机器手臂的坐标校正方法技术

本发明专利技术提供一种机器手臂的坐标校正方法，包含步骤：(a)在机器手臂于工作空间中运作时，依据移动命令控制机器手臂进行移动，并利用三维测量装置取得机器手臂所到达的参考定位点；(b)依据参考定位点取得参考坐标系；(c)机器手臂离开工作空间，而在机器手臂回到工作空间中运作时，依据移动命令控制机器手臂进行移动，并利用三维测量装置取得机器手臂所到达的实际定位点；(d)依据实际定位点取得实际坐标系，并依据参考坐标系及实际坐标系计算取得坐标补正信息；以及(e)依据坐标补正信息调整机器手臂，使机器手臂维持运作于参考坐标系。使机器手臂维持运作于参考坐标系。使机器手臂维持运作于参考坐标系。

【技术实现步骤摘要】
机器手臂的坐标校正方法


[0001]本专利技术涉及一种坐标校正方法，尤其涉及一种机器手臂的坐标校正方法。

技术介绍

[0002]如今，机器人在各个产业上的应用愈加广泛。机器人在运作过程中可能受载台移动而往返于不同的场域或工作站，而非固定运作于特定的工作站。于此情况下，若机器人移动至任一工作站时，均需重新建立坐标系并进行教点，以确保工作精度。然而，重复建立坐标系及教点将耗费大量时间，导致工作效率降低，且难以确保每次确立的坐标系均完全相同，可能使得机器手臂的工作精度下降。
[0003]因此，如何发展一种可改善上述公知技术的机器手臂的坐标校正方法，实为目前迫切的需求。

技术实现思路

[0004]本专利技术的目的在于提供一种机器手臂的坐标校正方法，其通过三维测量装置建立工作空间的参考坐标系，在机器手臂暂离后回到该工作空间时，通过三维测量装置获取实际坐标系，并依据参考坐标系与实际坐标系间的差异对机器手臂进行调整，使机器手臂仍维持运作于参考坐标系中。由此，无需重复建立坐标系及进行教点，可提升工作效率，且由于机器手臂始终运作于参考坐标系中，故可有效确保机器手臂的高精度。
[0005]为达上述目的，本专利技术提供一种机器手臂的坐标校正方法，其中机器手臂设置于可动载台上及运作于至少一工作空间中，工作空间中设置有三维测量装置，三维测量装置架构于测量机器手臂的位置。坐标校正方法包含步骤：(a)在机器手臂受可动载台移动而至工作空间中运作时，依据移动命令控制机器手臂进行移动，并利用三维测量装置取得机器手臂所到达的至少三个参考定位点；(b)依据至少三个参考定位点计算取得旋转矩阵及平移向量，并依据旋转矩阵及平移向量计算取得相应的参考坐标系；(c)机器手臂受可动载台移动而离开工作空间，而在机器手臂回到工作空间中运作时，依据移动命令控制机器手臂进行移动，并利用三维测量装置取得机器手臂所到达的至少三个实际定位点；(d)依据至少三个实际定位点计算取得旋转矩阵及平移向量，进而计算取得相应的实际坐标系，再通过比较参考坐标系及实际坐标系的旋转矩阵及平移向量，计算取得坐标补正信息；以及(e)依据坐标补正信息调整机器手臂，使机器手臂维持运作于参考坐标系。
[0006]本专利技术的有益效果在于，本专利技术提供一种机器手臂的坐标校正方法，其通过三维测量装置建立工作空间的参考坐标系，在机器手臂暂离后回到该工作空间时，通过三维测量装置获取实际坐标系，并依据参考坐标系与实际坐标系间的差异对机器手臂进行调整，使机器手臂仍维持运作于参考坐标系中。由此，无需重复建立坐标系及进行教点，可提升工作效率，且由于机器手臂始终运作于参考坐标系中，故可有效确保机器手臂的高精度。
附图说明
[0007]图1为本专利技术较佳实施例的机器手臂、工作空间及三维测量装置的立体结构示意图。
[0008]图2为图1的三维测量装置的立体结构示意图。
[0009]图3为本专利技术较佳实施例的机器手臂的坐标校正方法的流程示意图。
[0010]附图标记如下：
[0011]1：机器手臂
[0012]2：工作平台
[0013]3：三维测量装置
[0014]31：球形体
[0015]32：基座
[0016]33：测量模块
[0017]34：测量结构
[0018]4：工具
[0019]5：可动载台
[0020]S1、S2、S3、S4、S5：坐标校正方法的步骤
具体实施方式
[0021]体现本专利技术特征与优点的一些典型实施例将在后段的说明中详细叙述。应理解的是本专利技术能够在不同的方式上具有各种的变化，其皆不脱离本专利技术的范围，且其中的说明及图示在本质上当作说明之用，而非架构于限制本专利技术。
[0022]为了更易于了解本专利技术技术，以下将以图1及图2示例说明机器手臂、可动载台及三维测量装置与其所在的工作空间的具体方式，然而须注意的是，工作空间及三维测量装置的可能实施方式并不以此为限，仅需确保三维测量装置的设置位置维持固定，且可在工作空间中测量机器手臂的位置/坐标即可。
[0023]图1为本专利技术较佳实施例的机器手臂、工作空间及三维测量装置的立体结构示意图，图2为图1的三维测量装置的立体结构示意图。如图1及图2所示，其中以工作平台2代表三维测量装置3所在的工作空间，三维测量装置3固设于工作平台2上，机器手臂1设置于可动载台5上，且机器手臂1受可动载台5带动而与之同步移动。当然，于实际应用中，工作平台2上亦将设置机器手臂1在运作过程中相互动的元件或装置，此处为便于说明建立坐标过程而仅于图中示出工作平台2上的三维测量装置3。机器手臂1可为例如但不限于六轴型机器手臂或选择顺应性装配机器手臂(SCARA机器手臂)。三维测量装置3架构于测量机器手臂1的位置/坐标，且包含球形体31、基座32及三个测量模块33。球形体31可拆卸地组接于机器手臂1，且受机器手臂1带动而同步移动或转动。三个测量模块33均设置于基座32上，其中每一测量模块33包含测量结构34及位置感测器。三个测量模块33的三个测量结构34分别于X轴、Y轴及Z轴方向上移动，且均与球形体31接触。位置感测器架构于在对应的测量结构34被球形体31推动时感测测量结构34的移动距离，其中位置感测器可为例如但不限于由光学尺所构成。
[0024]请参阅图3，图3为本专利技术较佳实施例的机器手臂的坐标校正方法的流程示意图。
首先，在机器手臂1受可动载台5移动至工作空间(例如：工作平台2)中运作时，依据移动命令控制机器手臂1进行移动，并利用三维测量装置3取得机器手臂1所到达的至少三个参考定位点(步骤S1)。移动命令可例如但不限于包含控制机器手臂1以不同的操作动作进行至少三次移动。接着，依据该至少三个参考定位点建立参考坐标系(步骤S2)。接着，机器手臂1受可动载台5移动而离开工作空间，而在机器手臂1回到工作空间中运作时，依据移动命令控制机器手臂1进行移动，并利用三维测量装置3取得机器手臂1所到达的至少三个实际定位点(步骤S3)，其中实际定位点的数量与参考定位点的数量相同。而后，依据至少三个实际定位点取得实际坐标系，并依据参考坐标系及实际坐标系计算取得坐标补正信息(步骤S4)。最后，依据坐标补正信息调整机器手臂1，使机器手臂1维持运作于参考坐标系(步骤S5)。
[0025]由此可知，在机器手臂1初次移动至工作空间时，建立参考坐标系。在建立参考坐标系后，即便机器手臂1移动至其他工作空间或场域，在机器手臂1回到已建立参考坐标系的工作空间时，可通过比较参考坐标系及实际坐标系迅速调整机器手臂1，而使机器手臂1仍可运作于原先建立的参考坐标系中，无需重新建立坐标系及进行教点，由此，可大幅机器手臂1的工作效率及精度。
[0026]请再参阅图1至图3所示，上述三个测量结构34分别沿对应各个轴向(X轴、Y轴及Z轴)的可移动距离共同定义测量空间，于坐标校正方法的步骤S1及步骤S3中，球形体31受机器手臂1带动而于测量空间中移动，三个位置感测器的感测结果反映球形体31的三维坐本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机器手臂的坐标校正方法，其中该机器手臂设置于一可动载台上及运作于至少一工作空间中，该工作空间中设置有一个三维测量装置，该三维测量装置架构于测量该机器手臂的位置，该坐标校正方法包含步骤：(a)在该机器手臂受该可动载台移动而至该工作空间中运作时，依据一移动命令控制该机器手臂进行移动，并利用该三维测量装置取得该机器手臂所到达的至少三个参考定位点；(b)依据该至少三个参考定位点计算取得一旋转矩阵及一平移向量，并依据该旋转矩阵及该平移向量计算取得相应的一参考坐标系；(c)该机器手臂受该可动载台移动而离开该工作空间，而在该机器手臂回到该工作空间中运作时，依据该移动命令控制该机器手臂进行移动，并利用该三维测量装置取得该机器手臂所到达的至少三个实际定位点；(d)依据该至少三个实际定位点计算取得一旋转矩阵及一平移向量，进而计算取得相应的一实际坐标系，再通过比较该参考坐标系及该实际坐标系的该旋转矩阵及该平移向量，计算取得一坐标补正信息；以及(e)依据该坐标补正信息调整该机器手臂，使该机器手臂维持运作于该参考坐标系。2.如权利要求1所述的机器手臂的坐标校正方法，其中该移动命令包含控制该机器手臂以不同的操作动作进行至少三次移动。3.如权利要求1所述的机器手臂的坐标校正方法，其中该机器手臂的该旋转矩阵的等式如下：式如下：式如下：式如下：其中，P0、P
x
及P
y
代表三个该定位点，及分别代表X轴、Y轴及Z轴的单位向量，R代表该机器手臂的该旋转矩阵。4.如权利要求3所述的机器手臂的坐标校正方法，其中该机器手臂的该平移向量的等式如下：其中P
x0
、P
y0
及P
z0
代表该机器手臂的档点位置，代表该机器手臂的该平移向量。5.如权利要求4所述的机器手...

【专利技术属性】
技术研发人员：邵启焕，张启舜，
申请(专利权)人：台达电子工业股份有限公司，
类型：发明
国别省市：