基于多工作链的拟人机器人实时模仿人体运动的方法与流程
本发明涉及一种机器人运动方法，具体而言，涉及一种基于多工作链的拟人机器人实时模仿人体运动的方法，属于人机交互领域。
背景技术
随着科技的不断发展，机器人技术不再仅限于工业制造领域内的应用，机器人技术正迅速地扩展到家庭娱乐、医疗服务、教育科研以及勘测探险等领域。可以预见的是，机器人在21世纪将会得到更加飞速地发展。
伴随着图像处理、机器视觉、人工智能等相关学科的不断发展，尤其是深度传感器(如microsoft的kinect等)出现后，基于深度传感器获得人体运动骨骼信息的技术方案逐步成为了现实。由于光学传感器的工作原理是通过光线反射时间计算被检测物体的参数，不需要使用者佩戴额外的穿戴设备，因而基于深度传感器进行人机交互是一种更加自然、也更加便捷的人机交互方式。目前，运用光学传感器是人机交互技术中最为前沿和热门的领域之一。基于深度传感器的应用开发使人机交互可以从二维平面互动扩展到三维空间自由交互，并且能够提供非接触的交互体验，使用户在与机器的交互过程中更自由。
当前的机器人模仿主要基于两种方式，一种是角度配置的相似性，一种是末端执行器轨迹的相似性。但如何将上述两种方式更好地进行融合及优化，以实现拟人机器人对人体运动的实时模仿，一直是行业内难以解决的问题之一。
综上所述，如何提出一种拟人机器人实时模仿人体运动的方法，吸取现有各类技术的优点，实现拟人机器人对人体运动的实时模仿，就成为了本领域内技术人员亟待解决的问题。
技术实现要素：
鉴于现有技术存在上述缺陷，本发明的目的是提出一种基于多工作链的拟人机器人实时模仿人体运动的方法，包括如下步骤：
s1、数据获取及优化步骤，通过深度传感器获取人体各关节在传感器坐标系下的骨骼位置数据，并对所获取的数据进行优化处理；
s2、坐标映射步骤，将经过优化处理后的骨骼位置数据转化为向量信息，并映射到拟人机器人的尺寸上；
s3、正向运动学模型建立步骤，在拟人机器人的单条手臂上，建立从肩关节到肘关节的正向运动学工作链和从肩关节到腕关节的正向运动学工作链；
s4、多工作链的逆向运动学求解步骤，求解从肩关节到肘关节的逆向运动学方程，获取肩部关节两个自由度的角度值，再将所获取的角度值代入从肩关节到腕关节的逆向运动学方程中并求解，获取肘部关节两个自由度的角度值；
s5、角度值进行滤波处理步骤，对所获取的角度值进行滤波处理；
s6、角度值限制步骤，对已经过滤波处理后的角度值进行限制，避免拟人机器人运动过程中的自我碰撞。
优选地，所述深度传感器为kinect传感器。
优选地，s1中所述对所获取的数据进行优化处理，包括如下步骤：使用holt双指数平滑方法中的平滑滤波器来过滤骨骼位置数据。
优选地，s2坐标映射步骤中所使用的映射方程为，
其中，
优选地，所述s3正向运动学模型建立步骤，包括如下步骤：
s31、在拟人机器人的左右手上分别建立从肩部关节到肘部关节的正向运动学工作链，获取拟人机器人的左手在该工作链的dh矩阵；
s32、在拟人机器人的左右手上分别建立从肩部关节到腕部关节的正向运动学工作链，获取拟人机器人的左手在该工作链的dh矩阵。
优选地，所述s5角度值进行滤波处理步骤，包括如下步骤：
s51、使用数字滤波中的限幅滤波算法对脉冲干扰进行限幅滤波；
s52、使用kalman滤波算法对所获取的角度值进行平滑滤波处理。
优选地，所述s6角度值限制步骤，包括如下步骤：使用三维形状简化拟人机器人结构，通过判断三维形状之间是否存在碰撞的方式检测拟人机器人的运动过程中是否发生了自我碰撞。
与现有技术相比，本发明的优点主要体现在以下几个方面：
本发明采用了多工作链的逆向运动学求解方式，不仅简化了逆向运动学求解的过程，同时也在保证末端轨迹相似性的基础上增加了角度配置的相似性，实现了拟人机器人对人体运动的实时模拟。同时，本发明中使用的两步滤波方式，使得模仿过程更加稳定，还在最大限度上降低了算法的延时性，提升了算法的实时性和计算结果的准确性。此外，本发明提出的整体算法可以实现拟人机器人实时的模仿人体运动。本发明也为同领域内的其他相关问题提供了参考，可以以此为依据进行拓展延伸，运用于领域内其他拟人机器人模仿人体运动的技术方案中，具有十分广阔的应用前景。
综上所述，本发明提出了一种基于多工作链的拟人机器人实时模仿人体运动的方法，具有很高的使用及推广价值。
以下便结合实施例附图，对本发明的具体实施方式作进一步的详述，以使本发明技术方案更易于理解、掌握。
附图说明
图1为本发明的流程图。
具体实施方式
如图1所示，本发明揭示了一种基于多工作链的拟人机器人实时模仿人体运动的方法，包括如下步骤：
s1、数据获取及优化步骤，通过深度传感器获取人体各关节在传感器坐标系下的骨骼位置数据，并对所获取的数据进行优化处理。
s2、坐标映射步骤，将经过优化处理后的骨骼位置数据转化为向量信息，并映射到拟人机器人的尺寸上。
s3、正向运动学模型建立步骤，在拟人机器人的单条手臂上，建立从肩关节到肘关节的正向运动学工作链和从肩关节到腕关节的正向运动学工作链。
s4、多工作链的逆向运动学求解步骤，求解从肩关节到肘关节的逆向运动学方程，获取肩部关节两个自由度的角度值，再将所获取的角度值代入从肩关节到腕关节的逆向运动学方程中并求解，获取肘部关节两个自由度的角度值。
此处的求解操作，大大简化了肩部到腕部工作链的逆向运动学求解过程，保证了手腕和手肘两端的末端轨迹的相似性，同时间接提高了角度配置的相似性。
s5、角度值进行滤波处理步骤，对所获取的角度值进行滤波处理。
s6、角度值限制步骤，对已经过滤波处理后的角度值进行限制，避免拟人机器人运动过程中的自我碰撞。
所述深度传感器为kinect传感器。在微软推出的kinect开发者版本中，kinect具有三个传感器：红外发射镜头，红外摄像头以及rgb摄像头。利用彩色图像来获取人体姿态的方法只能获取人体二维位置，且非常容易受光照、背景、衣服颜色的影响，准确性和鲁棒性都较差。由于深度图像能反映镜头视野内各像素的空间位置，故利用深度图像可得到人体以及多个主要关节的三维坐标，且不受环境光照和衣服颜色等因素的影响。第一代kinect能够获取包含20个关节的骨骼信息。在实际测试中kinect的骨骼数据抖动比较大我们需要对其进行滤波，在本技术方案中，使用holt双指数平滑方法中的平滑滤波器来过滤骨骼位置数据。
通过kinect可以获取人体的骨骼位置数据，但获取的数据是基于kinect的坐标系中，并不是我们想要的，因此我们需要把获取到的骨骼位置数据转换到拟人机器人的坐标系中，同时由于人体和机器人的关节尺寸差异过大，如果直接计算角度，会是模仿完全失败，因此需要把坐标信息转化成向量信息。
具体而言，s2坐标映射步骤中所使用的映射方程为，
其中，
所述s3正向运动学模型建立步骤，包括如下步骤：
s31、在拟人机器人的左右手上分别建立从肩部关节到肘部关节的正向运动学工作链，获取拟人机器人的左手在该工作链的dh矩阵。
s32、在拟人机器人的左右手上分别建立从肩部关节到腕部关节的正向运动学工作链，获取拟人机器人的左手在该工作链的dh矩阵。
为了使得机器人模仿人体运动模仿得更加平滑，我们需要优化结果去消除角度的抖动，考虑到系统的实时性，采用的平滑滤波方法都必须具有比较低的算法复杂度。在实验结果中操作者发现，s4中所获取的角度值有很大的脉冲干扰以及抖动，因此首先需要消除这些脉冲干扰，其次是获取到的结果不够平滑，进而需要进行平滑滤波处理。具体而言，所述s5角度值进行滤波处理步骤，包括如下步骤：
s51、使用数字滤波中的限幅滤波算法对脉冲干扰进行限幅滤波。
s52、使用kalman滤波算法对所获取的角度值进行平滑滤波处理。
为了防止损坏拟人机器人，避免拟人机器人的自我碰撞，在本实施例中，在拟人机器人内部提供了一些api，可以使机器人避免自我碰撞。
具体而言，所述s6角度值限制步骤，包括如下步骤：使用三维形状简化拟人机器人结构，通过判断三维形状之间是否存在碰撞的方式检测拟人机器人的运动过程中是否发生了自我碰撞。
本发明通过kinect传感器捕获人体的骨骼位置数据，建立机器人手臂的多工作链模型，映射人体的向量数据到机器人维度上，求解机器人手臂的逆向运动学解，获取手臂各个关节模仿的角度值，对角度值进行滤波平滑处理，再进行机器人自我碰撞的避免，通过无线把数据发送给机器人。最终验证后，本方法的实时性、相似性都达到了非常高的要求。
本发明采用了多工作链的逆向运动学求解方式，不仅简化了逆向运动学求解的过程，同时也在保证末端轨迹相似性的基础上增加了角度配置的相似性，实现了拟人机器人对人体运动的实时模拟。同时，本发明中使用的两步滤波方式，使得模仿过程更加稳定，还在最大限度上降低了算法的延时性，提升了算法的实时性和计算结果的准确性。此外，本发明提出的整体算法可以实现拟人机器人实时的模仿人体运动。本发明也为同领域内的其他相关问题提供了参考，可以以此为依据进行拓展延伸，运用于领域内其他拟人机器人模仿人体运动的技术方案中，具有十分广阔的应用前景。
综上所述，本发明提出了一种基于多工作链的拟人机器人实时模仿人体运动的方法，具有很高的使用及推广价值。
对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神和基本特征的情况下，能够以其他的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内，不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
此外，应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施例中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。
- 还没有人留言评论。精彩留言会获得点赞！