fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 06:23:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

had the wrong variable and wrong setpoint type

Browse Source
This commit is contained in:
andre-nguyen
2014-06-04 00:04:31 -04:00
parent e12d3af503
commit abbf57dac6
2 changed files with 8 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_receiver.cpp
+1
View File
@@ -379,6 +379,7 @@ MavlinkReceiver::handle_message_quad_swarm_roll_pitch_yaw_thrust(mavlink_message
case 4: case 4:
ml_mode = OFFBOARD_CONTROL_MODE_DIRECT_POSITION; ml_mode = OFFBOARD_CONTROL_MODE_DIRECT_POSITION;
ml_armed = true;
break; break;
default: default:
break; break;
src/modules/mc_pos_control/mc_pos_control_main.cpp
+7 -7
View File
@@ -133,7 +133,7 @@ private:
struct position_setpoint_triplet_s _pos_sp_triplet; /**< vehicle global position setpoint triplet */ struct position_setpoint_triplet_s _pos_sp_triplet; /**< vehicle global position setpoint triplet */
struct vehicle_local_position_setpoint_s _local_pos_sp; /**< vehicle local position setpoint */ struct vehicle_local_position_setpoint_s _local_pos_sp; /**< vehicle local position setpoint */
struct vehicle_global_velocity_setpoint_s _global_vel_sp; /**< vehicle global velocity setpoint */ struct vehicle_global_velocity_setpoint_s _global_vel_sp; /**< vehicle global velocity setpoint */
struct offboard_control_setpoint_s _offboard_control_pos_sp; /**< offboard control position setpoint struct vehicle_local_position_setpoint_s _offboard_control_pos_sp; /**< offboard control position setpoint */
struct { struct {
@@ -532,7 +532,7 @@ MulticopterPositionControl::task_main()
_arming_sub = orb_subscribe(ORB_ID(actuator_armed)); _arming_sub = orb_subscribe(ORB_ID(actuator_armed));
_local_pos_sub = orb_subscribe(ORB_ID(vehicle_local_position)); _local_pos_sub = orb_subscribe(ORB_ID(vehicle_local_position));
_pos_sp_triplet_sub = orb_subscribe(ORB_ID(position_setpoint_triplet)); _pos_sp_triplet_sub = orb_subscribe(ORB_ID(position_setpoint_triplet));
_offboard_control_pos_sp_sub = orb_subscribe(ORB_ID(offboard_control_setpoint)); _offboard_control_pos_sp_sub = orb_subscribe(ORB_ID(vehicle_local_position_setpoint));
parameters_update(true); parameters_update(true);
@@ -676,15 +676,15 @@ MulticopterPositionControl::task_main()
orb_check(_offboard_control_pos_sp_sub, &updated); orb_check(_offboard_control_pos_sp_sub, &updated);
if (updated) { if (updated) {
orb_copy(ORB_ID(offboard_control_setpoint), _offboard_control_pos_sp_sub, orb_copy(ORB_ID(vehicle_local_position_setpoint), _offboard_control_pos_sp_sub,
&_offboard_control_pos_sp); &_offboard_control_pos_sp);
} }
/* Hopefully no one dies from this */ /* Hopefully no one dies from this */
pos(0) = _offboard_control_pos_sp.p1; _pos_sp(0) = _offboard_control_pos_sp.x;
pos(1) = _offboard_control_pos_sp.p2; _pos_sp(1) = _offboard_control_pos_sp.y;
pos(2) = _offboard_control_pos_sp.p4; _pos_sp(2) = _offboard_control_pos_sp.z;
_att_sp.yaw_body = _offboard_control_pos_sp.p3; _att_sp.yaw_body = _offboard_control_pos_sp.yaw;
} else { } else {
/* AUTO */ /* AUTO */