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

Moved pos output

Browse Source
This commit is contained in:
Lorenz Meier
2014-08-21 15:31:06 +02:00
parent 0bdf28f9ba
commit 6051b2112e
1 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/bottle_drop/bottle_drop.cpp
+4 -4
View File
@@ -497,6 +497,10 @@ BottleDrop::task_main()
float groundspeed_body = sqrtf(_global_pos.vel_n * _global_pos.vel_n + _global_pos.vel_e * _global_pos.vel_e);
distance_real = fabsf(get_distance_to_next_waypoint(_global_pos.lat, _global_pos.lon, _drop_position.lat, _drop_position.lon));
if (counter % 90 == 0) {
mavlink_log_info(_mavlink_fd, "#audio: drop distance %.2f", (double)distance_real);
}
//warnx("absolut wind speed = %.4f", vr); //////////////////////////////////////////////////////////////////// DEBUGGING
@@ -636,10 +640,6 @@ BottleDrop::task_main()
onboard_mission_pub = orb_advertise(ORB_ID(onboard_mission), &onboard_mission);
}
if (counter % 90 == 0) {
mavlink_log_info(_mavlink_fd, "#audio: drop distance %.2f", (double)distance_real);
}
// We're close enough - open the bay
distance_open_door = math::max(3.0f, fabsf(t_door * groundspeed_body));