[发明专利]机械手装置以及机械手装置的控制方法

摘要

本发明涉及机械手装置以及机械手装置的控制方法，该机械手装置通过具有致动器的连结装置而将手臂可旋转或可直线移动地连结，该机械手装置具备：安装在手臂上的惯性传感器；第一计算部，根据来自致动器所具备的角度传感器的旋转角度数据，计算致动器的角速度以及角加速度；第二计算部，其根据由惯性传感器检测到的输出，计算手臂的角速度或者角加速度；比较部，其对由第一计算部计算出的角速度或者角加速度和由第二计算部计算出的角速度或者角加速度进行比较；故障判断部，其在比较部中致动器和手臂的角速度或者角加速度之差的绝对值大于阈值的情况下判断为惯性传感器发生了故障。

主权项

一种机械手装置，其特征在于，具备：手臂连结装置，其具有致动器、将上述致动器的转矩以规定的减速比进行传递的转矩传递机构、和检测上述致动器的旋转角度的角度传感器；手臂体，其是由多个手臂通过上述手臂连结装置串联且可旋转地被连结而形成的；基体，上述手臂体通过设置在上述手臂体的一个端部的基体连结装置被可旋转地连结在该基体上，该基体连结装置具备上述致动器、将上述致动器的转矩以规定的减速比进行传递的转矩传递机构、和检测上述致动器的旋转角度的角度传感器；惯性传感器，其安装在上述手臂上；第一计算部，其根据来自上述角度传感器的上述致动器的旋转角度数据来计算上述致动器的角速度以及角加速度；第二计算部，其根据由上述惯性传感器检测到的输出，计算上述手臂的角速度或者角加速度；比较部，其对由上述第一计算部计算出的上述致动器的角速度或者角加速度、和由上述第二计算部计算出的上述手臂的角速度或者角加速度进行比较；故障判断部，当在上述比较部中，上述致动器的角速度或者角加速度与上述手臂的角速度或者角加速度之差的绝对值大于阈值Ω时，该故障判断部判断为上述惯性传感器发生了故障，并输出使上述致动器的动作停止的信号。