[发明专利]一种面向背抱式移乘护理机器人的人体姿势识别系统

摘要

本发明为一种面向背抱式移乘护理机器人的人体姿势识别系统，该系统通过放置于护理机器人与使用者接触部分的气囊式压力传感器阵列实时采集人机交互时产生的各个分区的压力分布及变化信息，同时在机器人上位机建立人机力学解算模型，将采集到的压力信息与力学模型结合解算出使用者实时的身体姿态，将身体姿态信息作为控制依据调整机器人姿态达到保证使用者安全舒适的目的。本发明可以实现在低成本的情况下简单、无束缚、准确的数据获取，并将人体姿势信息作为控制依据驱动机器人进行运动调整保证使用者的舒适安全性。

主权项

1.一种面向背抱式移乘护理机器人的人体姿势识别系统，该系统包括气囊式压力传感器阵列、足底压力传感器与护理机器人，所述足底压力传感器置于护理机器人放置人体双脚的踏板上；所述护理机器人采用背抱式的方式将被护理者进行位置的移动，包括机器人本体、上位机、机器人运动控制器，机器人本体包含移动部分和背抱部分，背抱部分由电动缸驱动机械臂和胸部靠板实现机器人机械臂的位置及胸部靠板角度变化将被护理者背抱起身，胸部靠板的空间位置的移动由机械臂绕机器人底盘处转动及机械臂自身的转动实现，胸部靠板的转动由机械臂与胸部靠板之间的电动缸实现；该系统采用以下步骤：S1.信息采集与处理：护理机器人与人体接触的部分为胸部靠板，将人体上肢分为上胸、下胸、上腹和下腹四个部分，上胸、下胸、上腹和下腹的质心分别记为A、B、C和D，气囊式压力传感器阵列铺设在护理机器人胸部靠板上，气囊式压力传感器阵列设有四个独立工作的传感单元，每个传感单元对应检测上述的一个质心位置所受压力；气囊式压力传感器阵列连接护理机器人的上位机，通过数据采集卡将数据传送到上位机中；S2.构建护理机器人姿态与人体上肢重量分配的人机力学解算模型：通过在上位机中构建护理机器人姿态与人体重量分配的人机力学解算模型得到在护理机器人在任意姿态下使用者身体与护理机器人接触时不同部位所产生的压力，具体步骤如下：以护理机器人机械臂与机器人底盘相接部位为坐标原点O，以地面以上为Y方向正方向，水平方向人体所在方向为X方向正方向，建立直角坐标系；护理机器人胸部靠板与X方向的夹角记为θ_m，人体上肢四部分与水平夹角分别为θ_h1、θ_h2、θ_h3和θ_h4，气囊式压力传感器阵列对应的四个传感单元的压力值分别为F₁、F₂、F₃和F₄；根据人体上肢姿态受力关系满足公式(1)‑(8)：f₁×cos(θ_h1‑θm)+F₁×sin(θ_h1‑θm)+F_1i+G₁×sinθ_h1＝0   (1)G₁+F_1i×sinθ_h1+F₁×cosθ_m+f₁×sinθ_m＝0   (2)f₂×cos(θ_h2‑θm)+F₂×sin(θ_h2‑θm)+F_2i+G₂×sinθ_h2＝0   (3)G₂+F_2i×sinθ_h2+F₂×cosθ_m+f₂×sinθ_m＝0   (4)f₃×cos(θ_h3‑θm)+F₃×sin(θ_h3‑θm)+F_3i+G₃×sinθ_h3＝0   (5)G₃+F_3i×sinθ_h3+F₃×cosθ_m+f₃×sinθ_m＝0   (6)f₄×cos(θ_h4‑θm)+F₄×sin(θ_h4‑θm)+F_4i+G₄×sinθ_h4＝0   (7)G₄+F_4i×sinθ_h4+F₄×cosθ_m+f₄×μ×sinθ_m＝0    (8)其中，f₁、f₂、f₃和f₄分别为人体上肢四部分分别所受摩擦力，其值f＝F×μ，μ为胸部靠板材料的摩擦系数，则f₁＝F₁×μ、f₂＝F₂×μ、f₃＝F₃×μ、f₄＝F₄×μ；θ_m由机器人控制器求得；G₁、G₂、G₃和G₄分别为人体上肢四部分所受重力，F_1i、F_2i、F_3i和F_4i分别为记上胸、下胸、上腹和下腹所受内力，人体双腿与双脚占人体总重的34.5％，则F_1iF_2i、F_3i和F_4i的值通过公式(9)‑(12)求得：式中，Fs为足底压力；根据气囊式压力传感器阵列的数值变化通过对上述方程(1)‑(12)进行联立求解在上位机中得到人体上肢四部分与水平夹角分别为θ_h1、θ_h2、θ_h3和θ_h4，从而识别人体上肢姿势；根据人体姿势识别结果与预先设置的人体舒适姿势进行对比，将两者的差值作为控制目标带入给机器人运动控制器，使护理机器人运动并将人体姿态调整到合理位置。