本发明所设计的工件装在机器人上的轨迹生成实现方法，使用工件参数或实际扫描得出的较优点集建立多个虚拟坐标系，所述的虚拟坐标系只进行轨迹计算，不参与控制机器人运动；通过上述建立的虚拟坐标系之间的旋转平移关系和工件焊缝模型计算得出轨迹，控制机器人使用自带的法兰盘坐标系行走计算出的轨迹，使得焊缝点集都经过同一点，以进行扫描或焊接。这种机器人焊接轨迹生成的方法通过所建立的虚拟坐标系计算轨迹后，直接由法兰盘坐标系控制机器人的行走轨迹，从而规避了手动标定TCP对机器人绝对精度的影响；规避了除机器人以外进行的机械运动，减少了机械复杂度的同时，提高了工件焊接精度，且可适用于所有存在焊缝模型且可安装在机器人上的工件。
1.一种工件装在机器人上轨迹生成实现方法，其特征在于分为以下步骤：
S1.已知机器人固有坐标系为机器人法兰盘坐标系CF，机器人基座坐标系Cb，且根据焊接工件和焊缝形成的截面上分别建立工件坐标系Ct与焊缝坐标系Cf；
S2.通过已知的焊接工件参数，求取工件坐标系Ct与焊缝坐标系Cf之间的旋转平移关系，为3×3的旋转矩阵R(Ct‑Cf)与3×1的平移矩阵T(Ct‑Cf)相加，得出Ct×R(Ct‑Cf)+T(Ct‑Cf)＝Cf；逆运算求得旋转矩阵R(Cf‑Ct)，得出Cf×R(Cf‑Ct)‑T(Ct‑Cf)＝Ct；
S3.根据上述坐标系之间的旋转平移计算公式与机器人的位姿数据，得出机器人法兰盘坐标系CF与机器人基座坐标系Cb之间的旋转平移关系，为3×3的旋转矩阵R(Cb‑CF)与3×1的平移矩阵T(Cb‑CF)；
S5.通过观察测量或标定方法确定工件坐标系Ct与法兰盘坐标系CF的关系，得出法兰盘坐标系CF与工件坐标系Ct之间的旋转平移关系为3×3的旋转矩阵R(CF‑Ct)与3×1的平移矩阵T(CF‑Ct)；
S6.通过已知的工件参数与焊接工件装夹在法兰盘夹具上的模型，得出焊缝上任意点的坐标 所述的任意点坐标 的全局坐标系为焊缝坐标系Cf，且需要在每一焊缝点上建立焊缝点坐标系 焊缝点坐标系 的建立由任意焊缝点的最优焊接姿态与焊缝坐标系Cf决定，得出焊缝坐标系Cf与任意的焊缝点坐标系 之间的旋转平移关系为3×3的旋转矩阵 和3×1的平移矩阵S7.根据上述步骤中得出的所有旋转平移关系，得出任意的焊缝点坐标系 与机器人基座坐标系Cb的旋转平移关系，得出焊缝上的任意焊缝点在机器人基座坐标系Cb下的位姿，任意的焊缝点坐标系 与机器人法兰盘坐标系CF的关系；
S8.获取位于机器人基座坐标系Cb下的扫描点P，且根据实际需求建立P点坐标系，所述的P点坐标系的全局坐标系为机器人基座坐标系Cb，得出P点坐标系Cp与机器人基座标系Cb之间的旋转平移关系；
S9.通过上述得出的P点坐标系Cp与机器人基座标系Cb之间的旋转平移关系、任意的焊缝点坐标系 与机器人法兰盘坐标系CF之间的旋转平移关系，反向推出在任意的焊缝点坐标系 经过P点坐标系Cp时，机器人法兰盘坐标系CF与机器人基座标系Cb之间的旋转平移关系，将前述的旋转平移关系转换为机器人的位姿；
S10.将上述得出的机器人位姿，发送至机器人处，从而驱动机器人通过法兰盘坐标系CF举着工件进行扫描运动，使得所有焊缝点经过扫描点P；
S11.通过上述机器人的扫描运动中，视觉传感器采集到的焊缝图像的坐标数据，机器人同步给出当前机器人基座坐标系Cb下法兰盘位姿，且视觉传感器采集到的焊缝图像的坐标数据通过手眼标定的方式得出的转换关系，算出焊缝在机器人基座坐标系Cb下对应的坐标值，公式如下： 处对应的基座坐标(Xbuv,Ybuv,Zbuv)；
S12.所述的机器人基座坐标系Cb下对应坐标值为位于扫描点四周的离散无规则点，同时已知前述的离散无规则点对应的法兰盘位姿，经由反向推导得出离散无规则点在法兰盘坐标系CF下的位置，使得离散无规则点形成与焊接工件的焊缝相似点，将焊接工件的焊缝′模型与前述的焊缝相似点进行过滤，拟合，插值，根据拟合的数据重新建立焊缝坐标系Cf 和焊缝点坐标系 根据上述的旋转平移关系步骤，得出焊缝点坐标系 与机器人法兰盘坐标系CF的旋转平移关系；
S13.获取位于机器人基座坐标系Cb下的焊接点P ，重复S8、S9的工作流程，得到机器人的焊接轨迹。
2.根据权利要求1所述的工件装在机器人上轨迹生成实现方法，其特征在于所述的步骤S1中焊缝坐标系Cf的建立由工件坐标系Ct与焊接工件参数决定，同时工件坐标系Ct为焊缝坐标系Cf的全局坐标系；工件坐标系Ct的建立需根据焊接工件特征，遵循易观测原则。
3.根据权利要求1所述的工件装在机器人上轨迹生成实现方法，其特征在于所述的扫描点P为固定设置的虚拟点，扫描点P的位置位于当焊缝处于扫描点P时，传感器中的图像最′ ′清晰；同时将焊枪枪尖在机器人基座标系下的位置设置为焊接点P ，当焊缝处于焊接点P的位置时，机器人远离奇异位置且姿态较为舒适。
4.根据权利要求1所述的工件装在机器人上轨迹生成实现方法，其特征在于所述的步骤S8中建立的P点坐标系Cp是根据实际需求，此实际需求指的是扫描或焊接时，工件焊缝与视觉传感器或焊枪的关系。
工件装在机器人上的轨迹生成实现方法
技术领域
[0001] 本发明涉及机器人控制领域，具体涉及工件装在机器人上的轨迹生成实现方法。
背景技术
[0002] 在现有技术中在现有技术中随着机器人的普及，在工业上逐步替代了人工的焊接方式，来进行多种类型的工件焊接，一般通过两种方法控制机器人的行走，一种是手操器示教位置，使机器人按照示教的位置重复行走，这种方法适应性差，对工件拼装以及定位要求高，同时需要一定的机器人工作经验；另一种由外部程序生成焊接轨迹，发送轨迹控制机器人的行走，一般是工件放置在机器人周围，根据工件参数与放置位置生成机器人焊枪的移动轨迹，使得焊枪围绕着工件进行扫描焊接，这种方法需要标定外部工具TCP，难以校准绝对精度，且对于某些工件需配合变位机或外部轴，增加了系统复杂性。
发明内容
[0003] 为了解决上述问题，本发明提供了规避了手动标定的TCP精度对机器人变姿态行走的绝对精度的影响，规避了除机器人外的机械，提高了精度，减少了机械复杂度的工件装在机器人上的轨迹生成实现方法。
[0004] 为了到达上述目的，本发明设计的工件装在机器人上轨迹生成实现方法，其特征在于分为以下步骤：
[0005] S1.已知机器人固有坐标系为机器人法兰盘坐标系CF，机器人基座坐标系Cb，且根据焊接工件和焊缝形成的截面上分别建立工件坐标系Ct与焊缝坐标系Cf；
[0006] S2.通过已知的焊接工件参数，求取工件坐标系Ct与焊缝坐标系Cf之间的旋转平移关系，为3×3的旋转矩阵R(Ct‑Cf)与3×1的平移矩阵T(Ct‑Cf)相加，得出Ct×R(Ct‑Cf)+T(Ct‑Cf)＝Cf；逆运算求得旋转矩阵R(Cf‑Ct)，得出Cf×R(Cf‑Ct)‑T(Ct‑Cf)＝Ct；
[0007] S3.根据上述坐标系之间的旋转平移计算公式与机器人本身可以得到TCP坐标系所在的位姿数据，从而得出机器人法兰盘坐标系CF与机器人基座坐标系Cb之间的旋转平移关系，为3×3的旋转矩阵R(Cb‑CF)与3×1的平移矩阵T(Cb‑CF)；
[0008] S4.将焊接工件装夹在法兰盘夹具上；
[0009] S5.通过观察测量或标定方法确定工件坐标系Ct与法兰盘坐标系CF的关系，得出法兰盘坐标系CF与工件坐标系Ct之间的旋转平移关系为3×3的旋转矩阵R(CF‑Ct)与3×1的平移矩阵T(CF‑Ct)；
[0010] S6.通过已知的工件参数与焊接工件装夹在法兰盘夹具上的模型，得出焊缝上任意点的坐标 所述的任意点坐标 的全局坐标系为焊缝坐标系Cf，且需要在每一焊缝点上建立焊缝点坐标系 焊缝点坐标系 的建立由任意焊缝点的最优焊接姿态与焊缝坐标系Cf决定，得出焊缝坐标系Cf与任意的焊缝点坐标系 之间的旋转平移关系为3×3的旋转矩阵 和3×1的平移矩阵
[0011] S7.根据上述步骤中得出的所有旋转平移关系，得出任意的焊缝点坐标系 与机器人基座坐标系Cb的旋转平移关系，得出焊缝上的任意焊缝点在机器人基座坐标系Cb下的位姿，任意的焊缝点坐标系 与机器人法兰盘坐标系CF的关系；
[0012] S8.获取位于机器人基座坐标系Cb下的扫描点P，且根据实际需求建立P点坐标系，所述的P点坐标系的全局坐标系为机器人基座坐标系Cb，得出P点坐标系Cp与机器人基座标系Cb之间的旋转平移关系；
[0013] S9.通过上述得出的P点坐标系Cp与机器人基座标系Cb之间的旋转平移关系、任意的焊缝点坐标系 与机器人法兰盘坐标系CF之间的旋转平移关系，反向推出在任意的焊缝点坐标系 经过P点坐标系Cp时，机器人法兰盘坐标系CF与机器人基座标系Cb之间的旋转平移关系，将前述的旋转平移关系转换为机器人的位姿；
[0014] S10.将上述得出的机器人位姿，发送至机器人处，从而驱动机器人通过法兰盘坐标系CF举着工件进行扫描运动，使得所有焊缝点经过扫描点P；
[0015] S11.通过上述机器人的扫描运动中，视觉传感器采集到的焊缝图像的坐标数据，机器人同步给出当前机器人基座坐标系Cb下法兰盘位姿，且视觉传感器采集到的焊缝图像的坐标数据通过手眼标定的方式得出的转换关系，算出焊缝在机器人基座坐标系Cb下对应的坐标值，公式如下： 处对应的基座坐标(Xbuv,Ybuv,Zbuv)；
[0016] S12.所述的机器人基座坐标系Cb下对应坐标值为位于扫描点四周的离散无规则点，同时已知前述的离散无规则点对应的法兰盘位姿，经由反向推导得出离散无规则点在法兰盘坐标系CF下的位置，使得离散无规则点形成与焊接工件的焊缝相似点，将焊接工件的焊缝模型与前述的焊缝相似点进行过滤，拟合，插值，根据拟合的数据重新建立焊缝坐标系Cf′和焊缝点坐标系 根据上述的旋转平移关系步骤，得出焊缝点坐标系 与机器人法兰盘坐标系CF的旋转平移关系；
[0017] S13.获取位于机器人基座坐标系Cb下的焊接点P′，重复S8、S9的工作流程，得到机器人的焊接轨迹。
[0018] 为了进一步达到上述目的，S1中焊缝坐标系Cf的建立由工件坐标系Ct与焊接工件参数决定，同时工件坐标系Ct为焊缝坐标系Cf的全局坐标系；工件坐标系Ct的建立需根据焊接工件特征，遵循易观测原则；所述的易观测原则为当焊接工件装夹在法兰盘夹具上时，能够较为方便的确定工件坐标系Ct与法兰盘坐标系CF的关系；所述的扫描点P为固定设置的虚拟点，扫描点P的位置位于当焊缝处于扫描点P时，传感器中的图像最清晰；同时将焊枪枪尖在机器人基座标系下的位置设置为焊接点P′，当焊缝处于焊接点P′的位置时，机器人远离奇异位置且姿态较为舒适；且所述的步骤S8中建立的P点坐标系Cp是根据实际需求确立的，前述的实际需求具体指代在扫描或焊接的过程中，工件焊缝与视觉传感器或焊枪的关系，由于此方法本质求的是当焊缝点坐标系 与Cp重合时，法兰盘坐标系CF与基座坐标系Cb的旋转平移关系，因此Cp的建立会影响焊接或扫描时，工件焊缝上的点经过点P时与视觉传感器或焊枪的关系，因此需根据实际需求确定。且控制机器人行走计算所得出的轨迹，所使用的工具坐标系都是机器人自带的法兰盘坐标系。
[0019] 这种结构的设置相较于现有的机器人生成焊机轨迹的方法，通过对焊缝坐标系Cf中的各个焊缝点都建立虚拟的TCP坐标系，以及对每个建立在焊缝点上的TCP坐标系都根据视觉传感器采集到的焊缝图像的坐标数据进行调整，使焊缝上的每个TCP坐标系都与设定好的固定坐标系重合，从而提升焊接机器人的焊接精度；同时所有存在模型可使用公式计算焊接轨迹且大小合适的工件，都可以安装在机器人端进行焊接，提升了工件的制造柔性，且机械结构简单。
[0020] 本发明所设计的工件装在机器人上的轨迹生成实现方法，首先在焊接工件上建立工件坐标系Ct与焊缝坐标系Cf后，通过求取前述的坐标系之间的旋转平移关系，将焊接工件装夹在法兰盘夹具上，求取工件坐标系Ct与机器人法兰盘坐标系CF之间的旋转平移关系，同时根据焊接工件参数与焊缝模型，得出焊缝工件中的任意的焊缝点坐标 所述的焊缝点坐标 以焊缝坐标系Cf为全局坐标系，将任意的焊缝点建立焊缝点坐标系 得出焊缝点坐标系 与机器人基座坐标系Cb之间的旋转平移关系，即得出知焊缝上任意的焊缝点在机器人基座坐标系Cb下的位姿，亦可知焊缝上任意的焊缝点坐标系 在机器人法兰盘坐标系CF下的旋转平移关系，通过建立P点坐标系Cp，可知Cp与机器人基座坐标系Cb的旋转平移关系，则使焊缝点坐标 经过P点，且坐标系重合时，法兰盘坐标系CF与机器人基座坐标系Cb的旋转平移关系，即法兰盘在机器人基座坐标系Cb下的位姿。通过机器人基座坐标系Cb下设置的扫描点P对焊接工件进行扫描后，同时对焊缝图像的坐标数据进行采集，形成一堆位于机器人基座坐标系Cb下的坐标点，且每个坐标点都对应一个法兰盘的位姿，根据程序计算得出焊缝点在法兰盘坐标系CF下形成一个散开的焊接轨迹，进行拟合计算后，得到焊接轨迹的参数，最后将得到的焊接轨迹的参数转换为法兰盘的移动轨迹，驱动法兰盘的移动；从而进行工件的焊接。
附图说明
[0021] 图1是建立的工件坐标系与焊缝坐标系的视图。
[0022] 图2是焊接点P＇点与焊缝坐标系的视图
[0023] 图3是在焊缝坐标系上建立任意焊缝点坐标系的视图。
[0024] 图4是经过视觉传感器纠正后的任意焊缝点经过焊接点P＇的视图。
具体实施方式
[0025] 为更进一步阐述本发明为实现预定发明目的所采取的技术手段及功效，以下结合附图及较佳实施例，对依据本发明的具体实施方式、结构、特征及其功效，详细说明如后。
[0026] 实施例1。
[0027] 本实施例描述的工件装在机器人上的轨迹生成实现方法，以一个底部为标准圆设置的虾米腰弯头工件为例。根据虾米腰弯头底部直径与弯头的弯曲角度两个参数，以虾米腰弯头底部圆心为坐标原点，弯头转弯方向为X轴，设置工件坐标系Ct，坐标轴为Xt、Yt、Zt，以虾米腰弯头焊缝切面的椭圆圆心为坐标原点，依据工件坐标系Ct，设置焊缝坐标系Cf，坐标轴为Xf、Yf、Zf；得到图1。
[0028] 第一步确定扫描点P与焊接点P＇的位置以及坐标系，实例中焊枪和视觉传感器都垂直地面安装，根据焊接和扫描的实际要求，焊缝平面的法向量要与枪或传感器垂直，因此焊接或扫描时焊缝坐标系Cf的Z轴与地面平行，由于运动过程中焊缝点坐标系 与Cp需重合，焊缝点坐标系 的坐标已确定，因此Cp由经过P点时的 确定。因此扫描点P的坐标系Cp如图2。
[0029] 第二步根据焊接工件参数，求取工件坐标系Ct与焊缝坐标系Cf之间的旋转平移关系为一个3×3的旋转矩阵R(Ct‑Cf)加3×1的平移矩阵T(Ct‑Cf)，得出R(Ct‑Cf)×Ct+T(Ct‑Cf)＝Cf后；通过逆运算求得旋转矩阵R(Cf‑Ct)，进而得出R(Cf‑Ct)×Cf‑T(Ct‑Cf)＝Ct；由机器人的位姿数据得到机器人法兰盘坐标系CF与机器人基座坐标系Cb之间的旋转平移关系为一个3×3的旋转矩阵R(Cb‑CF)加3×1的平移矩阵T(Cb‑CF)。
[0030] 第三步将虾米腰弯头装夹在法兰盘夹具上，法兰盘夹具安装在法兰盘上，同时已知法兰盘夹具的参数，得出法兰盘坐标系CF与工件坐标系Ct之间的旋转平移关系为3×3的旋转矩阵R(CF‑Ct)与3×1的平移矩阵T(CF‑Ct)；根据虾米腰弯头工件参数与虾米腰弯头焊缝模型，也就是椭圆得参数方程，计算出虾米腰弯头上任意的焊缝点坐标 焊缝点坐标的全局坐标系为焊缝坐标系Cf，同时在每个焊缝点坐标 上都建立焊缝点坐标系 得出图3；焊缝坐标系Cf与任意的焊缝点坐标系 之间的旋转平移关系为3×3的旋转矩阵和3×1的平移矩阵
[0031] 第四步通过上述的步骤得出任意的焊缝点坐标系 与机器人基座坐标系Cb的旋转平移关系，得出虾米腰弯头上任意的焊缝点在机器人基座坐标系Cb下的位姿，同时可知焊缝点坐标系 与机器人法兰盘坐标系CF的关系。
[0032] 第五步已知扫描点P点坐标系Cp，得出建立P点坐标系Cp与机器人基座标系Cb之间的旋转平移关系；通过上述的P点坐标系Cp与机器人基座标系Cb的旋转平移关系和任意的焊缝点坐标系 与机器人法兰盘坐标系CF的旋转平移关系，反推出在任意的焊缝点坐标系经过P点坐标系Cp时，机器人法兰盘坐标系CF与机器人基座标系Cb之间的旋转平移关系，即得出法兰盘坐标系CF的行走位姿，通过将上述的机器人位姿，发送给机器人，驱动机器人使用法兰盘坐标系，使得所有焊缝点经过扫描点P。
[0033] 第六步在机器人举着工件在扫描点P扫描过程中，传感器实时采集到焊缝图像中的坐标数据，视觉传感器采集到的焊缝图像的坐标数据通过手眼标定生成的标定矩阵得出的转换关系，算出焊缝在机器人基座坐标系Cb下对应的坐标值，
[0034] 处对应的基座坐标(Xbuv,Ybuv,Zbuv)；由于工件尺寸与安装位置的误差，上述得到的需经过扫描点P的焊缝轨迹大多会有误差，分布在扫描点P四周；每接收一个传感器发送的点，上位机同时记录此时机器人法兰盘坐标系CF在机器人基座坐标系Cb下的位姿。
[0035] 第七步将上述得到经过标定矩阵转换后图像坐标对应的聚集在扫描P点周围的离散无规则点集，通过对应的法兰盘坐标系CF在机器人基座坐标系Cb下的旋转矩阵，转换成在法兰盘坐标系CF下的位置，此时离散点变成有模型的规律点集，可使用焊缝模型对所得点集进行过滤，拟合，插值处理，利用处理过后的点集和拟合的数据重新建立工件上的焊缝坐标系Cf′和任意焊缝点坐标系 得出到任意焊缝点坐标系 与法兰盘坐标系CF的旋转平移关系。
[0036] 第八步已知焊接点P＇坐标系Cp，重复第四与第五步即可使经过视觉传感器纠正后的焊缝点准确的经过焊接点P＇，得到图4。
[0037] 以上所述，仅是本发明的较佳实施例而已，并非对本发明作任何形式上的限制，虽然本发明已以较佳实施例揭示如上，然而并非用以限定本发明，任何本领域技术人员，在不脱离本发明技术方案范围内，当可利用上述揭示的技术内容做出些许更动或修饰为等同变化的等效实施例，但凡是未脱离本发明技术方案内容，依据本发明的技术实质对以上实施例所作的任何简介修改、等同变化与修饰，均仍属于本发明技术方案的范围内。
