zhyinch
2021-11-08 ffbabafff544caa6cf992434fdbb5e7d5bd6c0a7
源码/核心板/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)
{