【技术实现步骤摘要】
本专利技术涉及仿人机器人，具体涉及一种仿人机器人多接触低质心爬行运动的轨迹跟踪方法。
技术介绍
1、仿人机器人经过复杂地形是当前仿人机器人领域的热点问题。众所周知，仿人机器人是系统结构最复杂、集成度最高、与人类最为相似的一类机器人，因此易于替代人类进行一些危险环境中的作业甚至能够完成普通人类无法完成的任务。随着机器人的工作环境和工作任务的复杂化，仿人机器人因其体积相对较小、对非结构化环境具有较好的适应性、蔽障能力强、能耗小、移动盲区小等优良的品质，受到众多学者和专家的关注。当仿人机器人需要经过斜坡、不平整碎石路面、低矮通道等复杂环境时，行走或跳跃动作很容易使机器人在不平整路面动作时发生摔倒，且无法通过低矮通道，因此，设计一种低质心的仿人机器人爬行运动轨迹规划和控制方法，可以有效帮助仿人机器人通过复杂环境中的不同路况。
2、仿人机器人的许多研究方向主要集中在行走、跳跃和奔跑，部分研究仿人机器人的高位跪姿爬行运动，而针对仿人机器人爬行尤其是低质心爬行的研究内容较少。仿人机器人低质心爬行运动相比于高质心行走和跳跃具有更高的稳定性，并且可以更加平稳通过复杂路况。在实现低质心爬行运动的过程中，机器人本体的关节或连杆会与地面发生单点接触或多点接触，机器人爬行前进或后退的过程，机器人本体与地面之间会发生接触点切换，增加新接触点或释放旧接触点。现阶段，针对机器人爬行的运动规划方法主要有以下两种：第一种是采用传统逆运动学和动力学方法对爬行轨迹进行轨迹优化；第二种是采用基于cpg(central pattern generator)模型
3、实现仿人机器人在复杂路面低质心爬行是一个复杂的问题，其中机器人本体与地面发生接触后的接触点切换更是影响机器人爬行的一个关键问题。audren在iros会议中提出使用离线多接触规划器生成接触姿态序列，这是一种离线方法。kudruss在ras会议中提出通过质心运动轨迹从而预定义机器人运动过程中的接触行为。2018年，justin和nicolas在发表的文章中提出腿足机器人多接触运动需要使用完整机器人模型，通过质心动力学计算腿足机器人在任意地形的多接触运动轨迹，并在一些仿真场景得到了验证。经过这些研究表明，复杂地形的多接触运动在现在仍然是一个开放的问题，质心动力学可以帮助简化计算，接触序列离线化设计可以更好地帮助机器人适应不同地形。
技术实现思路
1、有鉴于此，本专利技术提供了一种仿人机器人多接触低质心爬行运动的轨迹跟踪方法，通过结合机器人正逆运动学、动力学、低质心爬行轨迹优化和接触点切换的控制方法，降低了机器人在复杂地形爬行过程中的本体损害，提高了爬行过程中接触点切换的平滑程度，最终实现了仿人机器人在复杂地形的低质心爬行。
2、本专利技术的仿人机器人多接触低质心爬行运动的轨迹跟踪方法，包括：
3、步骤一，确定仿人机器人的低质心爬行运动过程中，仿人机器人本体与地面的接触点情况，所述接触点情况包括触地关节数量和触地关节名称；
4、步骤二，基于仿人机器人在低质心爬行运动过程中仿人机器人本体与地面的接触点情况，建立仿人机器人低质心爬行运动的运动学和动力学模型，获取仿人机器人低质心爬行运动轨迹；
5、步骤三，以步骤二获取的仿人机器人低质心爬行运动轨迹为参考轨迹，基于改进的二次规划qp算法对仿人机器人的运动轨迹进行跟踪控制；
6、其中，改进的二次规划qp算法中，qp(q,τ,γ,ω)代价函数为：
7、
8、其中，代表关节速度，其中6代表基座在空间中的3个移动自由度和3个转动自由度，ndof代表仿人机器人关节自由度数量；τ代表关节力矩代表第i个触地关节的期望接触力和力矩项，γi代表第i个触地关节的实际接触力和力矩项，i代表第i个触地关节，θtarget代表期望关节角度，θ代表实际关节角度，其中代表期望第j个末端执行器位姿，xj(q)代表实际第j个末端执行器位姿；在qp代价函数中qp(q,τ,γ,ω)，方程中每一项的下角标ω*代表对应代价项的权重；
9、其中，参数ωcont,i基于多接触点平滑切换算法实时在线修改，具体为：
10、s31，求解关节角变化△q、关节力矩变化△γ和关节力矩变化△τ，实时更新关节角q、关节力矩τ和接触力和力矩γ：(q,τ,γ)+＝(△q,△τ,△γ)，γ＝(f,τ)；
11、s32，针对仿人机器人关节i，i＝1,2，…，n，根据其当前的触地情况，判断下一时刻该关节是否触地移除或新增触地，修正其参数ωcont,i：
12、(1)若该关节当前为触地关节，则初始化其ωcont,i为其中，为设定的增加接触点临界值；为设定的移除接触点临界值；一般可设为1～5，一般可设为10-5～10-6；设定和的目的是可以使触地和不触地过程中平稳切换，降低机器人损害；
13、令ωcont,i＝δ·ωcont,i，执行s31，直到其中，δ为大于1的参数；然后判断||γi||≤ε是否满足，若满足则该关节触地移除，令参数若不满足，则令ωcont,i＝η·ωcont,i，执行s31，直到不移除该触地关节；其中，η为小于1的参数；
14、(2)若该关节当前为非触地关节，则初始化其ωcont,i为令ωcont,i＝η·ωcont,i，执行s31，直到然后判断||γi||≥μ是否满足，若满足，则该关节增加为触地关节，令参数若不满足，则令ωcont,i＝δ·ωcont,i，执行s31，直到不增加该接触点。
15、较优的，所述步骤一中，设定仿人机器人的低质心爬行运动为两种基本运动模态的循环切换；所述两种基本运动模态分别为：模态一，右腿膝关节微弯正面着地，左腿膝关节弯曲侧面着地，腰部右侧转动，右臂肘关节弯曲，左臂肩关节和肘关节弯曲；模态二，左腿膝关节微弯正面着地，右腿膝关节弯曲侧面着地，腰部左侧转动，左臂肘弯曲，右臂肩关节和肘关节弯曲；
16、确定两种基本运动模态的切换过程中，仿人机器人本体与地面的接触点情况。
17、较优的，仿人机器人由模态一切换为模态二再切换为模态一的过程为一个爬行周期；
18、在模态一切换到模态二的过程中，仿人机器人的右腿膝关节和右臂肘关节保存触地状态，左臂肩关节和肘关节抬起向前运动，此时机器人与地面接触点数量为3，之后腰部向左侧转动，左腿抬起向前运动，左臂在未落地前机器人与地面接触点数量为2，之后左臂肘关节和左腿膝关节相继本文档来自技高网...
【技术保护点】
1.一种仿人机器人多接触低质心爬行运动的轨迹跟踪方法，其特征在于，包括：
2.如权利要求1所述的方法，其特征在于，所述步骤一中，设定仿人机器人的低质心爬行运动为两种基本运动模态的循环切换；所述两种基本运动模态分别为：模态一，右腿膝关节微弯正面着地，左腿膝关节弯曲侧面着地，腰部右侧转动，右臂肘关节弯曲，左臂肩关节和肘关节弯曲；模态二，左腿膝关节微弯正面着地，右腿膝关节弯曲侧面着地，腰部左侧转动，左臂肘弯曲，右臂肩关节和肘关节弯曲；
3.如权利要求2所述的方法，其特征在于，仿人机器人由模态一切换为模态二再切换为模态一的过程为一个爬行周期；
4.如权利要求1或2或3所述的方法，其特征在于，所述步骤二中，通过多项式样条曲线规划质心和末端执行器的运动轨迹，仿人机器人的关节角通过逆运动学计算。
5.如权利要求4所述的方法，其特征在于，所述步骤二中，建立如下代价函数和约束方程对低质心爬行运动轨迹进行优化：
【技术特征摘要】
1.一种仿人机器人多接触低质心爬行运动的轨迹跟踪方法，其特征在于，包括：
2.如权利要求1所述的方法，其特征在于，所述步骤一中，设定仿人机器人的低质心爬行运动为两种基本运动模态的循环切换；所述两种基本运动模态分别为：模态一，右腿膝关节微弯正面着地，左腿膝关节弯曲侧面着地，腰部右侧转动，右臂肘关节弯曲，左臂肩关节和肘关节弯曲；模态二，左腿膝关节微弯正面着地，右腿膝关节弯曲侧面着地，腰部左侧转动，左臂肘弯曲，右臂肩...
【专利技术属性】
技术研发人员：高峻峣，金鸣岳，刘炯男，左伟龙，辛稀龙，伍泰平，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。