1

zhyinch

2022-03-02 56d6a907e12484053abb432e664d6a8466133161

 源码/核心板/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)
{