[发明专利]一种超冗余机械臂测试系统

说明书

本发明公开了一种超冗余机械臂测试系统，涉及力监测自动控制领域，包括超冗余机械臂测力驱动装置、超冗余机械臂驱动模块、电气柜、显示器、显示器支架、遥控手柄、大理石台面。通过本发明的实施，可以在工作过程中实时获取各驱动电机对驱动绳的拉力，能够实现驱动绳疲劳测试的自动化，通过实时数据分析可评估电机驱动能力和驱动绳负载能力是否满足设计需求。

技术领域

本发明涉及力监测自动控制领域，尤其涉及一种超冗余机械臂测试系统。

背景技术

随着作业环境的复杂化和狭窄化，超冗余度机器人作为特种机器人因其具有较强的避障能力和深腔作业能力，逐渐受到研究人员和企业的关注。一方面相比于传统工业机械臂，超冗余度机器人将驱动设备(电机)和传动装置(减速箱、丝杠等)后置于驱动底座，这样可以有效减轻操作臂质量，减小操作臂直径。另一方面通过优化结构设计，使超冗余度蛇形机器人拥有尽可能多的自由度和更大的弯曲角度，这使得操作臂具有极强的运动灵活性。

超冗余机械臂在运动过程中的姿态与各关节臂体的绳中力以及驱动绳的固有特性息息相关，所以对于研究蛇臂在运动过程中驱动绳特性极为重要。申请号为201811258514.1等中国发明专利公开了一种针对超冗余度机械臂的驱动装置，均为针对特定环境需求使用的机械臂驱动装置，由于空间体积限制，同时为了尽可能减小驱动绳输出时与扩线机构的干摩擦，一般需要将驱动绳依据机械臂需求直接内置于框架结构内侧，来尽可能减小驱动绳与扩线机构之间夹角，从而来减小驱动绳的摩擦。这种驱动装置需要排布紧凑，驱动绳的输出范围受限；单驱动模块单独拆卸困难；驱动绳在框架结构内侧，不易更换；对于不同类别机械臂的可替换性较差。另外该驱动装置未加装力传感器，无法获取驱动绳的拉力数据，故无法用于超冗余机器人的力位控制研究和驱动绳疲劳测试。

因此，本领域的技术人员致力于开发一种超冗余机械臂测试系统，针对超冗余机械臂的运动过程中各驱动绳的绳中力进行监测为执行端的超冗余机械臂控制提供参考和研究超冗余机械臂的运动特性提供依据。

发明内容

有鉴于现有技术的上述缺陷，本发明所要解决的技术问题是：如何解决多个待测对象的情况下不便同时获取的问题，以及如何实现驱动绳疲劳测试的自动化。

为实现上述目的，本发明提供了一种超冗余机械臂测试系统，包括：超冗余机械臂测力驱动装置、超冗余机械臂驱动模块、电气柜和大理石台面；

所述大理石台面与所述机械臂测力驱动装置及所述电气柜相连，

所述超冗余机械臂驱动模块与所述超冗余机械臂测力驱动装置的驱动电机连接。

进一步地，所述超冗余机械臂驱动模块还包括m个连接板卡以及n个电机驱动板卡，每n/m个驱动电机与其中一个所述连接板卡电连接。

进一步地，所述电气柜包括空气开关、力传感器信号变送器、开发板、开关电源、工业交换机和微型工控机。

进一步地，还包括显示器和显示器支架，所述显示器固定在显示器支架，所述显示器与所述微型工控机连接。

进一步地，所述超冗余机械臂测力驱动装置上还具有m个力传感器，所述力传感器信号变送器具有n个，每m/n个力传感器与其中一个力传感器信号变送器连接。

进一步地，所述开发板为STM32F407，所述开发板通过CAN总线与所述超冗余机械臂驱动模块相连，所述开发板负责解析指令并下发驱动量给所述超冗余机械臂驱动模块。

进一步地，所述开发板和所述微型工控机与所述工业交换机通过网线连接组成局域网，并通过UDP广播实现通信。

进一步地，所述开关电源与所述超冗余机械臂驱动模块3连接，用于向所述驱动电机和所述电机驱动板卡供电。

进一步地，还包括遥控手柄，所述遥控手柄与所述微型工控机连接，用以提供控制信号。