一种寻踪定位处理系统及定位方法
【技术领域】
[0001] 本发明设及智能控制领域，具体设及一种寻踪定位处理系统及定位方法。 技术背景
[0002] 随着国家大力推动机器人技术、工厂、企业大力进行机器人技改、创新，W机器代 替人工的工作方式正在现在的工厂、企业中起到越来越大的作用，机器人在工作中，很重要 的一点就是定位，目前，对于工厂流水线中的标准件来说，可W通过预设定程序来实现，预 设定机器人的行进轨迹、动作参数，对于过程可W预见、可W编程的机器人动作，该种方式 省时、省力。
[0003] 但是有一些机器人在工作中，需要面对的是不规则物件或者是行进轨迹，该就需 要机器人自身有自身定位、处理的功能，否则通过预设模式无法良好符合期望轨迹。例如大 型=维曲面的焊接工作，焊接设备需要在不规则的=维曲面上面，对不规则的踪迹进行焊 接；又如线迹标记装置、线状痕迹清晰装置，对于典型的液体运输泄露，其泄露的液体呈线 状不规则分布，需要机器人自身对痕迹进行良好的定。现有技术无法对线状轨迹进行良好 的追踪、定位。
[0004] 鉴于上述缺陷，本发明创作者经过长时间的研究和实践终于获得了本发明。
【发明内容】
[0005] 为解决上述技术缺陷，本发明采用的技术方案在于，提供一种寻踪定位处理系统， 其特征在于，包括一处理器、与所述处理器分别相连的一第一视觉系统与一第二视觉系统， 所述第一视觉系统与所述第二视觉系统能够向待处理表面发射激光、获取所述激光线投影 与待处理踪迹图像传送至所述处理器，所述第一视觉系统位于所述第二视觉系统前方，所 述第一视觉系统能够识别行进方向前方更大的踪迹范围，从而确定系统在接下来一段时间 的一定轨迹，在后的第二视觉系统能够识别正在处理的踪迹段，实现精确处理。
[0006] 较佳的，所述第一视觉系统包括一第一图像获取装置与一第一激光发射装置，所 述第二视觉系统包括一第二图像获取装置与一第二激光发射装置，所述处理器包括一第一 处理器与一第二处理器；
[0007] 所述第一图像获取装置与所述第一处理器相连，所述第二图像获取装置与所述第 二处理器相连。
[0008] 较佳的，所述第一激光发射装置为一线形激光发生器，所述第二激光发射装置为 一环形激光发生器。
[0009] 一种寻踪定位方法，其特征在于，包括步骤：
[0010] S1;系统定位于踪迹起点附近，所述第一视觉系统获取起点位置；
[0011] S2 ;所述第一视觉系统打开，向待处理表面发射激光，并收集激光投影与待测踪迹 图像至所述处理器；
[0012] S3 ;所述处理器对图像进行处理，确定系统行进轨迹；
[0013] S4:所述第二视觉系统打开，向待处理表面发射激光，并收集激光投影与待测踪迹 图像至所述处理器；
[0014] S5 ;所述处理器对图像进行处理，修正所述第二视觉系统位置；
[0015] S6 ;所述第二视觉系统打开，向待处理表面发射激光，并收集激光投影与待测踪迹 图像至所述处理器；
[0016] S7 ;所述处理器对图像进行处理，对系统位置轨迹进行修正；
[0017] S8 ;重复步骤S2至步骤S7至寻踪定位结束。
[0018] 较佳的，所述步骤S3具体为：
[0019] 所述处理器对图像进行处理，确定系统需绕W方向调整的角度与系统在V方向调 整的距离。
[0020] 较佳的，系统需绕W方向调整的角度化II为：
[0021]
[00过系统在Y方向调整的距离化为：
[0023]
[0024] 其中，ai、bi为所述第一相机视场U、V方向图像长度，激光线与
[00幼踪迹边缘的交点图像坐标分别为Mi2(ai，VM,:)、Ni2(ai，VN12)，Vm。、Vn。分别为点Mi2、N。的V轴坐标，由所述第一相机测定，C11为所述第一相机的标定系数；0。为焊缝在 W= ^处的切线与V轴的夹角，由所述第一相机测定。
[0026] 较佳的，所述步骤S5具体为；所述第二视觉系统绕T轴旋转角度为0 21，0 21为所 述第二相机视场S轴与踪迹切线所呈角度，由所述第二相机确定。
[0027] 较佳的，所述步骤S7具体为，所述处理器确定所述第二视觉系统需绕绕R轴旋转 角度、绕S轴旋转角度、沿S轴方向位移。
[0028] 较佳的，所述第二视觉系统在S方向上调整
在T方向上调 整
绕S轴旋转方向调整角度为
绕R轴旋转方向调整角度为
[002引其中，Sm。与Sn。分别为踪迹边缘与第二相机视场坐标系S轴交点的S轴坐标，交点 为M22、N22,即M22(0，Sm。）、N^(0，Sn。），ly。为焊枪与S轴的偏离量，^22为所述第 二是相机的标定系数；
[0030] 若第二视觉系统相对踪迹空间位置、位姿合理时，所述h。为第二相机坐标系距离 踪迹的实际距离，华。为圆形光斑图像的直径；
[0031] a,为经T轴旋转后的所述第二视觉系统的所述环形激光器向待处理平面照射形成 的近楠圆形沿着R正向的半轴，bf为经T轴旋转后的第二视觉系统的所述环形激光器向待 处理平面照射形成的近楠圆形沿着R负向的半轴；a,为经T轴旋转后的所述第二视觉系统 的所述环形激光器向待处理平面照射形成的近楠圆形沿着S正向的半轴，b,为经T轴旋转 后的所述第二视觉系统的所述环形激光器向待处理平面照射形成的近楠圆形沿着S负向 的半轴，均由所述第二相机测定；0 2。为圆形光斑的散射角度；
[0032] W所述第二相机视场左下角为原点，R轴与X轴同向，R轴与Y轴同向，T轴与Z轴 同向。
[0033] 与现有技术相比较，本发明的有益效果在于；本发明效率高、应用本发明的寻踪定 位处理系统对踪迹的处理质量好；柔性化的操作机制，适应性好；可实现厚板、薄板及多种 坡口的表面的踪迹识别及跟踪；本发明智能化程度较高，在寻踪过程中不需要人工监控及 采用复杂的夹具、轨道等辅助，只需要将该装备放置于装配好的待处理件的踪迹起点附近 处的曲面上，就可W实现自动寻踪处理；操作简单，自动化程度高，测量成本低，无公害，审U 造成本低。
【附图说明】
[0034]图1为本发明所述寻踪定位处理系统实施例一结构图；
[00巧]图2为本发明所述寻踪定位处理系统实施例二结构图；
[0036] 图3a为本发明所述寻踪定位步骤S3示意图之一；
[0037] 图3b为本发明所述寻踪定位步骤S3示意图之二；
[0038] 图4a为本发明所述寻踪定位步骤S7示意图之一；
[0039] 图4b为本发明所述寻踪定位步骤S7示意图之二；
[0040] 图5a为本发明所述寻踪定位步骤S7示意图之S;
[0041] 图化为本发明所述寻踪定位步骤S7示意图之四。
【具体实施方式】
[0042] 为便于本领域技术人员对本发明的技术方案和有益效果进行理解，特结合附图对
【具体实施方式】进行如下描述。
[004引实施例一；
[0044] 请参阅图1所示，其为本发明所述的寻踪定位处理系统实施例一结构图，包括一 处理器1、第一视觉系统2、第二视觉系统3。
[0045] 所述第一视觉系统2与所述第二视觉系统3分别与所述处理器1相连，所述第一 视觉系统2位于所述第二视觉系统3前方，通常位于寻踪处理设备的前方，能够全面观察踪 迹。所述第一视觉系统2能够向前方踪迹发射激光，并且将线状激光与踪迹的图像收集，传 输至所述处理器中，所述处理器经过处理，给出第一控制信号。
[0046] 由于寻踪处理设备通常具备两个部分，一部分是沿踪迹前行的行走机构，另外一 部分是对踪迹进行处理的处理机构。
[0047] 所述第一控制信号给出设备的大致前行方向。
[0048]所述第二视觉系统能够向踪迹发射出激光，并能够捕捉激光与踪迹的图像，传输 至所述处理器中，所述处理器经过处理，给出第二控制信号。
[0049] 由于通常，踪迹处理，无论是对踪迹的清洗、焊接、或者是其他处理，均应当从垂直 于踪迹表面的位置开始实施，第二控制信号给出设备的处理机构的动作轨迹，将动作机构 定位至所述踪迹的垂直位置。
[0050] 所述处理器1与寻踪处理设备相连，控制其行走和运动轨迹。
[00川实施例二
[0052] 请参阅图2所示，其为本发明所述的寻踪定位处理系统实施例二结构图。
[0053] 实施例二与实施例一相近，不同之处在于，所述处理器1包括两个子处理器；第一 处理器11与第二处理器12,所述第一视觉系统包括第一图像获取装置21与第一激光发射 装置22,所述第二视觉系统包括第二激光发射装置31与第二图像获取装置32。
[0054] 寻踪处理设备沿踪迹进行处理，所述第一激光发射装置22发射激光至踪迹，所述 第一图像获取装置21将所述视场内的踪迹与激光捕捉到，并且传送至所述第一处理器11 中进行处理。所述第二激光发射装置31发射激光至踪迹，所述第二图像获取装置32将所 述视场内的踪迹与激光捕捉到，并且传送至所述第二处理器12中进行处理。
[00巧]本实施例中，优选的，所述第一激光发射装置22为一线型激光发射器，能够发射 直线激光，其发射的激光与踪迹垂直。所述第一图像获取装置21为一相机，即第一相机。
[0056] 本实施例中，优选的，所述第二激光发射装置31为一环形激光发射器，能够发射 环形激光。所述第二图像获取装置32为一相机，即第二相机。
[0057] 在实际处理过程中，本系统采用=步矫正方式对寻踪处理设备进行定位指引。通 常此类装置为由一个较大的驱动装置或行走装置，带动一个较小的处理装置、如焊头、探 头、清洁头等等。
[0058] 本发明所述系统采用如下方法完成寻踪定位工作。
[0059] S1;将寻踪处理设备定位于踪迹起点附近，所述第一视觉系统智能获取起点位置， 并且开始处理；
[0060] 本实施例中处理装置的工作坐标系XYZ，W处理装置的安装位置的中屯、为原点0， W寻踪处理设备长度方向为X方向，垂直于寻踪处理设备上平面的方向为Z方向，与面XZ 垂直方向为Y方向，寻踪处理设备在运动过程中沿着X方向前进，且绕着Z方向转动；第一 相机坐标系UVW，原点〇1，所述第二相机的坐标系为RST，原点化，上述S个坐标系可W相互 转换。
[0061] S2 ;所述第一视觉系统打开，向待处理表面发射激光，并收集激光投影与待测踪迹 图像至所述处理器；
[0062] 线型激光器打开，第一相机获取激光线投影及行走系统前方待焊焊缝的图像；第 一相机将光线与踪迹位置数据传送至所述第一处理器，图像数据处理器确定系统需绕W方 向调整的角度与系统在V方向调整的距离，并传送至所述行动控制器；