- 专利标题: 基于拖曳距的双轮机器人建模与静止平衡方法及装置
-
申请号: CN201910637561.5申请日: 2019-07-15
-
公开(公告)号: CN110348140B公开(公告)日: 2021-06-25
- 发明人: 梁斌 , 陈章 , 王秉亨 , 孙一勇 , 杨君
- 申请人: 清华大学
- 申请人地址: 北京市海淀区清华园
- 专利权人: 清华大学
- 当前专利权人: 清华大学
- 当前专利权人地址: 北京市海淀区清华园
- 代理机构: 北京清亦华知识产权代理事务所
- 代理商 张润
- 主分类号: G06F30/20
- IPC分类号: G06F30/20 ; G06F30/17 ; G06F111/04 ; G06F119/14
摘要:
本发明公开了一种基于拖曳距的双轮机器人建模与静止平衡方法及装置,其中,该方法包括:将双轮机器人系统设置为多连杆多关节系统,在多连杆多关节系统中定义多个坐标系并计算出双轮机器人系统的拖曳距范围;根据多连杆多关节系统所受的闭环运动链和双轮机器人系统的车轮几何特性建立两个约束方程并建立运动学模型;利用第一类拉格朗日方程对运动学模型进行求解得到双轮机器人动力学模型,并对可控性矩阵的奇异值、闭环控制器的吸引域和控制代价进行分析,根据分析结果在拖曳距范围中确定出符合控制需求的拖曳距。该方法能反映在不同拖曳距下车把转角与质心高度变化的非线性关系,并能为拖曳距的选取提供一套分析流程,提高静止平衡的控制效果。
公开/授权文献
- CN110348140A 基于拖曳距的双轮机器人建模与静止平衡方法及装置 公开/授权日:2019-10-18