主权项 |
一种智能平衡车系统,其至少包括:两轮车本体;两个手握件,分别安装在所述两轮车本体所包含的方向杆两端;两压力传感器,分别用于感测一个手握件的压力;设置在所述两轮车本体的控制模块,用于基于所述两压力传感器所感测的压力值来控制所述方向杆的转向,所述控制模块包括:速度检测单元,用于基于当前所获得的霍尔状态数据,采用预定测速法来确定所述两轮车的速度;所述速度检测单元包括:误差消除单元,用于基于当前所获得的霍尔状态数据与所有霍尔状态各自的标定数据之间的相关性来确定与所述当前所获得的霍尔状态数据对应的标定数据;速度确定单元,用于基于所确定的与所述当前所获得的霍尔状态数据对应的标定数据、采用以下滤波算法来确定所述两轮车的速度及加速度:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>v</mi><mi>k</mi></msub><mo>=</mo><mi>γ</mi><mfrac><mn>1</mn><mrow><mi>Y</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mfrac><mfrac><mrow><mi>X</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></mrow><mrow><mo>(</mo><mi>E</mi><mo>[</mo><mi>X</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow><mo>]</mo><mo>)</mo></mrow></mfrac><mo>,</mo></mrow>]]></math><img file="FDA0000622808990000011.GIF" wi="542" he="154" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>E</mi><mo>[</mo><mi>X</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow><mo>]</mo><mo>=</mo><munderover><mi>Σ</mi><mrow><mi>n</mi><mo>=</mo><mn>1</mn></mrow><mn>12</mn></munderover><mi>X</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000622808990000012.GIF" wi="429" he="149" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mover><mi>v</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><msub><mover><mi>v</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mover><mi>a</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mi>T</mi><mo>+</mo><mi>ξ</mi><mo>[</mo><msub><mi>v</mi><mi>k</mi></msub><mo>-</mo><mrow><mo>(</mo><msub><mover><mi>v</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mover><mi>a</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>]</mo><mo>,</mo></mrow>]]></math><img file="FDA0000622808990000013.GIF" wi="818" he="80" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mover><mi>a</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><msub><mover><mi>a</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>+</mo><mi>η</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>k</mi></msub><mo>-</mo><msub><mover><mi>a</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000622808990000014.GIF" wi="491" he="79" /></maths>其中,X(n)是与所述当前所获得的霍尔状态数据对应的标定数据,Y(k)为当前采集的霍尔持续时间,γ是每进行一次霍尔状态转换对应轮子所走过的距离,其值可根据电机一周霍尔状态个数、齿轮箱转速比及车轮外径关系得到,在0.0001m至0.01m之间取值,<img file="FDA0000622808990000015.GIF" wi="59" he="78" />当前时刻车轮速度的最优估计值,<img file="FDA0000622808990000016.GIF" wi="83" he="73" />上一时刻车轮速度的最优估计值,<img file="FDA0000622808990000017.GIF" wi="63" he="72" />当前时刻车轮加速度的最优估计值,<img file="FDA0000622808990000018.GIF" wi="80" he="75" />上一时刻车轮加速度的最优估计值,v<sub>k</sub>是车轮的速度,a<sub>k</sub>当前所测得的电机加速度,T是当前时刻与上一时刻的时间间隔,ξ,η为预定滤波系数。 |