Ejemplo 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);
}
Ejemplo n.º 2
0
static void set_robot_pose(carmen_point_t pose) {

  carmen_point_t std = {0.2, 0.2, carmen_degrees_to_radians(4.0)};
  carmen_localize_initialize_gaussian_command(pose, std);
  if (simulation)
    carmen_simulator_set_truepose(&pose);
  global_pos_reset = 1;
}
Ejemplo n.º 3
0
void navigator_update_robot(carmen_world_point_p robot) 
{
  carmen_point_t std = {0.2, 0.2, carmen_degrees_to_radians(4.0)};

  if (robot == NULL) {
    carmen_localize_initialize_uniform_command();
  } else {
    carmen_verbose("Set robot position to %d %d %f\n", 
		   carmen_round(robot->pose.x), 
		   carmen_round(robot->pose.y),
		carmen_radians_to_degrees(robot->pose.theta)); 
    
    carmen_localize_initialize_gaussian_command(robot->pose, std);
  }
}