发明名称 智能平衡车系统
摘要 本发明公开了一种智能平衡车系统。所述智能平衡车系统至少包括:两轮车本体、分别安装在两轮车本体所包含的方向杆两端的两个手握件;分别用于感测一手握件的压力的两压力传感器;以及设置在所述两轮车本体的控制模块,用于基于所述两压力传感器所感测的压力值来控制所述方向杆的转向。优选地,所述控制模块还包括速度检测单元、根据相关信息、采用基于倒立摆模型及人主动干预运动相结合的响应模型来控制两轮车行驶的第一子控制单元、用于基于两轮车的相关参数,在两轮车车速已达到预定最大值时,使两轮车在预定范围内先加速再减速来调整车速的第二子控制单元。本发明能基于压力、速度等来控制两轮车的平衡行驶,以确保行车平稳及安全。
申请公布号 CN102774453B 申请公布日期 2015.05.20
申请号 CN201210230742.4 申请日期 2012.07.04
申请人 上海跑酷机器人科技有限公司 发明人 朱陈焜
分类号 B62K3/00(2006.01)I;B60W30/02(2012.01)I;G05D1/02(2006.01)I 主分类号 B62K3/00(2006.01)I
代理机构 上海金盛协力知识产权代理有限公司 31242 代理人 解文霞
主权项 一种智能平衡车系统,其至少包括:两轮车本体;两个手握件,分别安装在所述两轮车本体所包含的方向杆两端;两压力传感器,分别用于感测一个手握件的压力;设置在所述两轮车本体的控制模块,用于基于所述两压力传感器所感测的压力值来控制所述方向杆的转向,所述控制模块包括:速度检测单元,用于基于当前所获得的霍尔状态数据,采用预定测速法来确定所述两轮车的速度;所述速度检测单元包括:误差消除单元,用于基于当前所获得的霍尔状态数据与所有霍尔状态各自的标定数据之间的相关性来确定与所述当前所获得的霍尔状态数据对应的标定数据;速度确定单元,用于基于所确定的与所述当前所获得的霍尔状态数据对应的标定数据、采用以下滤波算法来确定所述两轮车的速度及加速度:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>v</mi><mi>k</mi></msub><mo>=</mo><mi>&gamma;</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>&Sigma;</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>&xi;</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>&eta;</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是当前时刻与上一时刻的时间间隔,ξ,η为预定滤波系数。
地址 201204 上海市浦东新区张江高新科技园区张衡路198弄(中海金鹤科技园)10号102室