fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-06-26 18:20:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

change main trims to normalized values

Browse Source
This commit is contained in:
Mark Whitehorn
2016-11-09 15:05:30 -07:00
committed by Lorenz Meier
parent dbc149c224
commit f0b41a0e52
5 changed files with 65 additions and 57 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/px4iofirmware/registers.c
+13 -13
View File
@@ -399,19 +399,19 @@ registers_set(uint8_t page, uint8_t offset, const uint16_t *values, unsigned num
/* copy channel data */
while ((offset < PX4IO_SERVO_COUNT) && (num_values > 0)) {
if (*values == 0) {
/* allow 0 - turns the trim option off */
r_page_servo_control_trim[offset] = 0;
} else if (*values > PWM_HIGHEST_MAX) {
r_page_servo_control_trim[offset] = PWM_HIGHEST_MAX;
} else if (*values < PWM_LOWEST_MAX) {
r_page_servo_control_trim[offset] = PWM_LOWEST_MAX;
} else {
r_page_servo_control_trim[offset] = *values;
}
// if (*values == 0) {
// /* allow 0 - turns the trim option off */
// r_page_servo_control_trim[offset] = 0;
//
// } else if (*values > PWM_HIGHEST_MAX) {
// r_page_servo_control_trim[offset] = PWM_HIGHEST_MAX;
//
// } else if (*values < PWM_LOWEST_MAX) {
// r_page_servo_control_trim[offset] = PWM_LOWEST_MAX;
//
// } else {
r_page_servo_control_trim[offset] = *values;
// }
offset++;
num_values--;