CN109946974B - 一种电驱动四足机器人的控制*** - Google Patents
一种电驱动四足机器人的控制*** Download PDFInfo
- Publication number
- CN109946974B CN109946974B CN201910294462.1A CN201910294462A CN109946974B CN 109946974 B CN109946974 B CN 109946974B CN 201910294462 A CN201910294462 A CN 201910294462A CN 109946974 B CN109946974 B CN 109946974B
- Authority
- CN
- China
- Prior art keywords
- personal computer
- industrial personal
- joint
- driver
- encoder
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
一种电驱动四足机器人的控制***,包括上位机、工控机、驱动器和编码器,工控机与上位机连接进行传输数据,工控机和编码器均与驱动器连接;编码器固定在关节电机的输出端,用于检测关节电机旋转的角度,通过编码器测得的脉冲数和关节减速器的减速比得到关节的旋转角度,编码器将脉冲数上传至驱动器,驱动器再将经过滤波的脉冲值上传至工控机,然后工控机运行,得出机器人各关节的输出力矩并转换成电流值传递给驱动器,驱动器通过内置的电流环实现电机输出给定的力矩,实现对单腿的柔性优化和碰撞能量优化。本发明减少了单腿触地的能量损失,提升了硬件***的整体实时性和可靠性以及四足机器人的高速运动,能够保持良好的动态稳定性和高能量效率。
Description
技术领域
本发明涉及一种用于电驱动四足机器人的控制***,属于电驱动四足机器人控制技术领域。
背景技术
腿足式机器人一直是移动机器人比较热门的研究领域,腿足式机器人在动态稳定性和复杂地形适应性方面都胜过轮式机器人。电驱动机器人作为腿足式机器人的一个热门分支更是具有以上优越的特点。电驱动机器人是指采用力矩电机作为驱动关节运动的关键单元的机器人,其中又分为直驱方式、准直驱方式和SEA方式。
直驱方式的电驱动机器人直接将电机的输出轴与关节连杆相连,这种驱动方式控制效果最好,但是对力矩电机的要求比较高,目前的力矩电机纯输出力矩还达不到高力矩性能,而且性能越高意味着成本越高。SEA方式是指在力矩电机和连杆之间加弹簧装置,利用弹簧的储能特性来减轻对力矩电机的性能高要求,但是这种方式动力学模型复杂,实际控制效果很难达到理想状态。准直驱方式是指在电机和连杆之间加一级减速器的方案,这样既能达到直驱的控制效果,也能放大电机的输出力矩。
电驱动四足机器人二自由度准直驱方式的单腿结构(本发明中所用)如图1所示,包括大腿关节4、大腿连杆5、小腿关节6和小腿连杆7。电驱动四足机器人整体仿真模型结构如图2所示,包括躯干1和四条三自由度的单腿,躯干1通过髋关节2连接髋部连杆3,胯部连杆3、大腿关节4、大腿连杆5、小腿关节6和小腿连杆7依次连接,小腿连杆7的底部设置足底传感器8。足底传感器8用来检测机器人单腿足端是否触地的关键部件。大腿关节4和小腿关节6都是由力矩电机和减速器组成,减速器为一级行星减速器,电机通过一级行星减速器带动大腿关节4或小腿关节6转动。单腿的相应的正运动学和逆运动学可以得出。正运动学为的是通过编码器传输上来的电机角度来得出整个单腿足端位于图1所示坐标系中的位置。下面进行具体分析。
根据图1所示的基座标系以及各关节连杆参数,可推导出足端相对于基座的正运动学方程如下:
已知单腿足端位置,可反解求得二自由度单腿的关节角:
对二自由度单腿求导,可得单腿的雅可比矩阵:
以上各式中所求的角度θ1,θ2为图1中对应的大腿关节4和小腿关节6的关节角,x,z为足端在基座标中的位置。l1、l2分别为大腿连杆5和小腿连杆7的长度。l12为图1中足端到基坐标系原点的直线距离。
在四足机器人领域,实时性的控制***搭建一直是四足机器人领域比较核心的问题。当前有很多实时性***方案,如美国麻省理工学院的Cheetah2用的是NI公司提供的控制器以RS-422通信为基础搭建的实时***,瑞士苏黎世联邦理工学院的StarlETH采用的是基于ROS机器人***的实时性***等,或是采用公司的成熟方案,或是基于机器人***搭建。但是由于采用的都不是专业的实时性***,当前的电动腿足式机器人的实时性***性能表现一般,仍然有提升的方面。
在机器人领域,提升机器人的能量利用效率一直是一个亟需解决的问题。这个问题具体到电驱动机器人主要集中在足端触地过程中的能量优化、足端轨迹和四足步态的选择。
发明内容
本发明针对现有的电驱动四足机器人在实时性和高效性控制方面存在的问题,提供一种准确可行、实时性高的电驱动四足机器人的控制***。
本发明的电驱动四足机器人的控制***,包括大腿关节和小腿关节,大腿关节和小腿关节都是由电机和减速器连接而成,该控制***采用以下技术方案:
该控制***,包括上位机、工控机、驱动器和编码器,工控机与上位机连接进行传输数据,工控机和编码器均与驱动器连接;编码器固定在关节电机的输出端,用于检测关节电机旋转的角度,通过编码器测得的脉冲数和关节减速器的减速比得到关节的旋转角度,编码器将脉冲数上传至驱动器,驱动器再将经过滤波的脉冲值上传至工控机,然后工控机运行,得出机器人各关节的输出力矩并转换成电流值传递给驱动器,驱动器通过内置的电流环实现电机输出给定的力矩,实现对单腿的柔性优化和碰撞能量优化。
上位机实现人与机器人的交互界面。在机器人运动过程中,可以通过上位机给机器人发控制指令,例如,前进、跳跃等。
所述工控机运行控制算法实现对单腿的柔性优化和碰撞能量优化,该控制算法,包括单腿触地碰撞过程优化以及四足运行轨迹和步态优化;单腿触地碰撞是一个连续的动力学求解过程,利用将连续线性问题转化为随机线性问题并结合高斯分布求得参数结果,优化后的参数表达式如下:
E[min(h,bG)2]=h2-σ2(h+b)f(h)+(σ2+b2-h2)F(h)
其中的E表示期望值,h,bG都是标量参数,σ用来描述这一过程的参数的平均值分布和离散程度;F(h)由下式求得:
以上便得到触地碰撞能量损失结果;
通过对伯恩斯坦多项式的运用求出足端轨迹,表达式如下:
其中P1(t),P2(t),P3(t)为轨迹曲线的三部分分段规划的相对于基座标系的x,z坐标,t表示当前***的时间;a0~a14表示规划的足端曲线的预设点的相对于基座标系的x,z坐标;
通过结合触地碰撞优化和足端轨迹曲线得出飞驰对角步态,两条对角的单腿触地而另两条对角的单腿腾空。
所述工控机与上位机通过TCP/IP协议进行传输数据,所述工控机与驱动器通过CAN总线连接。所述编码器通过信号线与驱动器连接。
本发明通过控制算法的改进减少了单腿触地的能量损失,提升了硬件***的整体实时性和可靠性以及四足机器人的高速运动,控制算法主要实现四足机器人的高速运动,仿真的结果表示本发明的控制算法可以使四足机器人达到18km/h的平均速度,并且能够保持良好的动态稳定性和高能量效率。
附图说明
图1是现有电驱动四足机器人的单腿结构运动学建模示意图。
图2是现有所用的电驱动四足机器人的仿真模型示意图。
图3是本发明中控制***的结构原理示意图。
图4是本发明中控制算法规划的轨迹示意图。
图5是飞驰对角(Flying-trot)步态示意图。
图中:1.躯干,2.胯关节,3.胯部连杆,4.大腿关节,5.大腿连杆,6.小腿关节,7.小腿连杆,8.足底传感器。
具体实施方式
本发明的用于电驱动四足机器人的控制***是针对图1所示二自由度单腿结构,如图3,该控制***,包括上位机、工控机、驱动器和编码器,工控机与上位机通过TCP/IP协议进行传输数据,工控机与驱动器通过CAN总线连接,编码器通过专用信号线与驱动器连接,编码器固定在电机输出端。编码器用于检测电机旋转的角度,通过编码器测得的脉冲数和已知的图1中小腿关节处的一级行星减速器的减速比De就可以得到图1所示的腿足式机器人的大腿和小腿关节的旋转角度,编码器将脉冲数上传至驱动器,驱动器再将经过滤波的脉冲值通过图3所示的CAN通讯总线上传至工控机实现数据采集的全过程,然后工控机运行本发明中的控制算法,得出需要腿足式机器人各关节的输出力矩,转换成电流值,通过CAN通信传递给驱动器,驱动器通过内置的电流环实现电机输出给定的力矩。
工控机采用德国控创公司的KEEX-5000系列的工控机并通过PCIE插槽扩展PEAK公司的CAN卡实现工控机与驱动器之间的CAN通信,由12V直流电池单独对工控机以及散热风扇供电,另由格氏提供的24V电池串联达到48V作为单腿的直流总电源。工控机带有电源指示灯和CAN通信指示灯。如图3所示,工控机与单腿的大腿关节4和小腿关节6的两个驱动器之间通过CAN总线连接,并通过CAN的高层协议CANOpen协议实现数据编码传输以及解析。工控机运行的***是由黑莓公司的QNX实时***,QNX***具有高实时性和可靠性的特点,特别适合机器人领域。通过其特有的QNX Momentic软件编译本发明中的控制算法代码可实现对单腿的柔性优化和碰撞能量优化。
编码器采用雷尼绍型号为RMB20IC13BC10的相对式编码器,精度为8192,即电机每转一圈,编码器将采集到8192个脉冲,该型编码器精度高,体积小,非常适合电机角度的检测。通过编码器检测到的脉冲数,利用公式:可以得到关节的旋转角度θ1,θ2,Ni为编码器检测到的脉冲数,De为一级行星减速器的减速比。然后本发明中的控制算法调用正运动学计算出足端相对于基坐标系的位置以及通过已知的控制频率计算出瞬时速度。
上述***在实际单腿运动中表现出良好的实时性能和高可靠性能。
本发明中的控制算法包括单腿触地碰撞过程优化以及四足运行轨迹和步态优化(单腿的跳跃运动、四足机器人的Flying-trot步态运动)。
单腿触地碰撞是一个连续的动力学求解过程,但是现实环境中获得的输入参数不足以支持求出能够接受的结果。所以利用将连续线性问题转化为随机线性问题并结合高斯分布,可以求得一个较为精确的参数结果。优化后的参数表达式如下:
E[min(h,bG)2]=h2-σ2(h+b)f(h)+(σ2+b2-h2)F(h)
其中的E表示期望值,h,bG都是标量参数,σ用来描述这一过程的参数的平均值分布和离散程度。F(h)由下式求得:
如图4,通过对伯恩斯坦多项式的运用可以求出一个较优的足端轨迹,轨迹表达式如下:
其中P1(t),P2(t),P3(t)为轨迹曲线的三部分分段规划的相对于基座标系的x,z坐标,t表示当前***的时间。a0~a14表示规划的足端曲线的预设点的相对于基座标系的x,z坐标。
如图5,步态通过结合触地碰撞优化和轨迹曲线得出一种“飞驰对角“步态,也就是两条对角的单腿触地,而另两条对角的单腿腾空。图5中的黑色圆圈表示对应的三自由度单腿触地,白色圆圈代表对应的三自由度单腿腾空。整图表示的是一个周期四足机器人的单腿触地变化。
以上便是具体的控制算法的全部。这个算法主要实现四足机器人的高速运动,仿真的结果表示上述本发明的控制算法可以使四足机器人达到18km/h的平均速度,并且能够保持良好的动态稳定性和高能量效率。
Claims (1)
1.一种电驱动四足机器人的控制***,其特征是:包括上位机、工控机、驱动器和编码器,工控机与上位机连接进行传输数据,工控机和编码器均与驱动器连接;编码器固定在关节电机的输出端,用于检测关节电机旋转的角度,通过编码器测得的脉冲数和关节减速器的减速比得到关节的旋转角度,编码器将脉冲数上传至驱动器,驱动器再将经过滤波的脉冲值上传至工控机,然后工控机运行,得出机器人各关节的输出力矩并转换成电流值传递给驱动器,驱动器通过内置的电流环实现电机输出给定的力矩,实现对单腿的柔性优化和碰撞能量优化;
工控机与驱动器通过CAN总线连接,工控机与上位机通过TCP/IP协议进行传输数据,由12V直流电池单独对工控机以及散热风扇供电,另由24V电池串联达到48V作为单腿的直流总电源;工控机与驱动器通过CAN总线连接,工控机与单腿的大腿关节和小腿关节的两个驱动器之间通过CAN总线连接,并通过CAN的高层协议CANOpen协议实现数据编码传输以及解析;
通过编码器测得的脉冲数转换为电机位置,并通过关节减速器的减速比得到关节的旋转角度,驱动器将经过滤波的编码器输出值上传至工控机,然后工控机运行,得出机器人各关节的输出力矩并转换成电流值传递给驱动器,驱动器通过内置的电流环实现电机输出给定的力矩,将大腿电机和小腿电机通过行星减速器及刚性连杆转换为关节输出力矩;
工控机运行的***是QNX实时***,保证控制的高实时性,通过高实时控制以保证能耗优化的效果,并通过其特有的QNX Momentic软件编译工控机的控制算法对单腿实现主动柔顺的力控制,实现单腿运动飞驰步态的柔性优化和碰撞能量优化;
所述工控机运行控制算法实现对单腿的柔性优化和碰撞能量优化,该控制算法,包括单腿触地碰撞过程优化以及四足运行轨迹和步态优化;单腿触地碰撞是一个连续的动力学求解过程,利用将连续线性问题转化为随机线性问题并结合高斯分布求得参数结果,优化后的参数表达式如下:
E[min(h,bG)2]=h2-σ2(h+b)f(h)+(σ2+b2-h2)F(h)
其中的E表示期望值,h,bG都是标量参数,σ用来描述这一过程的参数的平均值分布和离散程度;F(h)由下式求得:
以上便得到触地碰撞能量损失结果;
通过对伯恩斯坦多项式的运用求出足端轨迹,表达式如下:
其中P1(t),P2(t),P3(t)为轨迹曲线的三部分分段规划的相对于基座标系的x,z坐标,t表示当前***的时间;a0~a14表示规划的足端曲线的预设点的相对于基座标系的x,z坐标;
通过结合触地碰撞优化和足端轨迹曲线得出飞驰对角步态,两条对角的单腿触地而另两条对角的单腿腾空。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910294462.1A CN109946974B (zh) | 2019-04-12 | 2019-04-12 | 一种电驱动四足机器人的控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910294462.1A CN109946974B (zh) | 2019-04-12 | 2019-04-12 | 一种电驱动四足机器人的控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109946974A CN109946974A (zh) | 2019-06-28 |
CN109946974B true CN109946974B (zh) | 2022-07-01 |
Family
ID=67014915
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910294462.1A Active CN109946974B (zh) | 2019-04-12 | 2019-04-12 | 一种电驱动四足机器人的控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109946974B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110412921B (zh) * | 2019-08-09 | 2021-07-27 | 山东大学 | 基于EtherCAT的机器人单腿高实时性控制*** |
CN111332382A (zh) * | 2020-04-01 | 2020-06-26 | 安徽工业大学 | 一种水平关节四足机器人 |
CN111890363B (zh) * | 2020-07-27 | 2022-12-30 | 四川大学 | 一种基于快速自适应梯度神经网络算法的机械臂运动规划方法 |
CN111857173A (zh) * | 2020-08-17 | 2020-10-30 | 常州工程职业技术学院 | 一种四足机器人跳跃步态规划控制***及其方法 |
CN113110304A (zh) * | 2021-03-13 | 2021-07-13 | 无锡信捷电气股份有限公司 | 一种多通道的运动 |
CN113377113B (zh) * | 2021-07-02 | 2022-01-04 | 北方工业大学 | 足式机器人足端轨迹规划方法、***及控制方法、*** |
CN114488808B (zh) * | 2022-01-24 | 2022-12-30 | 新基线(江苏)科技有限公司 | 一种四足机器人模型参数的实时校正方法 |
CN114454983B (zh) * | 2022-03-02 | 2023-04-14 | 北京理工大学 | 一种四足机器人转弯控制方法及*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4548135B2 (ja) * | 2005-02-03 | 2010-09-22 | トヨタ自動車株式会社 | 脚式ロボットとその制御方法 |
CN103676797A (zh) * | 2012-09-07 | 2014-03-26 | 南京理工大学 | 模块化分动式多足机器人运动控制器及其控制方法 |
CN105599821A (zh) * | 2016-01-06 | 2016-05-25 | 山东优宝特智能机器人有限公司 | 具有环境感知能力的电驱动仿生四足机器人及控制方法 |
CN108710298A (zh) * | 2018-05-23 | 2018-10-26 | 中国海洋大学 | 基于足式仿生机器人在静立状态下的低能耗姿态分析方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8457830B2 (en) * | 2010-03-22 | 2013-06-04 | John R. Goulding | In-line legged robot vehicle and method for operating |
-
2019
- 2019-04-12 CN CN201910294462.1A patent/CN109946974B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4548135B2 (ja) * | 2005-02-03 | 2010-09-22 | トヨタ自動車株式会社 | 脚式ロボットとその制御方法 |
CN103676797A (zh) * | 2012-09-07 | 2014-03-26 | 南京理工大学 | 模块化分动式多足机器人运动控制器及其控制方法 |
CN105599821A (zh) * | 2016-01-06 | 2016-05-25 | 山东优宝特智能机器人有限公司 | 具有环境感知能力的电驱动仿生四足机器人及控制方法 |
CN108710298A (zh) * | 2018-05-23 | 2018-10-26 | 中国海洋大学 | 基于足式仿生机器人在静立状态下的低能耗姿态分析方法 |
Non-Patent Citations (5)
Title |
---|
An Energy Efficient Motion Controller Based on SLCP for the Electrically Actuated Quadruped Robot;Tianfa Li etc.;《Journal of Bionic Engineering》;20200407;全文 * |
Stochastic Complementarity for Local Control of Dscontinuous Dynamics;Yuval Tassa etc.;《Robotics: Science and Systems VI》;20100627;全文 * |
主—被动变刚度柔性单腿建模及能耗分析;史延雷 等;《计算机集成制造***》;20171231;第23卷(第12期);第2719-2726页 * |
史延雷 等.主—被动变刚度柔性单腿建模及能耗分析.《计算机集成制造***》.2017,第23卷(第12期),第2719-2726页. * |
基于自由步态的六足机器人崎岖路面行走控制方法研究;丛恩博;《中国优秀硕士学位论文全文数据库 信息科技辑》;20180215(第2期);正文第33-34页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109946974A (zh) | 2019-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109946974B (zh) | 一种电驱动四足机器人的控制*** | |
Park et al. | Variable-speed quadrupedal bounding using impulse planning: Untethered high-speed 3d running of mit cheetah 2 | |
Chen et al. | Quattroped: a leg--wheel transformable robot | |
CN110239644A (zh) | 一种基于柔性脊柱技术的仿生四足机器人 | |
CN104889996B (zh) | 一种替身机器人的替身实现方法 | |
CN104108433A (zh) | 一种轮足式机器人的柔顺控制方法 | |
CN111746824B (zh) | 一种缓冲/行走一体化六足着陆器及其步态控制方法 | |
CN103978485B (zh) | 一种仿蛇型软体机器人控制***和控制方法 | |
CN106809294A (zh) | 凸轮连杆组合机构驱动的步行机器人 | |
CN113843801B (zh) | 复合机器人的控制方法、装置及*** | |
CN113127989A (zh) | 一种六自由度机械臂逆运动学解析求解控制方法 | |
CN110919656A (zh) | 一种基于slip的并联腿足机器人运动控制方法及*** | |
CN103412487A (zh) | 一种基于模糊滑模控制器的球形机器人坡面运动控制方法 | |
CN115783081A (zh) | 一种足式机器人及运动控制方法 | |
Liao et al. | Energy efficient swing leg trajectory planning for quadruped robots walking on rough terrain | |
CN111497964B (zh) | 一种电驱动四足机器人分布式控制*** | |
Sun et al. | Rhex-t3: A transformable hexapod robot with ladder climbing function | |
CN102541068A (zh) | 一种双足机器人跨越障碍物的下肢运动规划*** | |
Li et al. | Design and simulated characteristics of a new biped mechanism | |
CN204725501U (zh) | 体感机械臂舒适度检测装置 | |
CN107485540B (zh) | 一种用于智能协步手杖的能量注入*** | |
CN203899136U (zh) | 基于嵌入式视觉的竞技娱乐型仿人机器人的外部结构 | |
CN108673492A (zh) | 基于网页控制的模块化软体机器人*** | |
CN209793754U (zh) | 一种便于控制的直驱仿人手指 | |
CN214267810U (zh) | 一种具有多运动方式的双足机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |