一种用于仿生假人踝关节精确跟踪控制方法技术

本发明专利技术公开了一种用于仿生假人踝关节精确跟踪控制方法，通过二连杆结构仿生假人踝关节，包括相铰接的小腿杆和脚掌杆，在脚掌杆上，与小腿杆连接端，设置有脚掌驱动电机；在小腿杆上，远离脚掌杆连接端，设置有小腿驱动电机；通过在小腿杆和脚掌杆上分别设置传感器以测量小腿杆、脚掌杆的角位置、角速率和角加速度；根据期望角位置与测量角位置获得跟踪误差，通过滑模控制法使得跟踪误差快速收敛，实现仿生假人踝关节对期望轨迹的精确跟踪。本发明专利技术公开的用于仿生假人踝关节精确跟踪控制方法，实现快速收敛，并规避了非奇异的问题，适用于冰雪运动等高速度运动下的控制。运动等高速度运动下的控制。运动等高速度运动下的控制。

【技术实现步骤摘要】
一种用于仿生假人踝关节精确跟踪控制方法


[0001]本专利技术涉及一种用于仿生假人踝关节精确跟踪控制方法，属于仿真控制


技术介绍

[0002]冰雪运动需要特定的场地，并伴随高速运动，在建立冰雪运动场地时，需要对场地进行测试，而真人测试容易造成损伤，通过仿生假人代替真人则是一种较好的方法。
[0003]冰雪运动需要进行动作学习和指导，采用仿生假人进行动作指导是一种有效的方法，能够解决教练不足的问题，并且做出标准的动作示范。
[0004]传统假人仅用于碰撞测试，从外观损坏情况推断对人体的危害程度，冰雪运动由于运动的特殊性，对假人踝关节运动、角度保持和高频转动做出了要求。
[0005]因此，需要对仿生假人踝关节控制方法进行研究，使得仿生假人踝关节能够精确的完成对期望轨迹信号的跟踪。

技术实现思路

[0006]为了克服上述问题，本专利技术人进行了深入研究，提出了一种用于仿生假人踝关节精确跟踪控制方法，通过二连杆结构仿生假人踝关节，包括相铰接的小腿杆和脚掌杆，在脚掌杆上，与小腿杆连接端，设置有脚掌驱动电机，使得脚掌杆能够相对小腿杆转动；在小腿杆上，远离脚掌杆连接端，设置有小腿驱动电机，使得小腿杆与水平面的夹角能够变化；
[0007]通过在小腿杆上设置传感器以测量小腿杆的角位置、角速率和角加速度，以及在脚掌杆上设置传感器，以测量脚掌杆的角位置、角速率和角加速度；
[0008]根据期望角位置与测量角位置获得跟踪误差，通过滑模控制法使得跟踪误差快速收敛，实现仿生假人踝关节对期望轨迹的精确跟踪。
[0009]进一步地，在滑模控制法中，设置误差动力学模型为：
[0010]e1＝q
‑
q
d
[0011][0012][0013]其中，e1表示仿生假人踝关节的角位置跟踪误差向量，q表示测量获得的仿生假人踝关节的角位置，q
d
表示期望的角位置， M0(q)表示正定质量惯性矩阵的名义值，u表示控制输入力矩，表示未知扰动和噪声之和，表示哥氏力和重力之和的名义值，
[0014]角位置、期望角位置和控制输入力矩均包括小腿部和脚掌部，表示为：
[0015]q＝[q1,q2]T
[0016]q
d
＝[q
d1
,q
d2
]T
[0017]u＝[u1,u2]T
[0018]其中，小腿部角位置q1为脚掌杆的延长与水平线的夹角，脚掌部角位置q2为小腿杆的延长与脚掌杆的夹角，小腿部期望角位置q
d1
表示q1期望的角位置，脚掌部期望角位置q
d2
表示q2期望的角位置，u1表示小腿部的控制输入力矩，u2表示脚掌部的控制输入力矩。
[0019]进一步地，在滑模控制法中，滑模面设置为固定时间收敛非奇异终端滑模面。
[0020]在一个优选的实施方式中，设置滑模面s为：
[0021][0022]其中，α、β为设计参数。
[0023]在一个优选的实施方式中，在滑模控制法中，趋近律设置为：
[0024][0025][0026]μ为设计参数，为自适应参数。
[0027]进一步优选地，自适应参数的控制率设置为：
[0028][0029]其中，α0、α1、α2为设计参数。
[0030]进一步地，在滑模控制法中，控制律设置为：
[0031][0032]本专利技术另一方面还提供了一种仿生假人踝关节，包括小腿杆、脚掌杆和微处理器，
[0033]小腿杆和脚掌杆铰接形成二连杆结构，在脚掌杆上，与小腿杆连接端，设置有脚掌驱动电机，使得脚掌杆能够相对小腿杆转动；在小腿杆上，远离脚掌杆连接端，设置有小腿驱动电机，使得小腿杆与水平面的夹角能够变化；
[0034]在小腿杆上设置传感器以测量小腿杆的角位置、角速率和角加速度，以及在脚掌杆上设置传感器，以测量脚掌杆的角位置、角速率和角加速度；
[0035]所述微处理器根据上述优选方法之一对小腿驱动电机和脚掌驱动电机进行滑模控制。
[0036]本专利技术所具有的有益效果包括：
[0037](1)不仅实现快速收敛，还规避了非奇异的问题，实现了高精度、高连续性控制，适用于冰雪运动等高速度运动下的控制；
[0038](2)对于大角度变换跟踪速度快、效果好，适应冰雪运动中的急速变化运动。
附图说明
[0039]图1示出根据本专利技术一种优选实施方式的用于仿生假人踝关节精确跟踪控制方法流程示意图；
[0040]图2示出根据本专利技术一种优选实施方式的用于仿生假人踝关节精确跟踪控制方法中等效二连杆结构示意图；
[0041]图3示出实施例1仿真结果中角度跟踪情况；
[0042]图4示出实施例1仿真结果中角速度变化情况；
[0043]图5示出实施例2仿真结果中角度跟踪情况；
[0044]图6示出实施例2仿真结果中角速度变化情况。
具体实施方式
[0045]下面通过附图和实施例对本专利技术进一步详细说明。通过这些说明，本专利技术的特点和优点将变得更为清楚明确。
[0046]在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。尽管在附图中示出了实施例的各种方面，但是除非特别指出，不必按比例绘制附图。
[0047]本专利技术提供了一种用于仿生假人踝关节精确跟踪控制方法，通过二连杆结构仿生假人踝关节，包括相铰接的小腿杆和脚掌杆，在脚掌杆上，与小腿杆连接端，设置有脚掌驱动电机，使得脚掌杆能够相对小腿杆转动；在小腿杆上，远离脚掌杆连接端，设置有小腿驱动电机，使得小腿杆与水平面的夹角能够变化；
[0048]通过在小腿杆上设置传感器以测量小腿杆的角位置、角速率和角加速度，以及在脚掌杆上设置传感器，以测量脚掌杆的角位置、角速率和角加速度；
[0049]根据期望角位置与测量角位置获得跟踪误差，通过滑模控制法使得跟踪误差快速收敛，实现仿生假人踝关节对期望轨迹的精确跟踪。
[0050]在本专利技术中，将期望轨迹转化为期望角位置，进而传递至仿生假人踝关节，通过滑模控制法跟踪期望角位置，从而实现对仿生假人踝关节对期望轨迹的精确跟踪。
[0051]根据本专利技术，在滑模控制法中，设置误差动力学模型为：
[0052]e1＝q
‑
q
d
[0053][0054][0055]其中，e1表示仿生假人踝关节的角位置跟踪误差向量，q表示测量获得的仿生假人踝关节的角位置，q
d
表示期望的角位置， M0(q)表示正定质量惯性矩阵的名义值，u表示控制输入力矩，表示未知扰动和噪声之和，表示哥氏力和重力之和的名义值，
[0056]由于仿生假人踝关节包括相连接的小腿杆和脚掌杆，则角位置、期望角位置和控制输入力矩均包括小腿部和脚掌部，表示为：
[0057]q＝[q1本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于仿生假人踝关节精确跟踪控制方法，其特征在于，通过二连杆结构仿生假人踝关节，包括相铰接的小腿杆和脚掌杆，在脚掌杆上，与小腿杆连接端，设置有脚掌驱动电机，使得脚掌杆能够相对小腿杆转动；在小腿杆上，远离脚掌杆连接端，设置有小腿驱动电机，使得小腿杆与水平面的夹角能够变化；通过在小腿杆上设置传感器以测量小腿杆的角位置、角速率和角加速度，以及在脚掌杆上设置传感器，以测量脚掌杆的角位置、角速率和角加速度；根据期望角位置与测量角位置获得跟踪误差，通过滑模控制法使得跟踪误差快速收敛，实现仿生假人踝关节对期望轨迹的精确跟踪。2.根据权利要求1所述的用于仿生假人踝关节精确跟踪控制方法，其特征在于，在滑模控制法中，设置误差动力学模型为：e1＝q
‑
q
dd
其中，e1表示仿生假人踝关节的角位置跟踪误差向量，q表示测量获得的仿生假人踝关节的角位置，q
d
表示期望的角位置，M0(q)表示正定质量惯性矩阵的名义值，u表示控制输入力矩，表示未知扰动和噪声之和，表示哥氏力和重力之和的名义值，角位置、期望角位置和控制输入力矩均包括小腿部和脚掌部，表示为：q＝[q1,q2]
T
q
d
＝[q
d1
,q
d2
]
T
u＝[u1,u2]
T
其中，小腿部角位置q1为脚掌杆的延长与水平线的夹角，脚掌部角位置q2为小腿杆的延长与脚掌杆的...

【专利技术属性】
技术研发人员：王伟，杨婧，王雨辰，朱泽军，陈柏霖，张宏岩，林时尧，刘佳琪，纪毅，苏政宇，孟祥瑜，于之晨，程一琛，张广，张锦程，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：