直立车方向控制,一段小视频

qq904305159

方向控制用的清华方案,两个电感,P=2000,D = 0;程序如下,不管P大还是小,都会两边荡,感觉抗干扰能力特别弱,速度稍微快点就很容易跑出弯道.咋回事?
有经验的同学可以给点提示吗?

void DirectionControl(void)
{
    float fLeftRightAdd,fLeftRightSub,fValue,fDValue;
    float nLeft,nRight;

    Read_AD();
    AD_Value[0] *= 10;
    AD_Value[1] *= 10;
    nLeft = AD_Value[1] /= DIRECTION_CONTROL_COUNT;
    nRight = AD_Value[0] /= DIRECTION_CONTROL_COUNT;

    fLeftRightAdd = nLeft + nRight;
    fLeftRightSub = nLeft - nRight;

    g_fDirectionControlOld = g_fDirectionControlNew;

    fValue = fLeftRightSub * g_dirControl_P / fLeftRightAdd;

    fDValue = Get_AngleSpeed_Y();
    fDValue *= g_dirControl_D;

    fValue += fDValue;
    g_fDirectionControlOutNew = fValue;
}
void DirectionControlOutput(void)
{
    float fValue;

    if(g_nDirectionControlPeriod>=DIRECTION_CONTROL_PERIOD)
     {
        g_nDirectionControlPeriod = 0;
     }

    fValue = g_fDirectionControlOutNew - g_fDirectionControlOutOld;
    g_fDirectionControlOut = fValue * (g_nDirectionControlPeriod + 1) /DIRECTION_CONTROL_PERIOD
    + g_fDirectionControlOutOld;

}
http://v.youku.com/v_show/id_XMTUxNDk2NTM3Ng==.html?from=y1.7-1.2









补充内容 (2016-4-6 12:40):
补充,后来发现程序写错了,改过来了

qq904305159

劳烦看一下啊

TG小平民

加D参数啊

浅笑无痕

这视频很有魔性啊

qq904305159

浅笑无痕 发表于 2016-3-28 20:04
这视频很有魔性啊

这不是重点哦

qq904305159

TG小平民 发表于 2016-3-28 19:45
加D参数啊

试试看,明天再发视频

斯特凡

E车的电机本来就需要特殊处理

浅笑无痕

qq904305159 发表于 2016-3-28 21:35
这不是重点哦

能不能不一上来  方向控制给2000  好暴力

牧奎山谷

楼主，你的ad采集值经过归一化处理了吗

Lewis卤蛋

66666666666666666666666666666