买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网恭喜广东省科学院智能制造研究所申请的专利一种抗噪与动力学约束的机器人实时运动规划方法及装置获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN112873208B 。

龙图腾网通过国家知识产权局官网在2024-09-17发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202110125245.7，技术领域涉及：B25J9/16；该发明授权一种抗噪与动力学约束的机器人实时运动规划方法及装置是由徐智浩;李晓晓;吴鸿敏;周雪峰;苏泽荣;唐观荣设计研发完成，并于2021-01-29向国家知识产权局提交的专利申请。

本一种抗噪与动力学约束的机器人实时运动规划方法及装置在说明书摘要公布了：本发明公开了一种抗噪与动力学约束的机器人实时运动规划方法及装置，其中，所述方法包括：读取当前时刻机器人的关节角度、关节角速度的反馈；基于当前的关节角和关节角加速度与机器人的惯性矩阵、哥矢力与离心力矩阵和重力矩推导当前角加速度的上下限；获得机器人的期望轨迹，计算机器人的跟踪误差及其对应的导数；在机器人的控制系统存在噪声情况下，设置机器人在实现轨迹跟踪时的加速度等式约束条件；计算机器人角加速度以及辅助变量的变化率；基于机器人角加速度以及辅助变量的变化率更新机器人的角加速度指令。在本发明实施例中，能够在控制系统存在噪声的情况下，实现机器人末端对期望轨迹的高精度轨迹跟踪。

本发明授权一种抗噪与动力学约束的机器人实时运动规划方法及装置在权利要求书中公布了：1.一种抗噪与动力学约束的机器人实时运动规划方法，其特征在于，所述方法包括：读取当前时刻机器人的关节角度、关节角速度的反馈，获得机器人的关节角度和关节角加速度；基于当前的关节角度和关节角加速度与所述机器人的惯性矩阵、哥矢力与离心力矩阵和重力矩阵推导当前角加速度的上下限；同时，获得所述机器人的期望轨迹，基于所述期望轨迹计算所述机器人的跟踪误差及其对应的导数；在所述机器人的控制系统存在噪声情况下，基于所述跟踪误差及其对应的导数设置所述机器人在实现轨迹跟踪时的加速度等式约束条件；基于所述当前角加速度的上下限和所述加速度等式约束条件计算机器人角加速度以及辅助变量的变化率；基于机器人角加速度以及辅助变量的变化率更新所述机器人的角加速度指令；所述方法还包括：建立机器人数学模型，并基于机器人当前的关节角度、关节角速度、关节角加速度以及关节力矩的约束建立机器人的物理约束模型；基于所述机器人数学模型及所述物理约束模型建立与角加速度相关的综合物理不等式模型；所述机器人数学模型如下： 所述物理约束模型如下： 所述综合物理不等式模型如下： 其中k1、k2、均为正控制常数；所述加速度等式约束条件如下： 其中，α、β、γ均为正控制常数；e为机器人对期望轨迹的跟踪误差，e＝r-rd，为e的一阶导数，r为机器人的实际轨迹，rd为机器人的期望轨迹；t表示时间；所述基于所述当前角加速度的上下限和所述加速度等式约束条件计算机器人角加速度以及辅助变量的变化率，还包括：建立所述加速度等式约束条件和综合物理不等式模型与加速度优化指标的问题描述模型；基于所述问题描述模型在迭代的机器人控制器求解模型中进行方案求解，获得机器人角加速度以及辅助变量的变化率；所述问题描述模型如下： 其中，为的转置；θ为机器人关节角度；fθ为机器人的前向运动学模型；为r的一阶导数，为r的二阶导数；为θ的一阶导数，表示机器人关节角速度，为θ的二阶导数，表示机器人关节角加速度；J表示机器人的雅克比矩阵；为J的一阶导数；τ为机器人的关节力矩；M、C、G分别为机器人的惯性矩阵、哥矢力与离心力矩阵和重力矩阵；θ-表示θ下限，θ+表示θ上限；表示下限，表示上限；表示下限，表示上限；τ-表示τ下限，τ+表示τ上限。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人广东省科学院智能制造研究所，其通讯地址为：510075 广东省广州市先烈中路100号大院15号楼；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。