Exemplo n.º 1
0
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;
}