[发明专利]一种机器人红外激光定位运动轨迹规划方法

权利要求书

1.一种机器人红外激光定位运动轨迹规划方法，其特征在于，包括以下步骤：

设置机器人，红外激光定位装置和处理器，红外激光定位装置包括红外摄像头、红外发射器和红外激光定位仪，红外摄像头、红外发射器和红外激光定位仪均通过处理器连接确定位置坐标，机器人上安装有定位器和视角摄像装置，处理器通过信号处理装置与红外激光定位装置和机器人连接；

控制机械人按预设规划的运动轨迹运动；

机器人通过定位器向红外发射器发射携带有位置坐标和红外发射器基础信息的红外激光定位信号发送，并通过红外摄像头和视角摄像装置进行环境图像定位信号的发送；

通过定位器根据接收的多个红外激光信号的信号强度和方位角以及多个红外激光信号携带的位置坐标和发射器基础信息进行目标位置解算，并且，红外摄像头对机器人环境图像信息实时的采集，获得机器人坐标及姿态信息实时转换；

在红外激光定位仪配合红外摄像头获取了目标位置的坐标及姿态信息后，通过红外发射器将红外激光信号的位置坐标信息及姿态图像信息传输到处理器，在红外线定位并借助环境图像定位方法获得机器人的实时坐标信息和姿态信息；

处理器接收信息后，对信息中坐标及图像状态属性进行分析，判断机器人运动过程中在坐标值变换，是否与预设的坐标值指令变化趋势一致，若坐标值指令的变化趋势与预设的坐标值指令变化趋势不一致，则将预先构建的机器人定位坐标系中在前后上的坐标值通过处理器修正为负值，得到校正后的机器人红外激光定位坐标系，并将信号的属性指令传送到机器人；

将所得信号通过信号处理装置发送到处理器，根据处理器结合视角图像视频信息信号及红外激光定位信息信号，进行整合、分析和统计的实际坐标轨迹，并根据实际轨迹与设定轨迹，作出相应的运动轨迹作业指令，实现运动轨迹的实时规划，提高机器人轨迹精度；

处理器判断完成后，机器人通过处理器进行下一步动作的指令，处理器接收到动作指令完成并请求下一动作的指令时，根据预定线程，编入各参数之偏移量，进行重复动作，发送至机器人上，循环完成阶段性任务。

2.根据权利要求1所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述机器人为六关节机器人，所述机器人的前端第六关节为可更换接头，所述接头上为用于制程的工业机器手、切割手、焊接手等的任一种。

3.根据权利要求2所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述机器人本体上所对应多个关节均设置有驱动装置，所述机器人上的驱动装置通过线路发送多个关键的位置信息及运动轨迹和速度，并发送到处理器上。

4.根据权利要求3所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述机器人在运动轨迹上运动过程中通过横向方向和前后方向坐标值的增大趋势和减小趋势与预设的坐标值变化趋势一致。

5.根据权利要求4所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述定位器根据接收的所述红外激光信号的信号强度计算获得所述定位器与所述红外发射器和所述红外激光定位仪的距离。

6.根据权利要求5所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述视角摄像装置包括CCD摄像机和视频采集卡，所述视频采集卡与视角图像视频信息单元连接。

7.根据权利要求6所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述红外摄像头、所述红外发射器和所述红外激光定位仪所能接受的范围覆盖对所述机器人运动轨迹范围。

8.根据权利要求7所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述红外摄像头以记录所述机器人各个关节电机形成的运动轨迹和速度形成姿态信息，并通过信号实时发送的所述各个关节位置及运动轨迹和速度形成姿态信息。

9.根据权利要求8所述的一种机器人红外激光定位运动轨迹规划方法，其特征在于，所述处理器采用的信号处理装置可通过根据所处的环境中WIFI信号连接、宽度线路连接或蓝牙信号连接，所述宽度线路连接为RJ45网口。