本发明公开了一种基于激光引导的测量路径规划方法，属于机器人自动化测量领域。该方法首先在空间内布设全局相机定位系统，并通过激光投射装置向待测对象上投射特定图案，相机系统实时捕捉投射激光图案的移动轨迹，并根据机器人与相机的相对位姿和测量距离解算出机器人末端的位姿，进而生成机器人测量轨迹。本发明操作便捷，计算过程简单，计算量小，且修改方便，能缩短测量视点规划时间，提高工作效率，易实施且能保证机器人测量姿态的合理性。
1.一种基于激光引导的测量路径规划方法，其特征在于，该方法包括以下步骤：步骤1、采用激光投射装置向待测位置投射激光图案，投射图案的几何中心与待测位置的中心点重合；
步骤2、待投射位置图案稳定后，控制双相机系统对激光图案进行拍摄，并将拍摄得到的图像传输到控制器进行处理；
步骤3、建立图像坐标系 ，求解图像中心点 在双相机系统坐标系 下的坐标 ，以及图像坐标系 到双相机系统坐标系 的位姿变换矩阵 ；
步骤4、通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂末端坐标系与基坐标系之间的位姿传递关系如下：；
其中， 为相机与机械臂基座标系之间的位姿变换矩阵； 为图像坐标系与双相机系统坐标系之间的位姿变换矩阵； 为机械臂末端坐标系与图像坐标系之间的位姿变换矩阵；
步骤5：根据机械臂工具坐标系与基坐标系之间的位姿变换矩阵 以及机械臂结构参数计算各关节的旋转角度 ；
步骤6：通过控制器向机械臂发送关节运动指令，驱动机械臂各关节达到指定的角度位置，同时检查机械臂在运动过程中是否出现奇异位姿；
步骤7：重复步骤1到步骤6，直至机械臂完成所有示教任务。
2.如权利要求1所述的一种基于激光引导的测量路径规划方法，其特征在于，投射的激光图案为十字线激光，且投射在待测物体表面后十字线激光的两条相交线具有易于区分的长短特征。
3.如权利要求1所述的一种基于激光引导的测量路径规划方法，其特征在于，图像中心点 在双相机系统坐标系下的三维坐标 通过双目立体视觉原理测量得到。
4.如权利要求1所述的一种基于激光引导的测量路径规划方法，其特征在于，位姿变换矩阵 根据图像坐标系 在双相机系统坐标系 下的位姿进行描述：记 的XYZ轴在双相机系统坐标系 下单位方向向量分别为，则 到坐标系 的位姿变换
其中， 的方向为图像中心点 的法向方向， 的方向为十字线激光长轴方向 与的叉积， 的方向为 与 的叉积， 是图像坐标系的原点在双相机系统坐标系下的三维坐标。
5.如权利要求1所述的一种基于激光引导的测量路径规划方法，其特征在于，双相机系统与机械臂基座标系之间的位姿变换矩阵 通过机械臂的手眼标定获得。
6.如权利要求1所述的一种基于激光引导的测量路径规划方法，其特征在于，机械臂末端坐标系与图像坐标系之间的位姿变换矩阵 根据搭载的测量设备测量距离设置，其中机械臂末端坐标系方向与图像坐标系方向保持一致，坐标系原点之间的距离为d，则将描述为：
一种基于激光引导的测量路径规划方法
技术领域
[0001] 本发明涉及机器人自动化测量领域，具体涉及一种基于激光引导的测量路径规划方法。
背景技术
[0002] 随着航空制造业从“模线‑样板”的模拟量传递方式到采用数字量传递的方式的转变，产品零件外形测量也由直尺、塞尺、卡板等发展到以激光扫描、结构光测量为主的数字
化测量方法。数字化测量方法带来了高精度的测量结果、易于存储的测量数据但也存在设
备体积笨重、手持稳定性低、测量姿态难以保证的问题，采用机械臂搭载测量设备进行自动
化测量是较为合理的解决方案。
[0003] 采用机械臂搭载数字化测量设备进行自动化测量的一个关键问题是如何解决机器人测量路径规划。目前机器人测量路径规划方法主要有人工示教编程和基于三维模型的
测量路径规划两种。采用示教编程的方法不仅示教时间长、劳动强度大，而且难以保证测量
设备与被测物体之间的相对位姿关系。基于三维模型的测量路径规划方法能较好解决示教
编程的问题，但其操作复杂、软件开发难度大，并且现有的机器人离线编程软件如
Robotstudio、Roboguide、KUKASim、RobotMaster等都还未实现针对自动测量的机器人路径
规划功能。因此，针对机器人自动测量路径规划的问题，有必要设计一种简单可靠的路径规
划方法。
发明内容
[0004] 本发明旨在解决现有技术中存在的上述问题，提出一种使用方便、操作简单的基于激光引导的机械臂测量路径规划方法。
[0005] 为了实现上述发明目的，本发明的技术方案如下：
[0006] 一种基于激光引导的测量路径规划方法，其特征在于，该方法包括以下步骤：
[0007] 步骤1、采用激光投射装置向待测位置投射激光图案，投射图案的几何中心与待测位置的中心点重合；
[0008] 步骤2、待投射位置图案稳定后，控制双相机系统对激光图案进行拍摄，并将拍摄得到的图像传输到控制器进行处理；
[0009] 步骤3、建立图像坐标系 ，求解图像中心点 在双相机系统坐标系下的坐标 ，以及图像坐标系 到双相机系统坐标系
的位姿变换矩阵 ；
[0010] 步骤4、通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂末端坐标系与基坐标系之间的位姿传递关系如下：
[0011] ；
[0012] 其中， 为相机与机械臂基座标系之间的位姿变换矩阵； 为图像坐标系与双相机系统坐标系之间的位姿变换矩阵； 为机械臂末端坐标系与图像坐标系之间
的位姿变换矩阵；
[0013] 步骤5：根据机械臂工具坐标系与基坐标系之间的位姿变换矩阵 以及机械臂结构参数计算各关节的旋转角度 ；
[0014] 步骤6：通过控制器向机械臂发送关节运动指令，驱动机械臂各关节达到指定的角度位置，同时检查机械臂在运动过程中是否出现奇异位姿；
[0015] 步骤7：重复步骤1到步骤6，直至机械臂完成所有示教任务。
[0016] 进一步的，投射的激光图案为十字线激光，且投射在待测物体表面后十字线激光的两条相交线具有易于区分的长短特征。
[0017] 进一步的，图像中心点 在双相机系统坐标系下的三维坐标 通过双目立体视觉原理测量得到。
[0018] 进一步的，位姿变换矩阵 根据图像坐标系 在双相机系统坐标系下的位姿进行描述：
[0019] 记 的XYZ轴在双相机系统坐标系 下单位方向向量分别为，则 到坐标系 的位姿变换
矩阵表示为： ；
[0020] 其中， 的方向为图像中心点 的法向方向， 的方向为十字线激光长轴方向与 的叉积， 的方向为 与 的叉积， 是图像坐标系的原点在双相机系统坐标
系下的三维坐标。
[0021] 进一步的，双相机系统与机械臂基座标系之间的位姿变换矩阵 通过机械臂的手眼标定获得。
[0022] 进一步的，机械臂工具坐标系与图像坐标系之间的位姿变换矩阵 根据搭载的测量设备测量距离设置，其中机械臂末端坐标系方向与图像坐标系方向保持一致，坐标系
原点之间的距离为d，则将 描述为：
[0023] ，
[0024] 其中，d为测量设备的最佳测量距离。
[0025] 综上所述，本发明具有以下优点：
[0026] 1.本发明提供的轨迹规划方法操作便捷，计算过程简单，计算量小，且修改方便，能缩短测量视点规划时间，提高工作效率；
[0027] 2.本发明采用激光引导的测量路径规划方法能减少示教编程的工作量，降低操作人员工作强度；
[0028] 3.本发明方案通过视觉计算并调整测量设备与被测对象之间的位姿能保证测量位姿的合理性，保障测量精度。
附图说明
[0029] 图1 是本发明的方法流程图；
[0030] 图2 是本发明所述的实施示意图；
[0031] 图3是测量设备与投影图像相对位置关系示意图；
[0032] 图4是各坐标系之间的转换关系。
[0033] 图中，
[0034] 1、机械臂，2、控制器，3、双相机系统，4、激光投射装置，5、待测零件，6、十字线激光，7、测量设备。
具体实施方式
[0035] 为了更清楚地说明本发明，下面结合优选实施例和附图对本发明做进一步的说明。本领域技术人员应当理解，下面所具体描述的内容是说明性的而非限制性的，不应以此
限制本发明的保护范围。
[0036] 本发明的说明书和权利要求书及上述附图中的属于“第一”、“第二”等是用于区别不同的对象，而不是用于描述特定顺序。此外，术语“ 包括”和“ 具有”以及它们任何变形，
意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设
备没有限定于已列出的步骤或单元，而是可选地还包括没有列出的步骤或单元，或可选地
还包括对于这些过程、方法或设备固有的气体步骤或单元。
[0037] 实施例1
[0038] 本发明提供了如图1所示的一种基于激光引导的测量路径规划方法，包括以下步骤：
[0039] 步骤1：如图2所示，在被测物体附近架设双相机系统3和机械臂1，连接并启动机械臂1、双相机测量系统3和控制器2，同时，打开激光投射器4并向待测零件5投射激光图案。投
射的激光图案为十字线激光6，两条直线垂直相交，且投射在待测物体表面后，两条相交线
具有易于区分的长短特征。
[0040] 步骤2：双相机系统3实时监测投射图案，检测到图像稳定后，控制器2控制双相机系统3对激光图案进行拍摄，并将拍摄得到的图像传输到控制器2进行处理。
[0041] 步骤3：建立图像坐标系 ，利用双目立体视觉成像原理求解图像坐标系的原点 在双相机系统坐标系 下的坐标 ，以及图像坐标系 到双相
机系统坐标系 的位姿变换矩阵 。其中，图像坐标系的原点 为图像中心点
，也是十字线激光6的十字交叉中心。
[0042] 位姿变换矩阵 根据图像坐标系 在双相机系统坐标系 下的位姿进行描述。具体方法是：
[0043] 记 的XYZ轴在双相机系统坐标系 下单位方向向量分别为，则 到坐标系 的位姿变换
矩阵表示为： ；
[0044] 其中， 的方向为图像中心点 的法向方向， 的方向为十字线激光长轴方向与 的叉积， 的方向为 与 的叉积， 是图像坐标系的原点在双相机系统坐标
系下的三维坐标。
[0045] 步骤4：如图4所示，通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂工具坐标系与基坐标系之间的位姿传递关系如下：
[0046] ；
[0047] 其中，
[0048] 为相机与机械臂基座标系之间的位姿变换矩阵，通过机械臂的手眼标定获得，手眼标定为本领域技术人员所熟知的技术；
[0049] 为图像坐标系与双相机系统坐标系之间的位姿变换矩阵，根据步骤3所述方法求解；
[0050] 为机械臂末端工具坐标系与图像坐标系之间的位姿变换矩阵，根据机械臂上搭载的测量设备7的最佳测量距离设置。如图3所示，其具体方法是：设机械臂末端坐标系方
向与图像坐标系方向保持一致，坐标系原点在Z方向的距离为d（d是测量设备的最佳测量距
离），则 表示为：
[0051] 。
[0052] 步骤5：根据机械臂末端工具坐标系与基坐标系之间的位姿变换矩阵 ，以及机械臂结构参数计算各关节的旋转角度 。
[0053] 步骤6：通过控制器2向机械臂1发送关节运动指令，驱动机械臂各关节达到指定的角度位置，同时检查机械臂在运动过程中是否出现奇异位姿。
[0054] 步骤7：重复步骤1到步骤6，直至机械臂完成所有示教任务。
[0055] 虽然结合附图对本发明的具体实施方式进行了详细地描述，但不应理解为对本专利的保护范围的限定。在权利要求书所描述的范围内，本领域技术人员不经创造性劳动即
可做出的各种修改和变形仍属本专利的保护范围。
[0056] 以上所述，仅是本发明的较佳实施例，并非对本发明做任何形式上的限制，凡是依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化，均落入本发明的保护
范围之内。
