CN116985184B - 基于模型预测的机器人自碰撞检测方法、系统及机器人 - Google Patents
基于模型预测的机器人自碰撞检测方法、系统及机器人 Download PDFInfo
- Publication number
- CN116985184B CN116985184B CN202311257313.0A CN202311257313A CN116985184B CN 116985184 B CN116985184 B CN 116985184B CN 202311257313 A CN202311257313 A CN 202311257313A CN 116985184 B CN116985184 B CN 116985184B
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- information
- coordinate system
- motion state
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 55
- 238000000034 method Methods 0.000 claims abstract description 21
- 238000011217 control strategy Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 31
- 230000001133 acceleration Effects 0.000 claims description 28
- 230000009466 transformation Effects 0.000 claims description 27
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000004422 calculation algorithm Methods 0.000 abstract description 12
- 238000010586 diagram Methods 0.000 description 9
- 238000004590 computer program Methods 0.000 description 7
- 238000003860 storage Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 230000006870 function Effects 0.000 description 4
- 239000012636 effector Substances 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及机器人控制技术领域，公开了基于模型预测的机器人自碰撞检测方法、系统及机器人，方法包括：获取机器人各关节的第一运动状态信息；依据第一运动状态信息，预测机器人各关节在预设控制周期次数之后的第二运动状态信息；依据第二运动状态信息，得到机器人各关节包络模型的空间位姿信息；基于空间位姿信息，判断机器人各关节在预设控制周期次数之后是否发生碰撞，并依据碰撞判断结果对应调整机器人各关节的运动控制策略。通过对机器人当前状态进行检测，基于动力学模型预测后续运动状态，克服了现有阈值设定过大或过小导致的问题，提高了碰撞检测精度，算法具有较好实时性。
Description
技术领域
本发明涉及机器人控制技术领域，特别涉及一种基于模型预测的机器人自碰撞检测方法、系统及机器人。
背景技术
仿人机械臂或者机器人的自碰撞的发生会对安全造成很大威胁，可能损坏机械臂机器人，甚至伤到周围的人员。随着机械臂/机器人自由度的增加，其发生自碰撞的可能性也将增大，因此解决这个问题对于拥有多自由度的机械臂或者机器人是至关重要的，也是机械臂或者机器人安全控制和执行任务的基础。
当前，机器人自碰撞检测的实现主要有两种：（1）基于电流或力矩的检测方法；（2）基于几何模型的检测方法。首先，基于电流或力矩的检测方法，如CN112549024 B、CN116476043A等专利，是通过检测电流或力矩的激增来判断是否有碰撞发生，且易出现误判，当检测到碰撞时，碰撞已经发生，存在设备损坏的风险。其次，基于几何模型的检测方法，是通过某些包络模型将机器人各部件包络起来，通过检测各包络模型的最小距离来判断是否发生碰撞，当最小距离小于设定的阈值时，则判定发生碰撞，如CN 116394266 A、CN111546378 B、CN 111360824 B等均采用此类方法进行自碰撞检测。而上述基于几何模型的检测方法，基于阈值的判断逻辑存在一定缺陷：当阈值设置过小时，碰撞报警后机器人来不及减速；当阈值设置过大时，会导致机器人可达工作空间缩小，且当最小距离在阈值以内但此时没有碰撞发生时，会发生碰撞误判；此外，固定的阈值设置无法满足所有运动状态下的减速。此外，专利CN 103722565 B预测模型无法体现机器人的动力学特性，因此预测精度较低。
发明内容
本发明实施例的目的是提供一种基于模型预测的机器人自碰撞检测方法、系统及机器人，通过对机器人当前状态进行检测，基于动力学模型预测后续运动状态信息，摒弃了现有的阈值判断逻辑，克服了阈值设定过大或过小导致的问题，提高了机器人碰撞检测的精度，算法具有较好的实时性。
为解决上述技术问题，本发明实施例的第一方面提供了一种基于模型预测的机器人自碰撞检测方法，包括如下步骤：
获取机器人各关节的第一运动状态信息，所述第一运动状态信息包括：当前位置信息、当前速度信息、当前驱动力矩信息和当前加速度信息；
依据所述第一运动状态信息，预测所述机器人各关节在预设控制周期次数之后的第二运动状态信息；
依据所述第二运动状态信息，得到所述机器人各关节包络模型的空间位姿信息；
基于所述空间位姿信息，预判所述机器人各关节在所述预设控制周期次数之后是否发生碰撞，并依据碰撞判断结果对应调整所述机器人各关节的运动控制策略。
进一步地，所述获取机器人各关节的第一运动状态信息，包括：
获取所述机器人各关节的当前位置信息、当前速度信息和当前驱动力矩信息；
基于所述当前位置信息、所述当前速度信息和所述当前驱动力矩信息，计算所述机器人各关节的当前加速度信息。
进一步地，所述机器人各关节的加速度信息的计算公式为：
；
其中，为机器人各关节单元驱动力矩，/>为机器人惯性参数矩阵，/>为科氏力及离心力项，/>为重力矩，/>为摩擦力项，/>为关节的位置，/>为关节速度，/>为关节的加速度。
进一步地，所述预测所述机器人各关节在预设控制周期次数之后的第二运动状态信息，包括：
依据所述机器人各关节的第一运动状态信息中的当前加速度信息，计算所述机器人各关节在每次控制周期之后的速度信息；
通过所述预设控制周期次数次的迭代计算，得到所述机器人各关节在预设控制周期次数之后预测的速度信息和位置信息；
依据速度信息和位置信息，得到所述机器人各关节的第二运动状态信息。
进一步地，所述机器人各关节在每次移动之后的速度信息的计算公式为：
在所述机器人第k步时的加速度为：
；
则第k+1步时，所述机器人的速度信息和位置信息/>为：
；
其中，为程序执行周期。
进一步地，所述依据所述第二运动状态信息，得到所述机器人各关节包络模型的空间位姿信息，包括：
依据所述第二运动状态信息，基于正向运动学计算所述机器人各关节相对于基坐标系的齐次变换矩阵。
进一步地，所述机器人各关节相对于基坐标系的齐次变换矩阵为：
；
；
其中，为第i个关节相对于基坐标系的齐次变换矩阵，/>、/>、/>分别为关节i上的点在坐标系i中的笛卡尔空间坐标值，/>为关节1角度为/>时基坐标系到坐标系1的齐次变换矩阵，/>为关节2角度为/>时坐标系1到坐标系2的齐次变换矩阵，/>为关节i角度为/>时坐标系i-1到坐标系i的齐次变换矩阵，i为所述机器人由底座至末端方向的各关节序号，坐标系i为所述关节i的坐标系，基坐标系为机器人底座的坐标系。
相应地，本发明实施例的第二方面提供了一种基于模型预测的机器人自碰撞检测系统，包括：
运动状态预测模块和自碰撞检测模块；
所述运动状态预测模块包括：
运动状态获取单元，其用于实时获取机器人各关节的第一运动状态信息；
状态积分器单元，其用于依据所述第一运动状态信息，获取所述机器人各关节在预设控制周期次数之后的第二运动状态信息，依据所述第二运动状态信息得到所述机器人各关节包络模型的空间位姿信息；
所述自碰撞检测模块包括：
自碰撞检测单元，其用于基于所述空间位姿信息，判断所述机器人各关节在所述预设控制周期次数之后是否发生碰撞；
碰撞反应单元，其用于依据碰撞判断结果对应调整所述机器人各关节的运动控制策略。
相应地，本发明实施例的第三方面提供了一种电子设备，包括：至少一个处理器；以及与所述至少一个处理器连接的存储器；其中，所述存储器存储有可被所述一个处理器执行的指令，所述指令被所述一个处理器执行，以使所述至少一个处理器执行如上述任一所述基于模型预测的机器人自碰撞检测方法。
相应地，本发明实施例的第四方面提供了一种计算机可读存储介质，其上存储有计算机指令，该指令被处理器执行时实现上述任一所述基于模型预测的机器人自碰撞检测方法。
相应地，本发明实施例的第五方面提供了一种带有多关节机械臂的机器人，所述机器人至少包括一个机械臂，每个所述机械臂至少包括3个关节，所述机器人还包括：
上述基于模型预测的机器人自碰撞检测系统；和/或，
上述电子设备及计算机可读存储介质。
本发明实施例的上述技术方案具有如下有益的技术效果：
通过对机器人当前状态进行检测，基于动力学模型预测后续运动状态信息，摒弃了现有的阈值判断逻辑，克服了阈值设定过大或过小导致的问题，提高了机器人碰撞检测的精度，算法具有较好的实时性。
附图说明
图1是本发明实施例提供的基于模型预测的机器人自碰撞检测方法流程图；
图2是本发明实施例提供的运动状态预测模块框图；
图3是本发明实施例提供的自碰撞检测模块框图；
图4是本发明实施例提供的状态积分器单元计算原理图。
附图标记：
200、运动状态预测模块，201、运动状态获取单元，202、动力学计算单元，203、状态积分器单元，300、自碰撞检测模块，301、自碰撞检测单元，302、碰撞反应单元，303、轨迹重规划单元。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了，下面结合具体实施方式并参照附图，对本发明进一步详细说明。应该理解，这些描述只是示例性的，而并非要限制本发明的范围。此外，在以下说明中，省略了对公知结构和技术的描述，以避免不必要地混淆本发明的概念。
请参照图1，本发明实施例的第一方面提供了一种基于模型预测的机器人自碰撞检测方法，包括如下步骤：
步骤S100，获取机器人各关节的第一运动状态信息，第一运动状态包括：当前位置信息、当前速度信息、当前驱动力矩信息和当前加速度信息。
步骤S200，依据第一运动状态信息，预测机器人各关节在预设控制周期次数之后的第二运动状态信息。
步骤S300，依据第二运动状态信息，得到机器人各关节包络模型的空间位姿信息。
步骤S400，基于空间位姿信息，预判机器人各关节在预设控制周期次数之后是否发生碰撞，并依据碰撞判断结果对应调整机器人各关节的运动控制策略。
上述技术方案通过对机器人当前状态进行检测，基于动力学模型预测后续运动状态信息，摒弃了现有的阈值判断逻辑，克服了阈值设定过大或过小导致的问题，提高了机器人碰撞检测的精度，算法具有较好的实时性。
具体的，步骤S100中的获取机器人各关节的第一运动状态信息，包括：
步骤S110，获取机器人各关节的当前位置信息、当前速度信息和当前驱动力矩信息。
步骤S120，基于当前位置信息、当前速度信息和当前驱动力矩信息，计算机器人各关节的当前加速度信息。
通常情况下，机器人的各类运动状态信息可以通过各种设置于机器人上的传感器来获取。常见的传感器包括：编码器、IMU、力传感器及设置于机器人和周边环境中的多个视觉传感器。其中，编码器（Encoder）：用于测量每个关节的位置和速度信息。编码器通常安装在关节的电机轴上，通过记录电机转动的脉冲数或位置来测量关节的位置和速度。IMU（Inertial Measurement Unit）：用于测量机器人的加速度和角速度。IMU由加速度计和陀螺仪组成，可以提供关节的加速度和角速度信息。力传感器（Force Sensor）：用于测量机器人在运动过程中所受到的力和力矩。力传感器通常安装在机器人的末端执行器上，可以测量末端执行器施加到物体上的力和力矩。视觉传感器（Vision Sensor）：例如摄像头或深度相机，可以用于获取机器人周围环境中物体的位置和姿态信息，从而间接获取机器人关节的位置信息。
进一步地，机器人各关节的当前加速度信息的计算公式为：
； （1）
其中，为机器人各关节单元驱动力矩，/>为机器人惯性参数矩阵，/>为科氏力及离心力项，/>为重力矩，/>为摩擦力项，/>为关节的位置，/>为关节速度，/>为关节的加速度。上述参数为机器人各关节检测得到的位置信息、速度信息和驱动力矩信息。
由上述公式（1）可以得到，在机器人第k步时的加速度为：
； （2）
则第k+1步时，机器人的运动状态可以预测得到：
； （3）
其中，为程序执行周期。
具体的，步骤S200中的预测机器人各关节在预设控制周期次数之后的第二运动状态信息，包括：
步骤S210，依据机器人各关节的第一运动状态信息中的当前加速度信息，计算机器人各关节在每次移动之后的速度信息。
步骤S220，通过预设控制周期次数次的迭代计算，得到机器人各关节在预设控制周期次数之后预测的速度信息和位置信息。
步骤S230，依据速度信息和位置信息，得到机器人各关节的预测运动状态信息。
通过状态积分器单元所进行的迭代计算后，机器人在第k+n步的运动状态如式（4）所示：
； （4）
其中，n为机器人移动的预设控制周期次数值。
具体的，步骤S300中的依据第二运动状态信息，得到机器人各关节包络模型的空间位姿信息，包括：
步骤S310，依据第二运动状态信息，基于正向运动学计算机器人各关节相对于基坐标系的齐次变换矩阵。
进一步地，机器人各关节相对于基坐标系的齐次变换矩阵为：
； （5）
； （6）
其中，为第i个关节相对于基坐标系的齐次变换矩阵，/>、/>、/>分别为关节i上的点在坐标系i中的笛卡尔空间坐标值，/>为关节1角度为/>时基坐标系到坐标系1的齐次变换矩阵，/>为关节2角度为/>时坐标系1到坐标系2的齐次变换矩阵，/>为关节i角度为/>时坐标系i-1到坐标系i的齐次变换矩阵，i为所述机器人由底座至末端方向的各关节序号，坐标系i为所述关节i的坐标系，基坐标系为机器人底座的坐标系。
具体的，以关节2部件为例，其正向运动学可被描述为：
； （7）
式中，为关节1角度为/>时基坐标系到坐标系1的齐次变换矩阵，/>为关节2角度为/>时坐标系1到坐标系2的齐次变换矩阵，/>为基坐标系到坐标系2的齐次变换矩阵。
定义关节2部件上的点为：
； （8）
式中，、/>、/>分别为关节2部位上的点在坐标系2中的笛卡尔空间坐标值。
那么在基系中可以被描述为：
； （9）
式中，为关节2部件上的点/>在对应位形下基坐标系中的描述。
同理，关节6部件在对应位形下基坐标系中的描述为：
。 （10）
具体的，步骤S400中的判断机器人各关节在预设控制周期次数之后是否发生碰撞，包括：
步骤S400，基于图形碰撞检测算法，判断机器人各关节在预设控制周期次数之后是否发生碰撞。
具体的，图形碰撞检测算法是一种用于判断两个或多个图形是否发生碰撞的技术。具体的图形碰撞检测算法可以包括：1.AABB碰撞检测（Axis-Aligned Bounding Box）：该算法将图形包围在一个与坐标轴对齐的矩形框中，然后通过判断矩形框是否相交来快速判断碰撞。它适用于矩形、圆形等简单形状的碰撞检测。2.方向包围盒（Oriented BoundingBox，OBB）是一种用于包围和表示一个物体或模型的三维轴对齐矩形框。与轴对齐包围盒（Axis-Aligned Bounding Box，AABB）不同，OBB 可以沿任意方向旋转，并且与物体的长宽高相匹配。OBB 在许多3D计算机图形和碰撞检测领域都得到广泛应用。在图形计算中，OBB可用于包围复杂的三维模型，用于快速检测碰撞、遮挡关系计算和简化物体边界。OBB 的形状可以更好地适应物体的几何形状，提供了更精确的包围盒，在某些情况下比 AABB 更有效。算法上，可以使用线性代数的方法计算和更新 OBB 的属性，另外还有一些优化策略可以加速 OBB 的构建和更新过程。
在本发明技术方案中，上述AABB算法和OBB算法仅用来表示可选的选项，其它的图像碰撞检测算法只要可以实现上述机器人的碰撞检测，即落入本发明的保护范围。
相应地，请参照图2和图3，本发明实施例的第二方面提供了一种基于模型预测的机器人自碰撞检测系统，包括：运动状态预测模块200和自碰撞检测模块300。
运动状态预测模块200包括：
运动状态获取单元201，其用于实时获取机器人各关节的第一运动状态信息；
状态积分器单元203，其用于依据第一运动状态信息，获取机器人各关节在预设控制周期次数之后的第二运动状态信息，依据第二运动状态信息得到机器人各关节包络模型的空间位姿信息。状态积分器单元203的实现原理如图4所示。具体实现，如公式11和公式12所示：
； （11）
； （12）
式中，、/>、/>分别表示第i步的位置、速度和加速度，/>，/>为循环控制周期。
可选的，运动状态预测模块200包括：
动力学计算单元202，其用于依据第一运动状态信息中的当前速度信息、当前位置信息、当前驱动力矩信息计算机器人各关节的当前加速度信息。
自碰撞检测模块300包括：
自碰撞检测单元301，其用于基于空间位姿信息，判断机器人各关节在预设控制周期次数之后是否发生碰撞；
碰撞反应单元302，其用于依据碰撞判断结果对应调整机器人各关节的运动控制策略。
进一步地，自碰撞检测模块300还包括：
轨迹重规划模块303，用于停止时根据当前路径重新规划速度，以实现机器人工作端仍处于给定的工作路径上。
相应地，本发明实施例的第三方面提供了一种电子设备，包括：至少一个处理器；以及与至少一个处理器连接的存储器；其中，存储器存储有可被一个处理器执行的指令，指令被一个处理器执行，以使至少一个处理器执行如上述任一基于模型预测的机器人自碰撞检测方法。
相应地，本发明实施例的第四方面提供了一种计算机可读存储介质，其上存储有计算机指令，该指令被处理器执行时实现上述任一基于模型预测的机器人自碰撞检测方法。
相应地，本发明实施例的第五方面提供了一种带有多关节机械臂的机器人，机器人至少包括一个机械臂，每个机械臂至少包括3个关节，机器人还包括：
上述基于模型预测的机器人自碰撞检测系统；和/或，
上述电子设备及计算机可读存储介质。
本发明实施例旨在保护一种基于模型预测的机器人自碰撞检测方法、系统及机器人，其中方法包括如下步骤：获取机器人各关节的第一运动状态信息，实时运动状态包括：当前位置信息、当前速度信息、当前驱动力矩信息和当前加速度信息；依据第一运动状态信息，预测机器人各关节在预设控制周期次数之后的第二运动状态信息；依据第二运动状态信息，得到机器人各关节包络模型的空间位姿信息；基于空间位姿信息，预判机器人各关节在预设控制周期次数之后是否发生碰撞，并依据碰撞判断结果对应调整机器人各关节的运动控制策略。上述技术方案具备如下效果：
通过对机器人当前状态进行检测，基于动力学模型预测后续运动状态信息，摒弃了现有的阈值判断逻辑，克服了阈值设定过大或过小导致的问题，提高了机器人碰撞检测的精度，算法具有较好的实时性。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质（包括但不限于磁盘存储器、CD-ROM、光学存储器等）上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备（系统）、和计算机程序产品的流程图和／或方框图来描述的。应理解可由计算机程序指令实现流程图和／或方框图中的每一流程和／或方框、以及流程图和／或方框图中的流程和／或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是：以上实施例仅用以说明本发明的技术方案而非对其限制，尽管参照上述实施例对本发明进行了详细的说明，所属领域的普通技术人员应当理解：依然可以对本发明的具体实施方式进行修改或者等同替换，而未脱离本发明精神和范围的任何修改或者等同替换，其均应涵盖在本发明的权利要求保护范围之内。
Claims (4)
1.一种基于模型预测的机器人自碰撞检测方法，其特征在于，包括如下步骤：
获取机器人各关节的第一运动状态信息，所述第一运动状态信息包括：当前位置信息、当前速度信息、当前驱动力矩信息和当前加速度信息；
依据所述第一运动状态信息，预测所述机器人各关节在预设控制周期次数之后的第二运动状态信息；
依据所述第二运动状态信息，得到所述机器人各关节包络模型的空间位姿信息；
基于所述空间位姿信息，预判所述机器人各关节在所述预设控制周期次数之后是否发生碰撞，并依据碰撞判断结果对应调整所述机器人各关节的运动控制策略；
所述获取机器人各关节的第一运动状态信息，包括：
获取所述机器人各关节的当前位置信息、当前速度信息和当前驱动力矩信息；
基于所述当前位置信息、所述当前速度信息和所述当前驱动力矩信息，得到所述机器人各关节的当前加速度信息；
所述机器人各关节的当前加速度信息的计算公式为：
；
其中，为机器人各关节单元驱动力矩，/>为机器人惯性参数矩阵，/>为科氏力及离心力项，/>为重力矩，/>为摩擦力项，/>为关节的位置，/>为关节速度，/>为关节的加速度；
所述机器人各关节在每次移动之后的速度信息的计算公式为：
在所述机器人第k步时的加速度为：
；
则第k+1步时，所述机器人的速度信息和位置信息/>为：
；
其中，为程序执行周期；
所述预测所述机器人各关节在预设控制周期次数之后的第二运动状态信息，包括：
依据所述机器人各关节的第一运动状态信息中的当前加速度信息计算所述机器人各关节在每次控制周期之后的速度信息；
通过所述预设控制周期次数次的迭代计算，得到所述机器人各关节在预设控制周期次数之后预测的速度信息和位置信息；
依据速度信息和位置信息，得到所述机器人各关节的第二运动状态信息；
所述依据所述第二运动状态信息，得到所述机器人各关节包络模型的空间位姿信息，包括：
依据所述第二运动状态信息，基于正向运动学计算所述机器人各关节相对于基坐标系的齐次变换矩阵；
所述机器人各关节相对于基坐标系的齐次变换矩阵为：
；
；
其中，为第i个关节相对于基坐标系的齐次变换矩阵，/>、/>、/>分别为关节i上的点在坐标系i中的笛卡尔空间坐标值，/>为关节1角度为/>时基坐标系到坐标系1的齐次变换矩阵，/>为关节2角度为/>时坐标系1到坐标系2的齐次变换矩阵，/>为关节i角度为/>时坐标系i-1到坐标系i的齐次变换矩阵，i为所述机器人由底座至末端方向的各关节序号，坐标系i为所述关节i的坐标系，基坐标系为机器人底座的坐标系。
2.一种基于模型预测的机器人自碰撞检测系统，其特征在于，包括：运动状态预测模块和自碰撞检测模块；
所述运动状态预测模块包括：
运动状态获取单元，其用于实时获取机器人各关节的第一运动状态信息；
状态积分器单元，其用于依据所述第一运动状态信息，获取所述机器人各关节在预设控制周期次数之后的第二运动状态信息，依据所述第二运动状态信息得到所述机器人各关节包络模型的空间位姿信息；
所述自碰撞检测模块包括：
自碰撞检测单元，其用于基于所述空间位姿信息，判断所述机器人各关节在所述预设控制周期次数之后是否发生碰撞；
碰撞反应单元，其用于依据碰撞判断结果对应调整所述机器人各关节的运动控制策略；
所述运动状态预测模块包括：
动力学计算单元，其用于依据第一运动状态信息中的当前速度信息、当前位置信息、当前驱动力矩信息计算机器人各关节的当前加速度信息；
所述机器人各关节的当前加速度信息的计算公式为：
；
其中，为机器人各关节单元驱动力矩，/>为机器人惯性参数矩阵，/>为科氏力及离心力项，/>为重力矩，/>为摩擦力项，/>为关节的位置，/>为关节速度，/>为关节的加速度；
所述机器人各关节在每次移动之后的速度信息的计算公式为：
在所述机器人第k步时的加速度为：
；
则第k+1步时，所述机器人的速度信息和位置信息/>为：
；
其中，为程序执行周期；
所述状态积分器单元用于依据所述机器人各关节的第一运动状态信息中的当前加速度信息计算所述机器人各关节在每次控制周期之后的速度信息，通过所述预设控制周期次数次的迭代计算，得到所述机器人各关节在预设控制周期次数之后预测的速度信息和位置信息，依据速度信息和位置信息，得到所述机器人各关节的第二运动状态信息；依据所述第二运动状态信息，基于正向运动学计算所述机器人各关节相对于基坐标系的齐次变换矩阵；
所述机器人各关节相对于基坐标系的齐次变换矩阵为：
；
；
其中，为第i个关节相对于基坐标系的齐次变换矩阵，/>、/>、/>分别为关节i上的点在坐标系i中的笛卡尔空间坐标值，/>为关节1角度为/>时基坐标系到坐标系1的齐次变换矩阵，/>为关节2角度为/>时坐标系1到坐标系2的齐次变换矩阵，/>为关节i角度为/>时坐标系i-1到坐标系i的齐次变换矩阵，i为所述机器人由底座至末端方向的各关节序号，坐标系i为所述关节i的坐标系，基坐标系为机器人底座的坐标系。
3.一种电子设备，其特征在于，包括：至少一个处理器；以及与所述至少一个处理器连接的存储器；其中，所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器执行如权利要求1所述基于模型预测的机器人自碰撞检测方法。
4.一种带有多关节机械臂的机器人，所述机器人至少包括一个机械臂，每个所述机械臂至少包括3个关节，其特征在于，所述机器人还包括：
如权利要求2所述的基于模型预测的机器人自碰撞检测系统；和/或，
如权利要求3所述的电子设备。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311257313.0A CN116985184B (zh) | 2023-09-27 | 2023-09-27 | 基于模型预测的机器人自碰撞检测方法、系统及机器人 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311257313.0A CN116985184B (zh) | 2023-09-27 | 2023-09-27 | 基于模型预测的机器人自碰撞检测方法、系统及机器人 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116985184A CN116985184A (zh) | 2023-11-03 |
| CN116985184B true CN116985184B (zh) | 2024-01-26 |
Family
ID=88526976
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311257313.0A Active CN116985184B (zh) | 2023-09-27 | 2023-09-27 | 基于模型预测的机器人自碰撞检测方法、系统及机器人 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116985184B (zh) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20090044130A (ko) * | 2007-10-31 | 2009-05-07 | 한국기계연구원 | 양팔 로봇 시스템의 충돌제어 방법 |
| CN102207988A (zh) * | 2011-06-07 | 2011-10-05 | 北京邮电大学 | 一种多自由度机械臂高效动力学建模方法 |
| CN103722565A (zh) * | 2014-01-23 | 2014-04-16 | 哈尔滨工业大学 | 仿人机器人自碰撞监控系统及监控方法 |
| CN108000521A (zh) * | 2017-12-06 | 2018-05-08 | 天津大学 | 一种无传感器式协作机器人碰撞检测方法 |
| CN110421564A (zh) * | 2019-08-06 | 2019-11-08 | 浙江大学 | 一种基于关节能耗评估的机器人工作单元布局优化方法 |
| CN112549024A (zh) * | 2020-11-26 | 2021-03-26 | 华南理工大学 | 基于时间序列分析的机器人免传感碰撞检测方法及应用 |
| CN114589694A (zh) * | 2022-03-03 | 2022-06-07 | 埃夫特智能装备股份有限公司 | 一种机器人碰撞检测阈值更新方法、装置与存储介质 |
-
2023
- 2023-09-27 CN CN202311257313.0A patent/CN116985184B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20090044130A (ko) * | 2007-10-31 | 2009-05-07 | 한국기계연구원 | 양팔 로봇 시스템의 충돌제어 방법 |
| CN102207988A (zh) * | 2011-06-07 | 2011-10-05 | 北京邮电大学 | 一种多自由度机械臂高效动力学建模方法 |
| CN103722565A (zh) * | 2014-01-23 | 2014-04-16 | 哈尔滨工业大学 | 仿人机器人自碰撞监控系统及监控方法 |
| CN108000521A (zh) * | 2017-12-06 | 2018-05-08 | 天津大学 | 一种无传感器式协作机器人碰撞检测方法 |
| CN110421564A (zh) * | 2019-08-06 | 2019-11-08 | 浙江大学 | 一种基于关节能耗评估的机器人工作单元布局优化方法 |
| CN112549024A (zh) * | 2020-11-26 | 2021-03-26 | 华南理工大学 | 基于时间序列分析的机器人免传感碰撞检测方法及应用 |
| CN114589694A (zh) * | 2022-03-03 | 2022-06-07 | 埃夫特智能装备股份有限公司 | 一种机器人碰撞检测阈值更新方法、装置与存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116985184A (zh) | 2023-11-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR102231551B1 (ko) | 운동학적 리던던트 로봇의 감시 | |
| JP5902425B2 (ja) | ロボット制御装置、外乱判定方法およびアクチュエータ制御方法 | |
| EP1901150B1 (en) | A method and device for avoiding collisions between an industrial robot and an object | |
| KR101475826B1 (ko) | 백스테핑 기법을 이용한 선도 추종자 대형제어 장치, 방법 및 이동로봇 | |
| US20180164170A1 (en) | Robot collision detection method | |
| JP6512790B2 (ja) | ロボット制御方法、ロボット装置、プログラム、記録媒体及び物品の製造方法 | |
| US11040449B2 (en) | Robot control system and method of controlling a robot | |
| EP3495098B1 (en) | Interference determination method, interference determination system, and computer program | |
| EP3646996B1 (en) | Control apparatus and robot teaching control method | |
| CN113263503B (zh) | 一种机器人系统的控制单元、机器人系统及机器人系统的控制方法 | |
| CN110345936B (zh) | 运动装置的轨迹数据处理方法及其处理系统 | |
| WO1991010181A1 (en) | Method of detecting collision using observer | |
| CN112757345A (zh) | 一种协作机器人碰撞检测方法、装置、介质及电子设备 | |
| JP5679121B2 (ja) | ロボットの運動予測制御方法と装置 | |
| WO2022179209A1 (zh) | 机器人摆动腿落地检测方法、装置和机器人 | |
| CN116985184B (zh) | 基于模型预测的机器人自碰撞检测方法、系统及机器人 | |
| JP2017019057A (ja) | ロボット制御装置、ロボットおよびロボットシステム | |
| WO2023155790A1 (zh) | 机器人负载转动惯量的标定方法、装置及存储介质 | |
| JP2022527059A (ja) | 衝突検出 | |
| US20220288773A1 (en) | Safe operation of a multi-axis kinematic system | |
| JP6657627B2 (ja) | ロボット制御装置、ロボットおよびロボットシステム | |
| US11738458B2 (en) | Control method for robot system | |
| EP3900887A1 (en) | Robot collision detection using cascading variational autoencoder | |
| CN115229780A (zh) | 机械臂运动路径规划方法及装置 | |
| JP2021091064A (ja) | 外乱オブザーバ及び外乱オブザーバを用いた接触点推定手段 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |