簡介

硬件配置資源

• 兩輪平衡小車主要硬件資源：
• 主控CPU：小熊派BearPi-HM Nano（Hi3861）開發(fā)板；
• 陀螺儀：MPU6050六軸陀螺儀傳感器；
• 左右輪：帶有霍爾傳感器的直流電機(jī)；
• 小車平臺及結(jié)構(gòu)件資源可以自行在相關(guān)網(wǎng)站獲得。

原理概括

PID算法介紹

• P比例參數(shù)：該參數(shù)能夠快速讓小車達(dá)到平衡狀態(tài)，但是由于控制是滯后的，以及是慣性系統(tǒng)，容易帶來超調(diào)，即小車會(huì)出現(xiàn)前后搖擺的現(xiàn)象。所以P參數(shù)不能太大；
• I積分參數(shù)：小車由于摩擦力或者風(fēng)阻力，并且P不能太大，只靠P控制有可能達(dá)不到穩(wěn)定狀態(tài)，所以需要加入I積分參數(shù)，消除穩(wěn)態(tài)誤差；
• D微分參數(shù)：平衡小車維持的是傾斜角度要為平衡角度，由于PI參數(shù)使小車振蕩，小車會(huì)出現(xiàn)前后搖擺現(xiàn)象，加入D微分參數(shù)能夠消除小車的振蕩。

兩步搭建樣例工程

關(guān)鍵算法講解

float g_middleAngle = 1.0;//平衡角度
float g_kpBalance = -85800.0;
float g_kdBalance = -400;


static int ControlBalance(float angle, short gyro)
{
    int outpwm = 0;
    float angleBias = 0.0;
    float gyroBias = 0.0;
    float tempAngle = 0.0;
    float tempGyro = 0.0;


    tempAngle = 0 - angle;//極性控制
    tempGyro = 0 - gyro;


    angleBias = g_middleAngle - tempAngle;
    gyroBias = 0 - tempGyro;
    outpwm = (g_kpBalance / 100 * angleBias + g_kdBalance
     * gyroBias / 100);


    return outpwm;
}

float g_kpSpeed = 95800.0;
float g_kiSpeed = 200;


static int ControlSpeed(long int left, long int right)
{
    int outpwm = 0;
    int speedBias = 0;
    int speedBiasLowpass = 0;
    static int speed_i = 0;
    float a = 0.68;
    static int speedBiasLast = 0;


    speedBias = 0 - left - right;
    speedBiasLowpass = (1 - a) * speedBias
        + a * speedBiasLast;
    speedBiasLast = speedBiasLowpass;


    speed_i += speedBiasLowpass;
    speed_i = limit_data(speed_i, SPEED_H, SPEED_L);


    outpwm = (g_kpSpeed * speedBiasLowpass / 100 +
        gkiSpeed * speed_i / 100);


    return outpwm;
}

static int ControlTurn(short gyro)
{
  int outpwm;


    outpwm = g_kpTurn * gyro;
  return outpwm;
}

總結(jié)

本文由電子發(fā)燒友社區(qū)發(fā)布，轉(zhuǎn)載請注明以上來源。如需社區(qū)合作及入群交流，請?zhí)砑?/span>微信EEFans0806，或者發(fā)郵箱liuyong@huaqiu.com。

熱門推薦干貨好文

1、?24Bit ADC高精度低功耗MCU 醫(yī)療級別設(shè)備參考設(shè)計(jì)（附上高精確算法+電路原理圖）?

2、超強(qiáng)性能AI芯片，OpenHarmony多系統(tǒng)支持，可定制高性能AP（附10+開發(fā)Demo）

3、從零入門物聯(lián)網(wǎng)OH開源平臺，從簡單到高階項(xiàng)目，創(chuàng)客、電子愛好者都愛用！

4、低成本ESP32方案，支持OpenHarmony系統(tǒng)開發(fā)（附10+項(xiàng)目樣例Demo）

5、NO RTOS移植！32位、64線程開發(fā)板，超強(qiáng)實(shí)時(shí)性體驗(yàn)！

6、四核64位，超強(qiáng)CPU ，看RK3568“競”開發(fā)板DEMO！

7、人工智能也能這么玩， 簡單快速入手，還能自定義AI運(yùn)算

8、業(yè)界首款！支持富設(shè)備開發(fā)，OpenHarmony開發(fā)者都選它！

9、高性能雙核RISC-V，滿足大多數(shù)開發(fā)，這款國產(chǎn)MCU工程師都愛了！