[发明专利]一种轮腿式机器人的驱动牵引特性控制方法无效
申请号: | 201010503338.0 | 申请日: | 2010-09-30 |
公开(公告)号: | CN102033545A | 公开(公告)日: | 2011-04-27 |
发明(设计)人: | 段星光;黄强;赵洪华;王兴涛;陈悦 | 申请(专利权)人: | 北京理工大学 |
主分类号: | G05D1/00 | 分类号: | G05D1/00 |
代理公司: | 北京理工大学专利中心 11120 | 代理人: | 杨志兵;高燕燕 |
地址: | 100081 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 轮腿式 机器人 驱动 牵引 特性 控制 方法 | ||
1.一种轮腿式机器人的驱动牵引特性控制方法,其特征在于,该方法包括:
首先定义轮腿式机器人坐标系R=(G,X,Y,Z)和轮地接触点的局部坐标系Ri=(Pi,Ui,Vi,Wi);G为机器人重心,X、Y轴的方向分别与机器人车体的长度和宽度方向一致,Z轴垂直向上;Pi是轮腿i的车轮与地面的接触点;i取1到n之间的整数,n为轮腿式机器人的轮腿数量;Wi是垂直与接触平面切线方向的法向方向;Ui是第i个轮腿的车轮的切线方向;Vi=Wi×Ui,Wi、Ui和Vi满足右手法则;接触点Pi的接触力向量为fi,沿局部坐标系Ri的三个坐标轴方向对接触力向量fi进行分解得到fi=(fui,fvi,fwi);
定义滑行率公式
在进行驱动牵引特性控制时,根据所述滑行率公式计算各接触点Pi的滑行率Si,并从中找出滑行率最大值Simax对应的接触点Pimax,将Pimax处的轮腿关节作为被控轮腿,通过调节被控轮腿的关节角使得Pimax处的滑行率最小;
其中,轮腿的关节角为:从该轮腿的摆臂旋转中心沿摆臂长度方向与X轴正向的夹角,并且逆时针方向为正。
2.如权利要求1所述的轮腿式机器人的驱动牵引特性控制方法,其特征在于,所述通过调节被控轮腿的关节角使得Pimax处的滑行率取最小包括:
获取Pimax处轮腿关节的关节角测量值;针对Pimax处计算滑行率取最小值时的关节角取值,记为关节角目标值,根据关节角目标值和关节角测量值对Pimax处的轮腿关节进行控制;
所述关节角测量值的获取方式为:通过集成在摆臂关节的电机编码器直接测量得到关节角测量值;或者为:利用感知系统感知车体姿态,包括横滚角、俯仰角和偏转角,然后根据感知的车体姿态,通过运动学逆解求出关节角,作为关节角测量值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京理工大学,未经北京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201010503338.0/1.html,转载请声明来源钻瓜专利网。
- 上一篇:菠萝削皮机
- 下一篇:液晶显示装置和光传感器的电压检测方法