Copy allocator passed in to clock init (#274)
* Store allocator passed in to clock init * Linter fix
This commit is contained in:
		
							parent
							
								
									b324f9de0d
								
							
						
					
					
						commit
						3356bd4cf1
					
				
					 2 changed files with 12 additions and 6 deletions
				
			
		| 
						 | 
					@ -63,7 +63,7 @@ typedef struct rcl_clock_t
 | 
				
			||||||
  rcl_ret_t (* get_now)(void * data, rcl_time_point_value_t * now);
 | 
					  rcl_ret_t (* get_now)(void * data, rcl_time_point_value_t * now);
 | 
				
			||||||
  // void (*set_now) (rcl_time_point_value_t);
 | 
					  // void (*set_now) (rcl_time_point_value_t);
 | 
				
			||||||
  void * data;
 | 
					  void * data;
 | 
				
			||||||
  rcl_allocator_t * allocator;
 | 
					  rcl_allocator_t allocator;
 | 
				
			||||||
} rcl_clock_t;
 | 
					} rcl_clock_t;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// A single point in time, measured in nanoseconds, the reference point is based on the source.
 | 
					/// A single point in time, measured in nanoseconds, the reference point is based on the source.
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
| 
						 | 
					@ -88,7 +88,7 @@ rcl_clock_init(
 | 
				
			||||||
  enum rcl_clock_type_t clock_type, rcl_clock_t * clock,
 | 
					  enum rcl_clock_type_t clock_type, rcl_clock_t * clock,
 | 
				
			||||||
  rcl_allocator_t * allocator)
 | 
					  rcl_allocator_t * allocator)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
  RCL_CHECK_ARGUMENT_FOR_NULL(allocator, RCL_RET_INVALID_ARGUMENT, rcl_get_default_allocator());
 | 
					  RCL_CHECK_ALLOCATOR_WITH_MSG(allocator, "invalid allocator", return RCL_RET_INVALID_ARGUMENT);
 | 
				
			||||||
  switch (clock_type) {
 | 
					  switch (clock_type) {
 | 
				
			||||||
    case RCL_CLOCK_UNINITIALIZED:
 | 
					    case RCL_CLOCK_UNINITIALIZED:
 | 
				
			||||||
      RCL_CHECK_ARGUMENT_FOR_NULL(
 | 
					      RCL_CHECK_ARGUMENT_FOR_NULL(
 | 
				
			||||||
| 
						 | 
					@ -111,6 +111,8 @@ rcl_clock_fini(
 | 
				
			||||||
  rcl_clock_t * clock)
 | 
					  rcl_clock_t * clock)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
  RCL_CHECK_ARGUMENT_FOR_NULL(clock, RCL_RET_INVALID_ARGUMENT, rcl_get_default_allocator());
 | 
					  RCL_CHECK_ARGUMENT_FOR_NULL(clock, RCL_RET_INVALID_ARGUMENT, rcl_get_default_allocator());
 | 
				
			||||||
 | 
					  RCL_CHECK_ALLOCATOR_WITH_MSG(&clock->allocator, "clock has invalid allocator",
 | 
				
			||||||
 | 
					    return RCL_RET_ERROR);
 | 
				
			||||||
  switch (clock->type) {
 | 
					  switch (clock->type) {
 | 
				
			||||||
    case RCL_ROS_TIME:
 | 
					    case RCL_ROS_TIME:
 | 
				
			||||||
      return rcl_ros_clock_fini(clock);
 | 
					      return rcl_ros_clock_fini(clock);
 | 
				
			||||||
| 
						 | 
					@ -138,7 +140,7 @@ rcl_ros_clock_init(
 | 
				
			||||||
  storage->active = false;
 | 
					  storage->active = false;
 | 
				
			||||||
  clock->get_now = rcl_get_ros_time;
 | 
					  clock->get_now = rcl_get_ros_time;
 | 
				
			||||||
  clock->type = RCL_ROS_TIME;
 | 
					  clock->type = RCL_ROS_TIME;
 | 
				
			||||||
  clock->allocator = allocator;
 | 
					  clock->allocator = *allocator;
 | 
				
			||||||
  return RCL_RET_OK;
 | 
					  return RCL_RET_OK;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					@ -151,7 +153,11 @@ rcl_ros_clock_fini(
 | 
				
			||||||
    RCL_SET_ERROR_MSG("clock not of type RCL_ROS_TIME", rcl_get_default_allocator());
 | 
					    RCL_SET_ERROR_MSG("clock not of type RCL_ROS_TIME", rcl_get_default_allocator());
 | 
				
			||||||
    return RCL_RET_ERROR;
 | 
					    return RCL_RET_ERROR;
 | 
				
			||||||
  }
 | 
					  }
 | 
				
			||||||
  clock->allocator->deallocate((rcl_ros_clock_storage_t *)clock->data, clock->allocator->state);
 | 
					  if (!clock->data) {
 | 
				
			||||||
 | 
					    RCL_SET_ERROR_MSG("clock data invalid", rcl_get_default_allocator());
 | 
				
			||||||
 | 
					    return RCL_RET_ERROR;
 | 
				
			||||||
 | 
					  }
 | 
				
			||||||
 | 
					  clock->allocator.deallocate((rcl_ros_clock_storage_t *)clock->data, clock->allocator.state);
 | 
				
			||||||
  return RCL_RET_OK;
 | 
					  return RCL_RET_OK;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					@ -165,7 +171,7 @@ rcl_steady_clock_init(
 | 
				
			||||||
  rcl_init_generic_clock(clock);
 | 
					  rcl_init_generic_clock(clock);
 | 
				
			||||||
  clock->get_now = rcl_get_steady_time;
 | 
					  clock->get_now = rcl_get_steady_time;
 | 
				
			||||||
  clock->type = RCL_STEADY_TIME;
 | 
					  clock->type = RCL_STEADY_TIME;
 | 
				
			||||||
  clock->allocator = allocator;
 | 
					  clock->allocator = *allocator;
 | 
				
			||||||
  return RCL_RET_OK;
 | 
					  return RCL_RET_OK;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					@ -191,7 +197,7 @@ rcl_system_clock_init(
 | 
				
			||||||
  rcl_init_generic_clock(clock);
 | 
					  rcl_init_generic_clock(clock);
 | 
				
			||||||
  clock->get_now = rcl_get_system_time;
 | 
					  clock->get_now = rcl_get_system_time;
 | 
				
			||||||
  clock->type = RCL_SYSTEM_TIME;
 | 
					  clock->type = RCL_SYSTEM_TIME;
 | 
				
			||||||
  clock->allocator = allocator;
 | 
					  clock->allocator = *allocator;
 | 
				
			||||||
  return RCL_RET_OK;
 | 
					  return RCL_RET_OK;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue