mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-12 02:48:28 -04:00
debug code updated
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1624 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
parent
a3d88b25a6
commit
6e396284a5
@ -182,8 +182,8 @@ set_servos_4()
|
||||
write_int(motor_out[CH_3]);
|
||||
write_int(motor_out[CH_4]);
|
||||
|
||||
write_int((int)(dcm.roll_sensor / 100));
|
||||
write_int((int)(dcm.pitch_sensor / 100));
|
||||
write_int((int)(cos_yaw_x * 100));
|
||||
write_int((int)(sin_yaw_y * 100));
|
||||
write_int((int)(dcm.yaw_sensor / 100));
|
||||
write_int((int)(nav_yaw / 100));
|
||||
|
||||
@ -192,9 +192,14 @@ set_servos_4()
|
||||
|
||||
write_int((int)nav_roll);
|
||||
write_int((int)nav_pitch);
|
||||
//24
|
||||
write_long(home.lat); //28
|
||||
write_long(home.lng); //32
|
||||
write_int((int)home.alt); //34
|
||||
|
||||
write_int((int)current_loc.alt);
|
||||
write_int((int)altitude_error);
|
||||
write_long(next_WP.lat);
|
||||
write_long(next_WP.lng);
|
||||
write_int((int)next_WP.alt); //44
|
||||
|
||||
flush(10);
|
||||
//*/
|
||||
|
Loading…
Reference in New Issue
Block a user