一种操作速度获取方法及装置的制造方法
【技术领域】
[0001] 本发明涉及机器人控制技术领域，特别是涉及一种操作速度获取方法及装置。
【背景技术】
[0002] 在现有机器人应用的工业中，例如制衣，均应用了大量的机器人来代替人工，故机 器人的控制如何达到准确高效成为一直以来厂商所追求的目标，在机器人控制中，机器人 操作工件时工件相对于参考点的移动速度是一个重要的参考指标，但目前并没有比较好的 速度获取方式。
【发明内容】
[0003] 鉴于以上所述现有技术的缺点，本发明的目的在于提供一种操作速度获取方法及 装置，解决现有技术中的各种缺陷。
[0004] 为实现上述目标及其他相关目标，本发明提供一种操作速度获取方法，包括：在预 定的工件移动空间内建立坐标系，在所述坐标系内定义所述工件各边缘点且将其中至少一 边缘点作为对齐点，并在工件定义第一操作点；在所述工件移动空间内定义外部控制点，所 述外部控制点供所述对齐点移动至与其重合；所述操作装置在所述第一操作点操作所述工 件移动，所述移动包括：工件平移至所述对齐点和外部控制点重合；或者，在所述对齐点和 外部控制点重合的情况下，工件绕所述外部控制点进行转动；根据平移前的对齐点坐标及 外部控制点坐标获得平移矢量，在所述第一操作点通过所述平移到达第二操作点时，根据 平移矢量及第一操作点坐标计算平移后的第二操作点坐标，据以计算所述第一操作点平移 至第二操作点的第一坐标移动量；在所述第二操作点通过所述转动到达第三操作点时，结 合转动角度计算所述第三操作点的坐标，据以计算第二操作点转动至第三操作点的第二坐 标移动量；结合所述第一坐标移动量及第二坐标移动量以计算出总移动量；根据所述总移 动量计算工件的移动距离；结合所述第一操作点移动至第三操作点的时间、及所计算的工 件的移动距离，计算工件相对外部控制点的移动速度。
[0005] 可选的，所述的操作速度获取方法，还包括：获取工件的各所述边缘点进行所述移 动后的坐标。
[0006] 可选的，所述的操作速度获取方法，所述外部控制点位于预设的法线上，所述工件 上每两个边缘点构成一线段；每次的所述转动是将所述工件转动至令其边缘的一所述线段 同所述法线重合，所述工件的转动角度是通过计算所述线段转动至同法线重合的转动角度 而获得的。
[0007] 可选的，所述转动角度等于：在第二操作点通过所述转动到达第三操作点时，第二 操作点和外部控制点连线同第三操作点和外部控制点连线间的夹角。
[0008] 可选的，所述坐标系包括：X轴、Y轴、Z轴及U轴，其中，所述U轴是转动轴，以角度 为单位。
[0009] 为实现上述目标及其他相关目标，本发明提供一种操作速度获取装置，包括：坐标 定义单元及工件移动速度获取单元；所述坐标定义单元，用于在预定的工件移动空间内建 立坐标系，在所述坐标系内定义所述工件各边缘点且将其中至少一边缘点作为对齐点，并 在工件定义第一操作点；在所述工件移动空间内定义外部控制点，所述外部控制点供所述 对齐点移动至与其重合；所述操作装置在所述第一操作点操作所述工件移动，所述移动包 括：工件平移至所述对齐点和外部控制点重合；或者，在所述对齐点和外部控制点重合的 情况下，工件绕所述外部控制点进行转动；所述工件移动速度获取单元，用于根据平移前的 对齐点坐标及外部控制点坐标获得平移矢量，在所述第一操作点通过所述平移到达第二操 作点时，根据平移矢量及第一操作点坐标计算平移后的第二操作点坐标，据以计算所述第 一操作点平移至第二操作点的第一坐标移动量；在所述第二操作点通过所述转动到达第三 操作点时，结合转动角度计算所述第三操作点的坐标，据以计算第二操作点转动至第三操 作点的第二坐标移动量；结合所述第一坐标移动量及第二坐标移动量以计算出总移动量； 根据所述总移动量计算工件的移动距离；结合所述第一操作点移动至第三操作点的时间、 及所计算的工件的移动距离，计算工件相对外部控制点的移动速度。。
[0010] 可选的，所述坐标转化单元，还用于获取工件的各所述边缘点进行所述移动后的 坐标。
[0011] 可选的，所述外部控制点位于预设的法线上，所述工件上每两个边缘点构成一线 段；每次的所述转动是将所述工件转动至令其边缘的一所述线段同所述法线重合，所述工 件的转动角度是通过计算所述线段转动至同法线重合的转动角度而获得的。
[0012] 可选的，所述转动角度等于：在第二操作点通过所述转动到达第三操作点时，第二 操作点和外部控制点连线同第三操作点和外部控制点连线间的夹角。
[0013] 可选的，所述坐标系包括：X轴、Y轴、Z轴及U轴，其中，所述U轴是转动轴，以角度 为单位。
[0014] 如上所述，本发明的目的在于提供一种操作速度获取方法及装置，在预定的工件 移动空间内建立坐标系，在所述坐标系内定义所述工件各边缘点且将其中至少一边缘点作 为对齐点，并在工件定义第一操作点；在所述工件移动空间内定义外部控制点，所述外部控 制点供所述对齐点移动至与其重合；所述操作装置在所述第一操作点操作所述工件移动， 所述移动包括：工件平移至所述对齐点和外部控制点重合；或者，在所述对齐点和外部控 制点重合的情况下，工件绕所述外部控制点进行转动或再平移；进行工件操作过程中的坐 标移动量的计算以得到工件的移动距离，并根据所述移动距离及操作过程的时间得到工件 相对外部控制点的移动速度；本发明简单易行。
【附图说明】
[0015] 图1显示为本发明一实施例中操作速度获取方法的流程示意图。
[0016] 图2a显示为本发明一实施例中平移操作的计算原理示意图。
[0017] 图2b显示为本发明一实施例中转动操作的计算原理示意图。
[0018] 图3显示为本发明一实施例中操作速度获取装置的结构示意图。
[0019] 元件标号说明
[0020] 1 操作速度获取装置
[0021] 11 坐标定义单元
[0022] 12 工件移动速度获取单元
[0023] Sl~S6 方法步骤
【具体实施方式】
[0024] 以下通过特定的具体实例说明本发明的实施方式，本领域技术人员可由本说明书 所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实 施方式加以实施或应用，本说明书中的各项细节也可以基于不同观点与应用，在没有背离 本发明的精神下进行各种修饰或改变。需说明的是，在不冲突的情况下，本申请中的实施例 及实施例中的特征可以相互组合。
[0025] 如图1所示，本发明提供一种操作速度获取方法，应用在例如缝纫作业中，所述工 件例如为缝纫布料，所述操作装置例如为机械臂等。
[0026] 所述方法包括：
[0027] 步骤Sl:在预定的工件移动空间内建立坐标系，在所述坐标系内定义所述工件各 边缘点且将其中至少一边缘点作为对齐点，并在工件定义第一操作点；在所述工件移动空 间内定义外部控制点。
[0028] 在一实施例中，所述空间坐标系例如为四轴（如X横轴、Y纵轴、Z上下轴、U转动 轴）的坐标系，操作装置所在的轴为U轴，实际上，空间坐标系可以只有三个轴，这个"U轴" 是另外定义出来以角度为刻度的假想轴，用以提供角度参数。
[0029] 在一实施例中，所述操作装置在所述第一操作点操作所述工件移动，所述移动包 括：工件平移至所述对齐点和外部控制点重合；或者，在所述对齐点和外部控制点重合的 情况下，工件绕所述外部控制点进行转动，当然在其他实施例中，若有其他需求还可再平 移。
[0030] 步骤S2 :根据平移前的对齐点坐标及外部控制点坐标获得平移矢量，在所述第一 操作点通过所述平移到达第二操作点时，根据平移矢量及第一操作点坐标计算平移后的第 二操作点坐标，据以计算所述第一操作点平移至第二操作点的第一坐标移动量。
[0031] 步骤S3 :在所述第二操作点通过所述转动到达第三操作点时，结合转动角度计算 所述第三操作点的坐标，据以计算第二操作点转动至第三操作点的第二坐标移动量。
[0032] 步骤S4 :结合所述第一坐标移动量及第二坐标移动量以计算出总移动量。
[0033] 步骤S5 :根据所述总移动量计算工件的移动距离。
[0034] 步骤S6 :结合所述第一操作点移动至第三操作点的时间、及所计算的工件的移动 距