[发明专利]仿人机器人自碰撞监控系统及监控方法

摘要

仿人机器人自碰撞监控系统及监控方法，涉及机器人控制领域。本发明是为了提高机器人碰撞检测的精度和实时性保护仿人机器人的安全。本发明使用球扫掠凸体构建碰撞模型，离散自适应窗口角速度计算方法以及GJK算法，开发了一个独立于机器人任务规划和控制的快速高精度碰撞检测监控系统，该系统循环运行，以机器人关节角作为输入，判断机器人是否会发生碰撞，当碰撞时向机器人控制器发送急停指令。机器人安全运行时该系统不影响机器人运行。本发明适用于机器人控制。

主权项

仿人机器人自碰撞监控系统，其特征是：它包括基于球扫略凸体的离散碰撞检测模块（7）、机器人运动状态预测模块（6）、关节角度速度计算模块（5）和通讯模块（4）；通讯模块（4）用于将仿人机器人上的关节角速度传感器采集的关节角度信息传送给关节角速度计算模块（5），还用于将基于球扫略凸体的离散碰撞检测模块（7）的在检测到碰撞时向机器人控制器（2）发送急停控制指令；关节角度速度计算模块（5）用于根据仿人机器人关节位置传感器采集的关节角度信息和仿人机器人关节位置传感器的采样周期计算仿人机器人各关节的角速度；并将仿人机器人关节位置传感器采集的关节角度和获得的仿人机器人各关节的角速度发送给机器人运动状态预测模块（6）；机器人运动状态预测模块（6）用于根据关节角度速度计算模块（5）发送的仿人机器人关节位置传感器采集的关节角度、仿人机器人各关节的角速度和自碰撞监控系统引入的时延预测仿人机器人的运动状态；并将预测结果发送给球扫略凸体的离散碰撞检测模块（7）；基于球扫略凸体的离散碰撞检测模块（7）用于构建仿人机器人的基于球扫掠凸体碰撞检测模型，并根据机器人运动状态预测模块（6）预测的机器人运动状态实时更新碰撞检测模型，优化碰撞对，并检测各碰撞对是否发生碰撞，并在发生碰撞时发出急停控制指令。