dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

px_generate_mixers.py: scale mixer so that sum(z_thrust_scale)==n_rotors

This commit is contained in:
Julien Lecoeur 2018-01-09 12:21:22 +01:00 committed by Daniel Agar
parent 262d9c790b
commit b7d7d1209b
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/lib/mixer/geometries/tools/px_generate_mixers.py
View File

@ -195,6 +195,7 @@ def normalize_mix_px4(B):
'''
B_norm = np.linalg.norm(B, axis=0)
B_max = np.abs(B).max(axis=0)
B_sum = np.sum(B, axis=0)
# Same scale on roll and pitch
B_norm[0] = max(B_norm[0], B_norm[1]) / np.sqrt(B.shape[0] / 2.0)
@ -208,7 +209,7 @@ def normalize_mix_px4(B):
B_norm[4] = B_norm[3]
# Scale z thrust separately
B_norm[5] = B_max[5]
B_norm[5] = - B_sum[5] / np.count_nonzero(B[:,5])
# Normalize
B_norm[np.abs(B_norm) < 1e-3] = 1