申请/专利权人：江西求是高等研究院

申请日：2023-12-21

公开（公告）日：2024-03-01

公开（公告）号：CN117428791B

主分类号：B25J9/16

分类号：B25J9/16;A61H1/02;G06F17/16

优先权：

专利状态码：有效-授权

法律状态：2024.03.01#授权;2024.02.09#实质审查的生效;2024.01.23#公开

摘要：本发明提供了一种用于肩部四轴康复机器人的逆运动学求解方法及系统，所述方法包括建立D‑H坐标系模型，求解肩部四轴康复机器人的D‑H参数；基于D‑H参数确定通用齐次变换矩阵；基于通用齐次变换矩阵确定相对矩阵；确定肩关节点、肘关节点与腕关节点以及二维坐标，基于二维坐标求解关节点的关节变量；根据关节点的关节变量与相对矩阵确定肩部四轴康复机器人的位置与姿态，本发明可在只给定末端执行器位置的情况下实现精准且快速的对肩部四轴康复机器人的位置与姿态进行求解，以便于肩部四轴康复机器人的使用与观测。

主权项：1.一种用于肩部四轴康复机器人的逆运动学求解方法，所述肩部四轴康复机器人包括基座以及设置在所述基座上的若干关节连杆，若干所述关节连杆依次首尾连接，相邻俩所述关节连杆之间、所述基座与所述关节连杆之间均设有关节点，其特征在于，包括：建立基于所述肩部四轴康复机器人的D-H坐标系模型，基于所述D-H坐标系模型求解所述肩部四轴康复机器人的各所述关节连杆与各所述关节点的D-H参数；基于各所述关节连杆与各所述关节点的D-H参数确定相邻两所述关节点之间的通用齐次变换矩阵；基于所述通用齐次变换矩阵确定末端执行器相对于基座坐标系的相对矩阵；确定所述肩部四轴康复机器人的肩关节点、肘关节点与腕关节点以及所述肩关节点、所述肘关节点与腕关节点的二维坐标，基于所述肩关节点、所述肘关节点与腕关节点的二维坐标求解所述关节点的关节变量；根据所述关节点的关节变量与所述相对矩阵确定所述肩部四轴康复机器人的位置与姿态；在所述基于各所述关节连杆与各所述关节点的D-H参数确定相邻两所述关节点之间的通用齐次变换矩阵的步骤中，所述通用齐次变换矩阵为： ；式中，表示第个关节点与第个关节点之间的通用齐次变换矩阵，为第个关节点对应的关节变量，为第个关节点与第个关节点之间的距离，、分别为第个关节点、第个关节点的扭角，为第个关节点的偏距；在所述基于所述通用齐次变换矩阵确定末端执行器相对于基座坐标系的相对矩阵的步骤中，所述相对矩阵为： ； 为末端执行器相对于基座坐标系的相对矩阵，、、、、、分别表示第一个关节点相对于基座坐标系、第二个关节点相对于第一个关节点、第三个关节点相对于第二个关节点、第四个关节点相对于第三个关节点、第五个关节点相对于第四个关节点、末端执行器相对于第五个关节点的通用齐次变换矩阵，、、表示末端执行器的x轴在基座坐标系下的投影，、、表示末端执行器的y轴在基座坐标系下的投影，、、表示末端执行器的z轴在基座坐标系下的投影，、、表示末端执行器相对于基座坐标系的位置；所述确定所述肩部四轴康复机器人的肩关节点、肘关节点与腕关节点以及所述肩关节点、所述肘关节点与腕关节点的二维坐标，基于所述肩关节点、所述肘关节点与腕关节点的二维坐标求解所述关节点的关节变量的步骤包括：将末端执行器所对应的关节点作为腕关节点C，将与末端执行器通过关节连杆连接的关节点作为肘关节点B，将其余关节点作为肩关节点A；在所述腕关节点C与所述肩关节点A之前确定中间点O，以使直线OB垂直于直线AC，在所述肘关节点B后方确定一辅助点P，以使所述肘关节点B、所述肩关节点A与所述辅助点P共面；将所述中间点O、所述肘关节点B投影到直线AC所在的平面上，并确定所述肩关节点A、所述肘关节点B与所述腕关节点C的二维坐标；基于所述肩关节点A、所述肘关节点B与所述腕关节点C的二维坐标，确定所述肩关节点A的三维坐标；基于所述肩关节点A的三维坐标求解所述关节点的关节变量；在所述确定所述肩关节点A、所述肘关节点B与所述腕关节点C的二维坐标的步骤中，所述肩关节点A的二维坐标为： ；所述肘关节点B的二维坐标为： ；所述腕关节点C的二维坐标为： ；式中，为所述肩关节点A与所述肘关节点B之间的距离，为所述肘关节点B与所述腕关节点C之间的距离，为所述肩关节点A与所述腕关节点C之间的距离；所述基于所述肩关节点A、所述肘关节点B与所述腕关节点C的二维坐标，确定所述肩关节点A的三维坐标的步骤包括：确定中间点O在设定三维空间中的三维坐标： ；式中，为由腕关节点C指向肩关节点A的向量，为肩关节点A的三维坐标；确定所述中间点O在设定三维空间内的三维朝向： ； ； ；式中，、、分别为所述中间点O在设定三维空间内的x轴朝向、y轴朝向、Z轴朝向，为由肩关节点A指向腕关节点C的向量，为由辅助点P指向腕关节点C的向量，为向量的模；基于所述中间点O在设定三维空间内的三维朝向确定二维空间的中心点O相对于设定三维空间的变换矩阵： ；式中，、、分别为投影在x、y、z轴上的距离，、、分别为投影在x、y、z轴上的距离，、、分别为投影在x、y、z轴上的距离，、、分别为投影在x、y、z轴上的距离；基于所述变换矩阵确定所述肩关节点A的三维坐标： ；所述基于所述肩关节点A的三维坐标求解所述关节点的关节变量的步骤包括：将所述肩关节点A的三维坐标进行转化，以得到设定三维坐标，将所述肩关节点A的设定三维坐标进行第一次分解： ； ； ； ；式中，分别为肩关节点A的x轴、y轴、z轴坐标，、、分别表示第一个关节点相对于基座坐标系、第二个关节点相对于第一个关节点、第三个关节点相对于第二个关节点的通用齐次变换矩阵，、、分别为第三个关节点对应的关节变量的第一函数、第二函数、第三函数，为第三个关节点与第四个关节点之间的距离，为第三个关节点的扭角，为第四个关节点的偏距；对所述肩关节点A的设定三维坐标进行第二次分解： ； ； ； ；式中，、分别为第一个、第二个关节点对应的关节变量，、、分别为的第一函数、第二函数、第三函数，为第一个关节点的偏距；设定为一个范围在的已知量，并基于两次分解后的设定三维坐标的坐标以及求解各个关节点的关节变量： ； ； ； ；式中，为由第三关节点与第四关节的连接中点指向肩关节点A的向量，为由肩关节点A指向肘关节点B的向量，为由肘关节点B指向腕关节点C的向量。

全文数据：

权利要求：

百度查询： 江西求是高等研究院 一种用于肩部四轴康复机器人的逆运动学求解方法及系统

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD