mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1598 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
parent
03d3231c48
commit
47d4b7a59d
@ -166,14 +166,33 @@ set_servos_4()
|
||||
init_pids();
|
||||
//Serial.print("kP: ");
|
||||
//Serial.println(pid_stabilize_roll.kP(),3);
|
||||
*/
|
||||
//*/
|
||||
|
||||
/*
|
||||
// YAW
|
||||
// make sure you init_pids() after changing the kP
|
||||
pid_yaw.kP((float)rc_6.control_in / 1000);
|
||||
init_pids();
|
||||
*/
|
||||
//*/
|
||||
|
||||
/*
|
||||
write_int(motor_out[CH_1]);
|
||||
write_int(motor_out[CH_2]);
|
||||
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)(dcm.yaw_sensor / 100));
|
||||
write_int((int)(nav_yaw / 100));
|
||||
|
||||
write_int((int)nav_lat);
|
||||
write_int((int)nav_lon);
|
||||
|
||||
write_int((int)nav_roll);
|
||||
write_int((int)nav_pitch);
|
||||
|
||||
flush(10);
|
||||
//*/
|
||||
}
|
||||
|
||||
// Send commands to motors
|
||||
|
Loading…
Reference in New Issue
Block a user