[发明专利]机械臂姿态检测方法和装置

说明书

本申请是关于一种机械臂姿态检测方法和装置。该方法包括以下步骤：获取机械臂上N个动态检测点在Ti时刻的N个检测位置坐标；所述N为大于或等于一的整数；其中，一个动态检测点在Ti时刻的检测位置坐标根据两个蓝牙模块分别在两个静态接收点的检测数据计算得到；获取所述机械臂在所述Ti时刻的N个预设位置坐标；根据N个所述检测位置坐标和N个所述预设位置坐标确定所述机械臂是否出现姿态偏差。本申请根据同一动态检测点在示教器训练时记录的Ti时刻的预设位置坐标和该动态检测点在Ti时刻的检测位置坐标进行比对，进而确认该动态检测点是否偏离了预设位置坐标，即机械臂是否出现姿态偏差，进而防止该机械臂在进行自动化操作时出现错误操作。

技术领域

本申请涉及机械臂自动化控制技术领域，尤其涉及机械臂姿态检测方法和装置。

背景技术

在生产线上，自动化的机械臂在控制器的控制下进行重复的自动化操作；为了进行机械臂的姿态确认，工作人员通过示教器连接控制器，获取控制器中该机械臂的姿态信息，从而确认该机械臂的实际运动轨迹和预设运动轨迹是否存在偏差，从而判断是否需要调整该机械臂的运动轨迹。

然而，示教器的价格较为昂贵，工作人员为了确认每个机械臂的姿态信息，需要逐一连接每个机械臂对应的控制器，再逐一确认机械臂的运动轨迹。实际的生产中，存在多个机械臂同时工作的情况，而仅仅通过示教器无法同时直接进行多个机械臂的姿态信息确认。

示教器通过实时读取机器人控制器数据显示正在读取的机器人的姿态及程序运行状态，但在实际生产中，存在多台机器人同时工作但以一台示教器进行示教的情况。此时示教器仅可显示正在接收示教的机器人状态，未连接示教器的机器人的状态信息则由机器人本身控制系统处理，对于机械臂的实际运动轨迹是否符合预设运动轨迹无法直观显示，需等待操作员将示教器与机械臂的控制器连接才可获知机器人当前的运动轨迹。

现有技术通过在机械臂上集成了多个传感器，但数据的显示与传输依然通过控制系统进行，这种方式价格高昂且需要将传感器与控制系统进行程序性的适配。

因此，为了能够同时进行多个机械臂的姿态确认，避免在进行姿态确认时需要人工用示教器逐一连接机械臂，亟需一种机械臂姿态检测方法和装置。

发明内容

为了克服现有技术问题，本申请第一方面提供一种机械臂姿态检测方法，包括：

获取机械臂上N个动态检测点在Ti时刻的N个检测位置坐标；所述N为大于或等于一的整数；其中，一个动态检测点在Ti时刻的检测位置坐标根据两个蓝牙模块分别在两个静态接收点的检测数据计算得到；

获取所述机械臂在所述Ti时刻的N个预设位置坐标；

根据N个所述检测位置坐标和N个所述预设位置坐标确定所述机械臂是否出现姿态偏差。

在一种实施方式中，所述一个动态检测点在Ti时刻的检测位置坐标的计算方式，包括：

获取一个动态检测点在Ti时刻的第一相位差和第二相位差，所述第一相位差为第一蓝牙模块在第一静态接收点对动态检测点的相位检测值，所述第二相位差为第二蓝牙模块在第二静态接收点对动态检测点的相位检测值；

根据第一相位差和第二相位差分别获取所述动态检测点的第一到达角和第二到达角；

根据第一到达角和第二到达角获取所述动态检测点在Ti时刻的检测位置坐标。

在一种实施方式中，所述获取机械臂上N个动态检测点在Ti时刻的N个检测位置坐标之后，包括：

将N个所述检测位置坐标拟合为所述机械臂在Ti时刻的实际运动姿态；

所述获取所述机械臂在所述Ti时刻的N个预设位置坐标之后，包括：

将N个预设位置坐标拟合为所述机械臂在Ti时刻的预设运动姿态；