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

use raw parameter floats if mission item is a mission command

Browse Source
This commit is contained in:
Andreas Antener
2016-01-11 08:19:00 +01:00
parent b0333e3e95
commit 7e7b21cbdc
3 changed files with 17 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/mission_block.cpp
+9 -9
View File
@@ -236,15 +236,15 @@ MissionBlock::reset_mission_item_reached()
void
MissionBlock::mission_item_to_vehicle_command(const struct mission_item_s *item, struct vehicle_command_s *cmd)
{
// Assignment based on MAVLink spec for param enumeration:
// http://mavlink.org/messages/common#MAV_CMD_NAV_WAYPOINT
cmd->param1 = item->time_inside;
cmd->param2 = item->acceptance_radius;
cmd->param3 = item->loiter_radius;
cmd->param4 = item->yaw;
cmd->param5 = item->lat;
cmd->param6 = item->lon;
cmd->param7 = item->altitude;
// we're expecting a mission command item here so assign the "raw" inputs to the command
// (MAV_FRAME_MISSION mission item)
cmd->param1 = item->params[0];
cmd->param2 = item->params[1];
cmd->param3 = item->params[2];
cmd->param4 = item->params[3];
cmd->param5 = item->params[4];
cmd->param6 = item->params[5];
cmd->param7 = item->params[6];
cmd->target_system = _navigator->get_vstatus()->system_id;
cmd->target_component = _navigator->get_vstatus()->component_id;