forked from Archive/PX4-Autopilot
54 lines
1.4 KiB
Plaintext
54 lines
1.4 KiB
Plaintext
Helicopter 120 degree Cyclic-Collective-Pitch Mixing (CCPM) for PX4FMU
|
|
==================================================
|
|
|
|
|
|
Output 0 - Rear Servo Mixer
|
|
----------------
|
|
|
|
Rear Servo = Collective (Thrust - 3) + Elevator (Pitch - 1)
|
|
|
|
M: 2
|
|
O: 10000 10000 0 -10000 10000
|
|
S: 0 3 10000 10000 0 -10000 10000
|
|
S: 0 1 10000 10000 0 -10000 10000
|
|
|
|
|
|
Output 1 - Left Servo Mixer
|
|
-----------------
|
|
Left Servo = Collective (Thurst - 3) - 0.5 * Elevator (Pitch - 1) + 0.866 * Aileron (Roll - 0)
|
|
|
|
M: 3
|
|
O: 10000 10000 0 -10000 10000
|
|
S: 0 3 -10000 -10000 0 -10000 10000
|
|
S: 0 1 -5000 -5000 0 -10000 10000
|
|
S: 0 0 8660 8660 0 -10000 10000
|
|
|
|
|
|
Output 2 - Right Servo Mixer
|
|
----------------
|
|
Right Servo = Collective (Thurst - 3) - 0.5 * Elevator (Pitch - 1) - 0.866 * Aileron (Roll - 0)
|
|
|
|
|
|
M: 3
|
|
O: 10000 10000 0 -10000 10000
|
|
S: 0 3 -10000 -10000 0 -10000 10000
|
|
S: 0 1 -5000 -5000 0 -10000 10000
|
|
S: 0 0 -8660 -8660 0 -10000 10000
|
|
|
|
Output 3 - Tail Servo Mixer
|
|
----------------
|
|
Tail Servo = Yaw (control index = 2)
|
|
|
|
M: 1
|
|
O: 10000 10000 0 -10000 10000
|
|
S: 0 2 10000 10000 0 -10000 10000
|
|
|
|
|
|
Output 4 - Motor speed mixer
|
|
-----------------
|
|
This would be the governor output - not sure what group id to use here?
|
|
|
|
M: 1
|
|
O: 10000 10000 0 -10000 10000
|
|
S: 0 5 0 20000 -10000 -10000 10000
|