离，计算工件相对外部控制点的移动速度。
[0035] 通过结合所述平移操作轨迹及转动即可获得操作装置在操作工件平移及转动等 运动过程中的移动轨迹。
[0036] 在一实施例中，所述方法还包括：获取工件的各所述边缘点进行所述移动后的坐 标在缝纫作业中，每次所述转动均是使得工件边缘的一段和预设法线重合以进行下一步缝 纫作业，具体来说，所述外部控制点位于预设的法线上，所述工件上每两个边缘点构成一线 段；每次的所述转动是将所述工件转动至令其边缘的一所述线段同所述法线重合，所述工 件的转动角度是通过计算所述线段转动至同法线重合的转动角度而获得的，进一步的，所 述转动角度等于：在第二操作点通过所述转动到达第三操作点时，第二操作点和外部控制 点连线同第三操作点和外部控制点连线间的夹角。
[0037] 以下将以一个详细实施例来说明上述原理，如图2a及2b所示；举例来说，所述坐 标系涉及例如四轴X横轴、Y纵轴、Z上下轴、U转动轴；操作装置在COl点抓取工件，虽然在 该实施例中Z轴并未例示，但在本发明的教示下，结合空间几何及平面几何等现有技术应 当可以毫无疑义地实现。
[0038] 如图所示，设操作装置在X、Y直角坐标系内移动，U为操作装置的转动轴（逆时针 为正方向），工件为任意一闭合图形由例如P0、P1、P2、P3、P4、P5、P6、P7组成，定义PO为起 始点，第一操作点CO坐标为（C0M，C0OT，COciu)，外部控制点A坐标为（Ax，Ay)，法线为L。根 据操作装置操作工件的方式不同进行不同的坐标转换并相结合：
[0039] 方式1 :平移
[0040] 如图2a所示，操作装置控制工件将起始点PO按箭头所示平移至外部控制点A重 合；未平移前设PO坐标为（POck，POot)，可得平移向量为M3,平移后操作装置的操作点COl 坐标（C01X，C01Y，COiu)的计算公式为：
[0041] [C01X，C01Y，COiu] = [Ax-P0ox，AY-P0OY，0] + [C0ox，C0OY，COou]
[0042] 并可对应计算工件各边缘点P0-P7平移后坐标计算公式为：
[0043] [Pilx，Pi1Y] = [AfPOwAY-POj+EPi^PiQYLi为 1 以上的整数，本实施例中，i〈80
[0044] 方式2 :转动
[0045] 如图2b所示，保持PO与外部控制点A重合的情况下，操作装置控制工件转动至使 P0-P1所成线段与法线重合，也就是说，在缝纫作业中，每次转动之前必要的是保持PO点和 外部控制点重合，那么在整个操作过程，是不断地平移重合后再转动，若两点有偏差了，则 再平移重合后再转动的过程。
[0046] 在一实施例中，操作装置转动前的操作点坐标为COl(C01X，C01Y，COiu)，工件边缘点 P0、P1 的坐标为（P01X，P01Y)，（P11X，P11Y)，转动后的操作点坐标为C02(C02X，C02Y，C02U) ;P0 连接Pl所成线段与法线的夹角为0 ;
[0047] 第二操作点C02的坐标计算即：
【主权项】
1. 一种操作速度获取方法，其特征在于，所述方法包括： 在预定的工件移动空间内建立坐标系，在所述坐标系内定义所述工件各边缘点且将其 中至少一边缘点作为对齐点，并在工件定义第一操作点； 在所述工件移动空间内定义外部控制点； 所述操作装置在所述第一操作点操作所述工件移动，所述移动包括：工件平移至所述 对齐点和外部控制点重合；或者，在所述对齐点和外部控制点重合的情况下，工件绕所述外 部控制点进行转动； 根据平移前的对齐点坐标及外部控制点坐标获得平移矢量，在所述第一操作点通过 所述平移到达第二操作点时，根据平移矢量及第一操作点坐标计算平移后的第二操作点坐 标，据以计算所述第一操作点平移至第二操作点的第一坐标移动量； 在所述第二操作点通过所述转动到达第三操作点时，结合转动角度计算所述第三操作 点的坐标，据以计算第二操作点转动至第三操作点的第二坐标移动量； 结合所述第一坐标移动量及第二坐标移动量以计算出总移动量； 根据所述总移动量计算工件的移动距离； 结合所述第一操作点移动至第三操作点的时间、及所计算的工件的移动距离，计算工 件相对外部控制点的移动速度。
2. 根据权利要求1所述的操作速度获取方法，其特征在于，还包括：获取工件的各所述 边缘点进行所述移动后的坐标。
3. 根据权利要求2所述的操作速度获取方法，其特征在于，所述外部控制点位于预设 的法线上，所述工件上每两个边缘点构成一线段；每次的所述转动是将所述工件转动至令 其边缘的一所述线段同所述法线重合，所述工件的转动角度是通过计算所述线段转动至同 法线重合的转动角度而获得的。
4. 根据权利要求3所述的操作速度获取方法，其特征在于，所述转动角度等于：在第二 操作点通过所述转动到达第三操作点时，第二操作点和外部控制点连线同第三操作点和外 部控制点连线间的夹角。
5. 根据权利要求1所述的操作速度获取方法，其特征在于，所述坐标系包括：X轴、Y 轴、Z轴及U轴，其中，所述U轴是转动轴，以角度为单位。
6. -种操作速度获取装置，其特征在于，所述操作速度获取装置包括：坐标定义单元 及工件移动速度获取单元； 所述坐标定义单元，用于在预定的工件移动空间内建立坐标系，在所述坐标系内定义 所述工件各边缘点且将其中至少一边缘点作为对齐点，并在工件定义第一操作点；在所述 工件移动空间内定义外部控制点； 所述操作装置在所述第一操作点操作所述工件移动，所述移动包括：工件平移至所述 对齐点和外部控制点重合；或者，在所述对齐点和外部控制点重合的情况下，工件绕所述外 部控制点进行转动； 所述工件移动速度获取单元，用于根据平移前的对齐点坐标及外部控制点坐标获得平 移矢量，在所述第一操作点通过所述平移到达第二操作点时，根据平移矢量及第一操作点 坐标计算平移后的第二操作点坐标，据以计算所述第一操作点平移至第二操作点的第一坐 标移动量；在所述第二操作点通过所述转动到达第三操作点时，结合转动角度计算所述第 三操作点的坐标，据以计算第二操作点转动至第三操作点的第二坐标移动量；结合所述第 一坐标移动量及第二坐标移动量以计算出总移动量；根据所述总移动量计算工件的移动距 离；结合所述第一操作点移动至第三操作点的时间、及所计算的工件的移动距离，计算工件 相对外部控制点的移动速度。
7. 根据权利要求6所述的操作速度获取装置，其特征在于，所述坐标转化单元，还用于 获取工件的各所述边缘点进行所述移动后的坐标。
8. 根据权利要求7所述的操作速度获取装置，其特征在于，所述外部控制点位于预设 的法线上，所述工件上每两个边缘点构成一线段；每次的所述转动是将所述工件转动至令 其边缘的一所述线段同所述法线重合，所述工件的转动角度是通过计算所述线段转动至同 法线重合的转动角度而获得的。
9. 根据权利要求8所述的操作速度获取装置，其特征在于，所述转动角度等于：在第二 操作点通过所述转动到达第三操作点时，第二操作点和外部控制点连线同第三操作点和外 部控制点连线间的夹角。
10. 根据权利要求6所述的操作速度获取装置，其特征在于，所述坐标系包括：X轴、Y 轴、Z轴及U轴，其中，所述U轴是转动轴，以角度为单位。
【专利摘要】本发明的目的在于提供一种操作速度获取方法及装置，在预定的工件移动空间内建立坐标系，在所述坐标系内定义所述工件各边缘点且将其中至少一边缘点作为对齐点，并在工件定义第一操作点；在所述工件移动空间内定义外部控制点，所述外部控制点供所述对齐点移动至与其重合；所述操作装置在所述第一操作点操作所述工件移动，所述移动包括：工件平移至所述对齐点和外部控制点重合；或者，在所述对齐点和外部控制点重合的情况下，工件绕所述外部控制点进行转动或再平移；进行工件操作过程中的坐标移动量的计算以得到工件的移动距离，并根据所述移动距离及操作过程的时间得到工件相对外部控制点的移动速度；本发明简单易行。
【IPC分类】G05D13-62
【公开号】CN104793654
【申请号】CN201510070264
【发明人】马泽, 谢兆里, 于恒基, 陈志强
【申请人】杰克缝纫机股份有限公司
【公开日】2015年7月22日
【申请日】2015年2月10日