void Carmen_Thread::set_localize_position(carmen_point_t pose) { carmen_point_t std = (carmen_point_t) { 0.2, 0.2, carmen_degrees_to_radians(0.0)/*, -pose.theta*/ }; carmen_localize_ackerman_initialize_gaussian_command(pose, std); carmen_localize_initialize_gaussian_command(pose, std); }
carmen_point_t publish_starting_pose(carmen_point_t pose) { carmen_point_t std; std.x = 0.001; std.y = 0.001; std.theta = carmen_degrees_to_radians(0.01); carmen_localize_ackerman_initialize_gaussian_command(pose, std); return pose; }