;程序的目的时求得两个轮子的速度矢量,但是却不知道为何是这样
speed.left =
tiM_GetCounter(TIM3)-0x7fff;
speed.right=TIM_GetCounter(TIM4)-0x7fff;/
speed.average*=0.7;
speed.average+=((float)(speed.left+speed.right))*0.5*0.3
TIM_SetCounter(TIM3, 0x7fff);
TIM_SetCounter(TIM4, 0x7fff);
然后我们这里记speed.average为VA,左右轮的叫做Vl和Vr。
那么每一次更新后
VA_k = Kp * VA_(k-1) + (1 - Kp) *(Vl_k + Vr_k)/2
这里的Kp是0.7
那么这里的VA到底是干什么用的呐?是用来计算Vx和Vy以及Phi呐还是什么。就需要你提供如何利用VA的那段代码
一周热门 更多>