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

申请/专利权人：广东省科学院智能制造研究所

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

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

全文数据：

权利要求：

百度查询： 广东省科学院智能制造研究所 一种抗噪与动力学约束的机器人实时运动规划方法及装置