aboutsummaryrefslogtreecommitdiff
path: root/src/modules/bottle_drop
diff options
context:
space:
mode:
authorLorenz Meier <lm@inf.ethz.ch>2014-08-21 15:31:06 +0200
committerLorenz Meier <lm@inf.ethz.ch>2014-08-21 15:31:06 +0200
commit6051b2112efb584e5f84fb0648d4dddf5ac6c918 (patch)
tree5b171c73b484e8d6c6805c66e694cfa7639abb89 /src/modules/bottle_drop
parent0bdf28f9ba6f0875bfb70ff961fc61e73b813edc (diff)
downloadpx4-firmware-6051b2112efb584e5f84fb0648d4dddf5ac6c918.tar.gz
px4-firmware-6051b2112efb584e5f84fb0648d4dddf5ac6c918.tar.bz2
px4-firmware-6051b2112efb584e5f84fb0648d4dddf5ac6c918.zip
Moved pos output
Diffstat (limited to 'src/modules/bottle_drop')
-rw-r--r--src/modules/bottle_drop/bottle_drop.cpp8
1 files changed, 4 insertions, 4 deletions
diff --git a/src/modules/bottle_drop/bottle_drop.cpp b/src/modules/bottle_drop/bottle_drop.cpp
index a899cbe60..6a501d97c 100644
--- a/src/modules/bottle_drop/bottle_drop.cpp
+++ b/src/modules/bottle_drop/bottle_drop.cpp
@@ -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));