[发明专利]一种爬行机器人的摔倒检测方法及系统

说明书

本发明提供一种爬行机器人的摔倒检测方法及系统，涉及机器人检测技术领域，包括：爬行机器人的每个机械臂具有至少一组驱动装置，驱动装置连接爬行机器人的控制器，每组驱动装置包括一驱动电机，以及连接驱动电机的一驱动关节；针对每组驱动装置，获取驱动关节的实时关节位置数据并输出；控制器分别计算各实时关节位置数据与对应连接驱动电机的预设电机位置数据之间的位置差值，存在位置差值大于第一差值阈值时，控制器控制驱动装置停止动作并输出表征爬行机器人处于摔倒状态的告警提示，以供爬行机器人的操纵者进行查看处理。有益效果是：有效提升爬行机器人的摔倒检测准确性的同时降低爬行机器人的摔倒误报率。

技术领域

本发明涉及机器人检测技术领域，尤其涉及一种爬行机器人的摔倒检测方法及系统。

背景技术

现有的爬行机器人能够在非特定环境下行走，以完成给定的任务动作，由于行走环境是未知的，有些情况下难免会出现摔倒问题，进而无法正确执行后续任务动作，同时摔倒容易引起机器人损伤，因此亟需一种能够及时检测爬行机器人的摔倒状态，从而爬行机器人的操作员可以根据检测结果实时调整爬行机器人的任务动作。

发明内容

针对现有技术中存在的问题，本发明提供一种爬行机器人的摔倒检测方法，所述爬行机器人的每个机械臂具有至少一组驱动装置，所述驱动装置连接所述爬行机器人的控制器，每组所述驱动装置包括一驱动电机，以及连接所述驱动电机的一驱动关节；

所述摔倒检测方法具体包括以下步骤：

步骤S1，针对每组所述驱动装置，获取所述驱动关节的实时关节位置数据并输出；

步骤S2，所述控制器分别计算各所述实时关节位置数据与对应连接所述驱动电机的预设电机位置数据之间的位置差值，并分别将各所述位置差值与预设的第一差值阈值进行比较：

若存在所述位置差值大于所述第一差值阈值，则转向步骤S3；

若不存在所述位置差值大于所述第一差值阈值，则返回所述步骤S1；

步骤S3，所述控制器控制所述驱动装置停止动作并输出表征所述爬行机器人处于摔倒状态的告警提示，以供所述爬行机器人的操纵者进行查看处理。

优选的，所述爬行机器人具有一姿态感应装置，连接所述控制器；

则所述步骤S2中，若不存在所述位置差值大于所述第一差值阈值，还包括：

步骤A1，所述控制器分别将所述位置差值与预设的第二差值阈值进行比较：

若存在所述位置差值大于所述第二差值阈值，则转向步骤A2；

若不存在所述位置差值大于所述第二差值阈值，则返回所述步骤S1；

所述第二差值阈值小于所述第一差值阈值；

步骤A2，所述控制器通过所述姿态感应装置获取所述爬行机器人的实时俯仰角，并将所述实时俯仰角与预设的俯仰角阈值进行比较：

若所述实时俯仰角小于所述俯仰角阈值，则转向所述步骤S3；

若所述实时俯仰角不小于所述俯仰角阈值，则返回所述步骤S1。

优选的，每组所述驱动装置还包括一离合器，所述驱动电机通过所述离合器连接所述驱动关节；

则所述步骤A2中，若所述实时俯仰角不小于所述俯仰角阈值，还包括：

步骤B1，所述控制器获取所述驱动电机的输出电流，并根据所述输出电流计算得到所述离合器的实时扭矩；

步骤B2，所述控制器将所述实时扭矩与预设的第一扭矩阈值进行比较：

若所述实时扭矩大于所述第一扭矩阈值，则转向步骤B3；