控制纵向两轮车平衡的方法和装置
基本信息
申请号 | CN202010947232.3 | 申请日 | - |
公开(公告)号 | CN112109561B | 公开(公告)日 | 2021-09-28 |
申请公布号 | CN112109561B | 申请公布日 | 2021-09-28 |
分类号 | B60L15/20(2006.01)I;B62J45/41(2020.01)I;B62K11/00(2013.01)I;G05B19/042(2006.01)I | 分类 | 一般车辆; |
发明人 | 张洋;张虎 | 申请(专利权)人 | 北京爱其科技有限公司 |
代理机构 | 济南信达专利事务所有限公司 | 代理人 | 李世喆 |
地址 | 100085北京市海淀区上地三街9号D座11层D1204A | ||
法律状态 | - |
摘要
摘要 | 本申请公开了一种控制纵向两轮车平衡的方法和装置。所述方法的一具体实施方式包括:获取纵向两轮车的目标转动角度;以第一时间间隔定时执行控制步骤:判断是否到达执行平衡算法的时间,如果到达,则执行平衡算法:获取纵向两轮车的姿态数据,计算当前车体倾斜角,基于PD算法,计算平衡角度,控制纵向两轮车转动平衡角度后,跳转执行控制步骤;如果未到达执行平衡算法的时间,读取当前转动角度,基于PID算法,控制纵向两轮车转向;更新当前转动角度,如果该当前转动角度小于目标转动角度,则跳转执行控制步骤。实现了控制纵向两轮车转向与车体平衡交织执行,在多次控制转向的过程中,间断的通过控制车体转动平衡角度,来不断的进行平衡矫正。 |
