源码/核心板/Src/algorithm/TrackingDiff.c
@@ -24,9 +24,11 @@ // self->vel_predict += (self->error * self->vel_factor) * self->time_correction; // self->pos_predict += (self->vel_predict + self->error * self->pos_factor) * self->time_correction; //} #define vel_factor 2 #define pos_factor 4 #define time_correction 0.03 //#define vel_factor 2 //#define pos_factor 4 extern uint16_t vel_factor,pos_factor; #define time_correction 0.01 float vel_predict[255],pos_predict[255]; void NewTrackingDiffUpdate(u8 channel, float target) {