C++ (Cpp) carmen_localize_initialize_gaussian_commandの例

コード例 #1

ファイル: carmen_thread.cpp プロジェクト: ulyssesrr/carmen_lcad

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);
}

コード例 #2

ファイル: hmap.c プロジェクト: Paresh1693/carmen

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;
}

コード例 #3

ファイル: navigator_panel.c プロジェクト: acekiller/MasterThesis

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);
  }
}