mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-01 21:07:40 +08:00
[fix] extra for #3089
This commit is contained in:
@@ -851,7 +851,7 @@ static void rpm_cb(uint8_t __attribute__((unused)) sender_id, struct rpm_act_t U
|
|||||||
#if INDI_RPM_FEEDBACK
|
#if INDI_RPM_FEEDBACK
|
||||||
int8_t i;
|
int8_t i;
|
||||||
for (i = 0; i < num_act; i++) {
|
for (i = 0; i < num_act; i++) {
|
||||||
act_obs[i] = (rpm_msg.rpm[i] - get_servo_min(i));
|
act_obs[i] = (rpm_msg[i].rpm - get_servo_min(i));
|
||||||
act_obs[i] *= (MAX_PPRZ / (float)(get_servo_max(i) - get_servo_min(i)));
|
act_obs[i] *= (MAX_PPRZ / (float)(get_servo_max(i) - get_servo_min(i)));
|
||||||
Bound(act_obs[i], 0, MAX_PPRZ);
|
Bound(act_obs[i], 0, MAX_PPRZ);
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -61,7 +61,7 @@ void rpm_sensor_init(void)
|
|||||||
void rpm_sensor_periodic(void)
|
void rpm_sensor_periodic(void)
|
||||||
{
|
{
|
||||||
struct rpm_act_t rpm_msg = {0, 0};
|
struct rpm_act_t rpm_msg = {0, 0};
|
||||||
rpm_msg.rpm = = update_first_order_low_pass(&rpm_lp, rpm_sensor_get_rpm());
|
rpm_msg.rpm = update_first_order_low_pass(&rpm_lp, rpm_sensor_get_rpm());
|
||||||
AbiSendMsgRPM(RPM_SENSOR_ID, &rpm_msg, 1);
|
AbiSendMsgRPM(RPM_SENSOR_ID, &rpm_msg, 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user