一种拖挂式自行车的稳定裕度估算方法以及控制方法
摘要:
本发明公开一种拖挂式自行车的稳定裕度估算方法以及控制方法,设计了动态估算稳定裕度的方法,利用姿态检测数据计算ZMP以及三个接地点在大地坐标系下的坐标,经ZMP做各边平行线,在接地三角形内平行线与对应的边形成三个最大梯形,通过计算三个最大梯形的面积与当前接地三角形面积之比,便可获得动态下每条边的稳定裕度,并以动态下每条边的稳定裕度作为平衡控制的数据基础,该动态估算稳定裕度的方法,能实时估算动态运行下接地三角形每条边的稳定裕度,并以动态的接地三角形每条边的稳定裕度为数据基础,实时地、动态地、量化地控制拖挂式自行车的平衡,在估算和控制上更具针对性,也更准确。
0/0