本发明专利技术公开一种机械臂关节的拖动示教限速方法，包括：获取关节的实际拖动速度；当实际拖动速度超过预设的安全拖动速度时；通过动力学模型计算关节电机的调整力矩，调整力矩的方向与关节的当前运动方向相反；将调整力矩转换为关节电机的运动控制指令，并发送给关节电机。本发明专利技术所提出的机械臂关节的拖动示教限速方法，在对机械臂进行拖动示教时，若关节的实际拖动速度超过安全拖动速度，则关节电机将产生与拖动方向相反的阻力，以降低机械臂关节的拖动速度，防止机械臂关节的拖动速度过快，避免出现因速度过快而导致的安全风险问题。此外，本发明专利技术还公开一种机械臂关节的拖动示教限速装置、电子设备及介质。电子设备及介质。电子设备及介质。
【技术实现步骤摘要】
机械臂关节的拖动示教限速方法、装置、电子设备及介质
[0001]本案为分案申请，其母案申请号为CN202110759410.4，申请日为2021
‑
07
‑
06，案件名称为“机械臂关节的拖动示教限速方法、装置、电子设备及介质”。
[0002]本专利技术涉及机械臂领域，特别涉及一种机械臂关节的拖动示教限速方法、装置、电子设备及介质。
技术介绍
[0003]拖动示教又称手动示教，是由操作员直接通过手动拖动的方式完成对机械臂的示教编程工作，而后机械臂可根据外界信号触发重复执行示教轨迹的指令。
[0004]在对机械臂进行拖动示教时，需先点击示教按钮，以使得机械臂进入拖动示教模式。机械臂在进入拖动示教模式后，再由操作员拖动机械臂移动至期望的位置，而在机械臂被拖动的过程中，机械臂会实时记录并保存其运动位姿或运动轨迹，从而完成对于机械臂的拖动示教过程。
[0005]现有技术中，机械臂处于力矩环控制模式，在拖动示教模式下，机械臂关节的运动状态由电机输出力矩和外部拖动力矩所决定，在外部拖动力矩过大时，机械臂关节会因速度过快而存在安全风险。此外，机械臂关节由于被拖动而快速运动时，即使停止施加外部拖动力矩，由于机械臂关节的动力学模型会产生维持当前运动的力，因此，机械臂关节仍会以当前速度继续运动一段距离，在此过程中也会存在安全风险。
技术实现思路
[0006]本专利技术的主要目的在于提出一种机械臂关节的拖动示教限速方法，旨在解决现有机械臂关节在进行拖动示教时会存在因速度过快而导致的安全风险问题。
[0007]为实现上述目的，本专利技术提出一种机械臂关节的拖动示教限速方法，包括：
[0008]获取关节的实际拖动速度；
[0009]当实际拖动速度超过预设的安全拖动速度时；
[0010]通过动力学模型计算关节电机的调整力矩，调整力矩的方向与关节的当前运动方向相反；
[0011]将调整力矩转换为关节电机的运动控制指令，并发送给关节电机。
[0012]其中，机械臂关节的拖动示教限速方法还包括：
[0013]设定机械臂进行拖动示教时关节的速率阈值；
[0014]将设定的速率阈值与关节的当前运动方向进行速度合成，得到关节的安全拖动速度。
[0015]其中，当实际拖动速度小于或等于安全拖动速度时，机械臂关节的拖动示教限速方法还包括：
[0016]基于动力学模型和关节的实际拖动速度，计算得到关节的理论力矩；
[0017]根据关节的理论力矩和其当前速度方向，确定关节的力矩约束范围；
[0018]根据力矩约束范围对关节的输出力矩进行饱和调节。
[0019]其中，根据关节的理论力矩和其当前速度方向，确定关节的力矩约束范围包括：
[0020]若理论力矩与实际拖动速度的方向同为正，则确定关节的力矩约束范围为[0，T1]；
[0021]若理论力矩与实际拖动速度的方向同为负，则确定关节的力矩约束范围为[
‑
T1，0]；
[0022]若理论力矩的方向为正且实际拖动速度的方向为负，则确定关节的力矩约束范围为[T1，T2]；
[0023]若理论力矩的方向为负且实际拖动速度的方向为正，则确定关节的力矩约束范围为[
‑
T2，
‑
T1]；
[0024]T1为关节的理论力矩，T2为关节电机的额定力矩，T1小于T2且T1和T2均为正值，力矩和速度的正负方向以关节的零点为参考。
[0025]其中，根据力矩约束范围对输出力矩进行饱和调节包括：
[0026]当关节的力矩约束范围为[0，T1]且输出力矩的方向为正时：若输出力矩大于T1，则将输出力矩调节为T1；若输出力矩小于或等于T1，则无需对输出力矩进行调节；
[0027]当关节的力矩约束范围为[
‑
T1，0]且输出力矩的方向为负时：若输出力矩大于
‑
T1，则无需对输出力矩进行调节；若输出力矩小于或等于
‑
T1，则将输出力矩调节为
‑
T1；
[0028]当关节的力矩约束范围为[T1，T2]且输出力矩的方向为正时：若输出力矩大于T1且小于T2，则无需对输出力矩进行调节；若输出力矩小于T1，则将输出力矩调节为T1；若输出力矩大于T2，则将输出力矩调节为T2；
[0029]当关节的力矩约束范围为[
‑
T2，
‑
T1]且输出力矩的方向为负时：若输出力矩大于
‑
T2且小于
‑
T1，则无需对输出力矩进行调节；若输出力矩小于
‑
T2，则将输出力矩调节为
‑
T2；若输出力矩大于
‑
T1，则将输出力矩调节为
‑
T1。
[0030]本专利技术还提出一种机械臂关节的拖动示教限速装置，包括：
[0031]速度获取模块，用于获取关节的实际拖动速度；
[0032]调整力矩模块，用于当实际拖动速度超过预设的安全拖动速度时，通过动力学模型计算关节电机的调整力矩，调整力矩的方向与关节的当前运动方向相反；
[0033]指令生成模块，用于将调整力矩转换为关节电机的运动控制指令，并发送给关节电机。
[0034]其中，机械臂关节的拖动示教限速装置还包括：
[0035]速率设定模块，用于设定机械臂进行拖动示教时关节的速率阈值；
[0036]速度合成模块，用于将设定的速率阈值与关节的当前运动方向进行速度合成，得到关节的安全拖动速度。
[0037]其中，机械臂关节的拖动示教限速装置还包括：
[0038]输出力矩模块，用于基于动力学模型和关节的实际拖动速度，计算得到关节的理论力矩；
[0039]力矩约束模块，用于根据关节的理论力矩和其当前速度方向，确定关节的力矩约束范围；
[0040]力矩调节模块，用于根据力矩约束范围对输出力矩进行饱和调节。
[0041]本专利技术还提出一种电子设备，包括：
[0042]存储器，用于存储计算机程序；
[0043]处理器，用于执行计算机程序时，实现前述所记载的机械臂关节的拖动示教限速方法，该机械臂关节的拖动示教限速方法至少包括以下步骤：
[0044]获取关节的实际拖动速度；
[0045]当实际拖动速度超过预设的安全拖动速度时；
[0046]通过动力学模型计算关节电机的调整力矩，调整力矩的方向与关节的当前运动方向相反；
[0047]将调整力矩转换为关节电机的运动控制指令，并发送给关节电机。
[0048]本专利技术还提出一种介质，该介质存储有计算机程序，该计算机程序被处理器执行时，实现实现前述所记载的机械臂关节的拖动示教限速方法，该机械臂关节的拖动示教限速方法至少包括以下步骤：
[0049]获取关节的实际拖动速度；
[0050]当实际拖本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种机械臂关节的控制器，其特征在于，包括：转速检测单元，用于检测关节电机的转动数据；数据处理单元，用于接收所述转动数据并对其进行处理，以计算得到所述关节电机的转动速度；运算单元，用于在所述关节电机的转动速度超过预设的安全拖动速度时，计算将所述关节电机的转动速度控制在安全拖动速度内的调整力矩；输出单元，将所述调整力矩转换为关节电机的运动控制指令并输出给所述关节电机。2.根据权利要求1所述的机械臂关节的控制器，其特征在于，还包括：速率设定单元，用于接收外部设定的所述关节的速率阈值；速度合成单元，用于将所述关节电机的速率阈值与所述关节电机的当前转动方向进行合成，得到所述关节电机的安全拖动速度。3.根据权利要求1所述的机械臂关节的控制器，其特征在于，还包括：力矩计算单元，用于在所述关节电机的转动速度小于或等于所述安全拖动速度时，根据动力学模型和所述关节电机的转动速度，计算得到所述关节电机的理论力矩；力矩约束单元，用于根据所述关节电机的理论力矩和所述关节电机的当前转动方向，计算得到所述关节电机的力矩约束范围；力矩调节单元，用于根据所述关节电机的力矩约束范围对所述关节电机的输出力矩进行饱和调节。4.根据权利要求3所述的机械臂关节的控制器，其特征在于，所述力矩约束单元用于：在所述理论力矩与所述关节电机的当前转动方向同为正时，确定所述关节电机的力矩约束范围为[0，T1]；在所述理论力矩与所述关节电机的当前转动方向同为负时，确定所述关节电机的力矩约束范围为[
‑
T1，0]；在所述理论力矩的方向为正且所述关节电机的当前转动方向为负时，确定所述关节电机的力矩约束范围为[T1，T2]；在所述理论力矩的方向为负且所述关节电机的当前转动方向为正时，确定所述关节电机的力矩约束范围为[
‑
T2，
‑
T1...
【专利技术属性】
技术研发人员：姜宇，黄睿，郎需林，林炯辉，刘主福，刘培超，
申请(专利权)人：深圳市越疆科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。