一种人形机器人与人体姿态相似度评价方法技术

本发明专利技术公开了一种人形机器人与人体姿态相似度评价方法，包括如下步骤：(1)通过深度摄像头获取人体骨骼节点的三维位置信息；(2)根据人体骨骼节点构建人体骨骼模型的连杆向量；(3)将人体骨骼模型各连杆向量在深度摄像头坐标系中的坐标转换到人类观测坐标系中；(4)根据人形机器人各关节角度及支撑脚姿态计算人形机器人各连杆向量在机器人观测坐标系中的坐标；(5)根据人体骨骼模型连杆向量在人类观测坐标系中的坐标和人形机器人连杆向量在机器人观测坐标系中的坐标计算人形机器人与人体姿态的相似度。本发明专利技术利用人体骨骼模型和人形机器人连杆在世界坐标系中的向量量化评价姿态相似度，具有表征充分、侧重整体、评价准确的特点。

【技术实现步骤摘要】
一种人形机器人与人体姿态相似度评价方法
本专利技术涉及人机交互
，特别涉及一种人形机器人与人体姿态相似度评价方法。
技术介绍
近年来，机器人技术快速发展，并越来越广泛地应用于工业、医疗、科学研究与教育培训和家庭日常生活等领域当中。与此同时，愈加复杂和多样的应用环境对机器人的适应性和智能化提出了更高的要求。机器人模仿学习技术可以提高机器人学习效率，提升机器人智能化程度，将开发者从繁重的编程工作中解脱出来。对机器人模仿姿态与人体姿态的相似度进行恰当的评价，对于机器人模仿系统的优化具有重要作用。当前一些研究使用主观评价的方法，该种方法需要发放问卷搜集信息，过程较为繁琐，难以获取精确的量化评价指标。另外一些研究使用量化评价方法对机器人模仿相似度进行评价，这些方法大多基于关节角度或身体关键节点。而关节角度或身体关键节点无法直接表征模仿或演示的姿态，因而难以有效评价人形机器人动作模仿的相似度。
技术实现思路
本专利技术的目的在于克服现有技术中的缺点与不足，提供一种人形机器人与人体姿态相似度评价方法，利用人体骨骼模型和机器人连杆在世界坐标系中的向量量化评价姿态相似度，具有表征充分、侧重整体、评价准确的特点。为实现以上目的，本专利技术采取如下技术方案：一种人形机器人与人体姿态相似度评价方法，包括下列步骤：S1、通过深度摄像头获取人体骨骼节点的三维位置信息；S2、根据步骤S1获得的人体骨骼节点构建人体骨骼模型的连杆向量；S3、将步骤S2获得的人体骨骼模型各连杆向量在深度摄像头坐标系中的坐标转换到人类观测坐标系中；S4、定义人形机器人全身关节和连杆，根据人形机器人各关节角度及支撑脚姿态计算人形机器人各连杆向量在机器人观测坐标系中的坐标；S5、根据步骤S3获得的人体骨骼模型连杆向量在人类观测坐标系中的坐标和步骤S4获得的人形机器人连杆向量在机器人观测坐标系中的坐标计算人形机器人与人体姿态的相似度。作为优选的技术方案，步骤S1中，所述通过深度摄像头获取人体骨骼节点的三维位置信息，包括人体的四肢和脊柱各关节点的信息。作为优选的技术方案，步骤S2，具体过程如下：将人体骨骼模型的躯干、头部、左上臂、左下臂、左手、左大腿、左小腿、左脚、右上臂、右下臂、右手、右大腿、右小腿、右脚定义为连杆；根据同一连杆的两个骨骼节点的三维坐标，得到该连杆在深度摄像头坐标系中的向量坐标。作为优选的技术方案，步骤S3中，利用转换矩阵Rh将深度摄像头坐标系中人体骨骼模型的连杆向量坐标转换到人类观测坐标系中，转换矩阵Rh为：其中，分别为在深度摄像头坐标系中与深度摄像头坐标系X轴、Y轴、Z轴正向同向的向量，分别为在深度摄像头坐标系中与人类观测坐标系X轴、Y轴、Z轴正向同向的向量。作为优选的技术方案，步骤S4中，包括下述步骤：S41、定义人形机器人全身关节和连杆：将人形机器人的躯干、头部、左上臂、左下臂、左手、左大腿、左小腿、左脚、右上臂、右下臂、右手、右大腿、右小腿、右脚定义为连杆；将靠近支撑脚的连杆定义为远离支撑脚的连杆的母连杆；将远离支撑脚的连杆定义为靠近支撑脚的连杆的子连杆；将颈部、左肩、左肘、左腕、左髋、左膝、左踝、右肩、右肘、右腕、右髋、右膝、右踝定义为主关节；将人形机器人主关节所具有的不同自由度定义为该主关节的次关节；将靠近支撑脚的主关节或次关节定义为远离支撑脚的主关节或次关节的母关节，将远离支撑脚的主关节或次关节定义为靠近支撑脚的主关节或次关节的子关节；将与一个关节相连的两个连杆中靠近支撑脚的连杆定义为该关节的母连杆，远离支撑脚的连杆定义为该关节的子连杆；将与一个连杆相连的两个关节中靠近支撑脚的关节定义为该连杆的母关节，远离支撑脚的关节定义为该连杆的子关节；S42、令初始姿态时人形机器人第k个连杆向量在机器人观测坐标系中的坐标为k＝1，2，3，4，5…，根据每个连杆各母关节的旋转角度θmki及相应旋转矩阵R(θmki)，以及支撑脚坐标系相对于机器人观测坐标系的旋转矩阵Rsupport，得到当前姿态的连杆向量在机器人观测坐标系中的坐标其中，n为目标连杆到支撑脚连杆之间目标连杆的母关节个数，i的数值越小表示该关节在连杆-关节链中越靠近支撑脚连杆；若旋转角度θmki为翻滚角的旋转角度，则旋转矩阵R(θmki)表达式为：若旋转角度θmki为俯仰角的旋转角度，则旋转矩阵R(θmki)表达式为：若旋转角度θmki为偏航角的旋转角度，则旋转矩阵R(θmki)表达式为：作为优选的技术方案，步骤S5中，具体过程如下：人类观测坐标系和机器人观测坐标系经过旋转平移重合，统一为一个坐标系，并使人体骨骼模型连杆向量进行与人类观测坐标系相同的旋转平移，使人形机器人连杆向量进行与机器人观测坐标系相同的旋转平移；利用人体骨骼模型连杆向量和相应人形机器人连杆向量的夹角的余弦值计算两连杆姿态的相关系数：其中，为在人类观测坐标系中的人体骨骼模型第k个连杆向量，为在机器人观测坐标系中的人形机器人第k个连杆向量；计算各组连杆相关系数的算术平均值，得到人形机器人动作模仿的相似度指标：其中K表示人形机器人或人体骨骼模型的连杆总数。作为优选的技术方案，人体骨骼模型和人形机器人两者的连杆向量方向在初始姿态时相互一致。作为优选的技术方案，步骤S41中，在同一条连杆-关节链中，采用衡量连杆或关节与支撑脚的距离；当人形机器人处于双腿支撑状态时，选取一只支撑脚作为计算参考的支撑脚。作为优选的技术方案，步骤S42中，将人形机器人的初始姿态定义为支撑脚坐标系与相应的机器人观测坐标系重合或相互平行，双臂竖直下垂的直立姿态；其中，所述机器人观测坐标系为右手坐标系。本专利技术相对于现有技术具有如下的优点和效果：1、本专利技术使用定量评价方法，可以得到机器人姿态与人体姿态相似度的精确量化指标。2、本专利技术使用连杆向量对机器人与人体的姿态进行表征是更加充分而有效的，由此可以得到更为准确的姿态相似度评价。3、本专利技术利用人体骨骼模型或机器人连杆在相应人类或机器人观测坐标系中的连杆向量，可以有效评价整体姿态相似度。4、本专利技术根据实际观测角度定义观测坐标系，可从不同观测角度评价姿态相似度，具有灵活性和普适性。附图说明图1是本实施例的一种人形机器人与人体姿态相似度评价方法的流程图；图2是本实施例由KinectII获取的人体骨骼节点名称及编号示意图；图3(a)和图3(b)分别是本实施例的Nao机器人、人体骨骼模型全身关节和连杆向量示意图。具体实施方式为使本专利技术实施例的目的、技术方案和优点更加清楚，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。实施例一种人形机器人与人体姿态相似度评价方法，使用KinectII作为深度摄像头，使用Nao机器人作为人形机器人，如图1所示，该方法具体包括下述步骤：S1、通过KinectII深度摄像头获取人体骨骼节点的三维位置信息，包括人体的四肢和脊柱各关节点的信息，各骨骼节点名称及编号如图2所示；S2、如图3(b)所示，根据人体骨骼节点构建人体骨骼模型的连杆向量；将人体骨骼模型的躯干、头部、左上臂、左下本文档来自技高网...

【技术保护点】
1.一种人形机器人与人体姿态相似度评价方法，其特征在于，包括下列步骤：S1、通过深度摄像头获取人体骨骼节点的三维位置信息；S2、根据步骤S1获得的人体骨骼节点构建人体骨骼模型的连杆向量；S3、将步骤S2获得的人体骨骼模型各连杆向量在深度摄像头坐标系中的坐标转换到人类观测坐标系中；S4、定义人形机器人全身关节和连杆，根据人形机器人各关节角度及支撑脚姿态计算人形机器人各连杆向量在机器人观测坐标系中的坐标；S5、根据步骤S3获得的人体骨骼模型连杆向量在人类观测坐标系中的坐标和步骤S4获得的人形机器人连杆向量在机器人观测坐标系中的坐标计算人形机器人与人体姿态的相似度。

【技术特征摘要】
1.一种人形机器人与人体姿态相似度评价方法，其特征在于，包括下列步骤：S1、通过深度摄像头获取人体骨骼节点的三维位置信息；S2、根据步骤S1获得的人体骨骼节点构建人体骨骼模型的连杆向量；S3、将步骤S2获得的人体骨骼模型各连杆向量在深度摄像头坐标系中的坐标转换到人类观测坐标系中；S4、定义人形机器人全身关节和连杆，根据人形机器人各关节角度及支撑脚姿态计算人形机器人各连杆向量在机器人观测坐标系中的坐标；S5、根据步骤S3获得的人体骨骼模型连杆向量在人类观测坐标系中的坐标和步骤S4获得的人形机器人连杆向量在机器人观测坐标系中的坐标计算人形机器人与人体姿态的相似度。2.根据权利要求1所述的人形机器人与人体姿态相似度评价方法，其特征在于，步骤S1中，所述通过深度摄像头获取人体骨骼节点的三维位置信息，包括人体的四肢和脊柱各关节点的信息。3.根据权利要求1所述的人形机器人与人体姿态相似度评价方法，其特征在于，步骤S2，具体过程如下：将人体骨骼模型的躯干、头部、左上臂、左下臂、左手、左大腿、左小腿、左脚、右上臂、右下臂、右手、右大腿、右小腿、右脚定义为连杆；根据同一连杆的两个骨骼节点的三维坐标，得到该连杆在深度摄像头坐标系中的向量坐标。4.根据权利要求1所述的人形机器人与人体姿态相似度评价方法，其特征在于，步骤S3中，利用转换矩阵Rh将深度摄像头坐标系中人体骨骼模型的连杆向量坐标转换到人类观测坐标系中，转换矩阵Rh为：其中，分别为在深度摄像头坐标系中与深度摄像头坐标系X轴、Y轴、Z轴正向同向的向量，分别为在深度摄像头坐标系中与人类观测坐标系X轴、Y轴、Z轴正向同向的向量。5.根据权利要求1所述的人形机器人与人体姿态相似度评价方法，其特征在于，步骤S4中，包括下述步骤：S41、定义人形机器人全身关节和连杆：将人形机器人的躯干、头部、左上臂、左下臂、左手、左大腿、左小腿、左脚、右上臂、右下臂、右手、右大腿、右小腿、右脚定义为连杆；将靠近支撑脚的连杆定义为远离支撑脚的连杆的母连杆；将远离支撑脚的连杆定义为靠近支撑脚的连杆的子连杆；将颈部、左肩、左肘、左腕、左髋、左膝、左踝、右肩、右肘、右腕、右髋、右膝、右踝定义为主关节；将人形机器人主关节所具有的不同自由度定义为该主关节的次关节；将靠近支撑脚的主关节或次关节定义为远离支撑脚的主关节或次关节的母关节，将远离支撑脚的主关节或次关节定义为靠近支撑脚的主关...

【专利技术属性】
技术研发人员：张智军，牛雅儒，王浩，
申请(专利权)人：华南理工大学，
类型：发明
国别省市：广东,44