CN107977019B - 布料抓取装置的抓取位置和姿态控制方法及系统 - Google Patents

布料抓取装置的抓取位置和姿态控制方法及系统 Download PDF

Info

Publication number
CN107977019B
CN107977019B CN201610920500.6A CN201610920500A CN107977019B CN 107977019 B CN107977019 B CN 107977019B CN 201610920500 A CN201610920500 A CN 201610920500A CN 107977019 B CN107977019 B CN 107977019B
Authority
CN
China
Prior art keywords
points
sewing
distance
point
max
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610920500.6A
Other languages
English (en)
Other versions
CN107977019A (zh
Inventor
汪洁萍
马泽
陈思
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jack Technology Co Ltd
Original Assignee
Jack Sewing Machine Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jack Sewing Machine Co Ltd filed Critical Jack Sewing Machine Co Ltd
Priority to CN201610920500.6A priority Critical patent/CN107977019B/zh
Publication of CN107977019A publication Critical patent/CN107977019A/zh
Application granted granted Critical
Publication of CN107977019B publication Critical patent/CN107977019B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Sewing Machines And Sewing (AREA)
  • Medicines That Contain Protein Lipid Enzymes And Other Medicines (AREA)

Abstract

本发明提供一种布料抓取装置的抓取位置和姿态控制方法及系统，包括设置布料抓取装置的属性点；设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[h max ，h min ]；当固定点与缝制线中间点Q|n/2|的距离h取值为h max 和
Figure 310574DEST_PATH_IMAGE001
时，分别计算对应的布料抓取装置的属性点的位置坐标；判断h max 和
Figure 227714DEST_PATH_IMAGE001
是否为布料抓取装置的安全距离；调整h max 与h min 的取值；判断调整后的h max 与h min 的差值是否小于预定误差；若是，
Figure 820501DEST_PATH_IMAGE001
为布料抓取装置的最优安全距离；若否，根据调整后的h max 和h min ，重复上述流程，直至调整后的h max 与h min 的差值小于预定误差。本发明的布料抓取装置的抓取位置和姿态控制方法及系统能够有效保证缝制质量。

Description

布料抓取装置的抓取位置和姿态控制方法及系统
技术领域
本发明涉及自动缝纫设备的技术领域，特别是涉及一种布料抓取装置的抓取位置和姿态控制方法及系统。
背景技术
随着自动缝纫设备行业的发展，自动缝纫设备越来越多地应用在生产生活的不同领域，并且与自动缝纫设备配套的辅助设备也逐渐丰富起来。其中通过布料抓取装置来将布料移动至预定位置，实现布料的自动化供给。
在缝制过程中，布料抓取装置按照一定的姿态抓取裁片使缝制线上等距距离的点一一经过机针位置，从而实现自动缝制。但是，若布料抓取装置与缝制线太近，在缝制过程中会与自动缝纫设备碰撞；若布料抓取装置与缝制线太远，则会发生裁片鼓起、拉扯变形等现象。因而，抓取位置太远或太近都会影响缝制质量。
因此，需要对自动缝纫设备的布料抓取装置的抓取位置和抓取姿态进行准确控制，以将布料的缝制线与机针对齐，从而保证缝制质量。
发明内容
鉴于以上所述现有技术的缺点，本发明的目的在于提供一种布料抓取装置的抓取位置和姿态控制方法及系统，根据裁片缝制线和布料抓取装置特性，有效地使布料抓取装置的着力点合理分布在裁片上，控制布料抓取装置能够以最佳位置和姿态对布料进行抓取，从而保证缝制质量。
为实现上述目的及其他相关目的，本发明提供一种布料抓取装置的抓取位置和姿态控制方法，应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值；包括以下步骤：设置布料抓取装置的属性点，其中，设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点；设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]；当固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure BDA0001135933920000011
时，分别计算对应的布料抓取装置的属性点的位置坐标，a和b均为自然数；判断hmax和
Figure BDA0001135933920000021
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域；调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure BDA0001135933920000022
不是安全距离，则
Figure BDA0001135933920000023
取代hmin；若hmax是安全距离，
Figure BDA0001135933920000024
是安全距离，则
Figure BDA0001135933920000025
取代hmax；判断调整后的hmax与hmin的差值是否小于预定误差；若是，
Figure BDA0001135933920000026
为布料抓取装置的最优安全距离；该最优安全距离及其所对应的着力点的位置坐标即为布料抓取装置的位置和姿态参数。
于本发明一实施例中，设置点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/d1向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
于本发明一实施例中，设定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形；
设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax；
自定义距离最小值hmin。
于本发明一实施例中，计算布料抓取装置的属性点的位置坐标包括以下步骤：
以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首点Q1坐标(x0，y0)、尾点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)；
计算点A2的坐标：
Figure BDA0001135933920000027
其中，
Figure BDA0001135933920000028
计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure BDA0001135933920000031
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure BDA0001135933920000032
计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure BDA0001135933920000033
Figure BDA0001135933920000034
于本发明一实施例中，若调整后的hmax与hmin的差值不小于预定误差，则根据调整后的hmax和hmin，重新计算对应的属性点，直至调整后的hmax与hmin的差值小于预定误差。
同时，本发明提供一种布料抓取装置的抓取位置和姿态控制系统，应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值；
包括属性点设置模块、距离设定模块、计算模块、第一判断模块、调整模块和第二判断模块；
所述属性点设置模块用于设置布料抓取装置的属性点；其中，设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点；
所述设定模块用于设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]；
所述计算模块用于在固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure BDA0001135933920000035
时，分别计算对应的布料抓取装置的属性点的位置坐标，a和b均为自然数；
所述第一判断模块用于判断hmax和
Figure BDA0001135933920000036
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域；
所述调整模块用于调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure BDA0001135933920000037
不是安全距离，则
Figure BDA0001135933920000038
取代hmin；若hmax是安全距离，
Figure BDA0001135933920000039
是安全距离，则
Figure BDA0001135933920000041
取代hmax；
所述第二判断模块用于判断调整后的hmax与hmin的差值是否小于预定误差；若是，
Figure BDA0001135933920000042
为布料抓取装置的最小安全距离，即最优安全距离，该最优安全距离及其所对应的着力点的位置坐标即为布料抓取装置的位置和姿态参数。
于本发明一实施例中，设置点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/d1向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
于本发明一实施例中，所述设定模块设定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形；
设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax；
自定义距离最小值hmin。
于本发明一实施例中，所述计算模块计算布料抓取装置的属性点的位置坐标包括以下步骤：
以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首点Q1坐标(x0，y0)、尾点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)；
计算点A2的坐标：
Figure BDA0001135933920000043
其中，
Figure BDA0001135933920000044
计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure BDA0001135933920000045
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure BDA0001135933920000046
计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure BDA0001135933920000051
Figure BDA0001135933920000052
于本发明一实施例中，于本发明一实施例中，所述第二判断模块中，若调整后的hmax与hmin的差值不小于预定误差，则根据调整后的hmax和hmin，重新计算对应的属性点，直至调整后的hmax与hmin的差值小于预定误差。
如上所述，本发明的布料抓取装置的抓取位置和姿态控制方法及系统，具有以下有益效果：
(1)能够根据不同裁片形状，自适应地计算出最佳的抓取位置和姿态；
(2)能够自适应地计算布料抓取装置与自动缝纫设备之间的安全距离，防止与自动缝纫设备碰撞的发生；
(3)保证了布料抓取装置的着力点在裁片范围内，避免了无法控制裁片的现象；
(4)在对不同缝制线进行缝制时，能够自动调整布料抓取装置的姿态，无需人工操作，提高了工作效率。
附图说明
图1显示为布料抓取装置控制裁片进行缝制的一个实施例的结构示意图；
图2显示为本发明的布料抓取装置的抓取位置和姿态控制方法的流程图；
图3显示为本发明中设定点A2与缝制线中间点Q|n/2|的最大值hmax的一个实施例的示意图；
图4显示为本发明中布料抓取装置的属性点分布的示意图；
图5显示为本发明的布料抓取装置的抓取位置和姿态控制系统的结构示意图。
元件标号说明
1 属性点设置模块
2 距离设定模块
3 计算模块
4 第一判断模块
5 调整模块
6 第二判断模块
具体实施方式
以下通过特定的具体实例说明本发明的实施方式，本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用，本说明书中的各项细节也可以基于不同观点与应用，在没有背离本发明的精神下进行各种修饰或改变。
需要说明的是，本实施例中所提供的图示仅以示意方式说明本发明的基本构想，遂图式中仅显示与本发明中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制，其实际实施时各组件的型态、数量及比例可为一种随意的改变，且其组件布局型态也可能更为复杂。
在自动缝纫设备中，布料抓取装置安装在自动缝纫设备的四轴(X横轴、Y纵轴、Z上下轴、U旋转轴)机械手臂末端，其尺寸已知，且可变换角度。如图1所示，布料抓取装置抓取裁片使其能够沿着机针所在点运动完成缝制。其中，A1、A2、A3为布料抓取装置的三个着力点，A2为固定点，连接线A1A2和连接线A2A3可绕A2旋转，连接线A1A2和连接线A2A3的长度分别为L1和L2，为已知固定值；Z为机针所在位置，矩形B1B2B3B4构成缝纫机区域，可以理解为缝纫机俯视图的外接矩形；Q1、Q2、Q3、Q4…Qn为一系列等距离的点，可以理解为裁片的缝制点，其组成的线条表示裁片缝制线。其中，点A1、A2、A3的位置以及点A2与缝制线中间点Q|n/2|的距离h即为布料抓取装置的位置和姿态参数。需要说明的是，着力点的个数并不限定为三个，可根据实际应用情况设定一定数量的着力点。
参照图2，本发明的布料抓取装置的抓取位置和姿态控制方法，应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值。
本发明的布料抓取装置的抓取位置和姿态控制方法包括以下步骤：
步骤S1、设置布料抓取装置的属性点；其中，设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点。
下面以设置三个着力点为例来说明。其中点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/d1向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
需要说明的是，采用d1和d2等距离分割连接线以获取属性点是为了后续计算的便利性。在实际操作中，并不局限于上述属性点获取方式，可以任意选取连接线上的点作为属性点。
步骤S2、设固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmim]。
优选地，设定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
21)根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形。
22)设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax。
23)自定义距离最小值hmin。优选地，距离最小值hmin可设置为0。
在本发明另一实施例中，根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形，将布料抓取装置的着力点设置在裁片上。如图3所示，选取极端条件，即A1和A3中一点在对面一缝制线上，另一点要在裁片区域，计算此时点A2的位置，即可确定距离最大值hmax。同时，自定义距离最小值hmin。优选地，距离最小值hmin可设置为0。
步骤S3、当固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure BDA0001135933920000071
时，分别计算对应的布料抓取装置的属性点的位置坐标，a和b均为自然数。
优选地，a和b相等。
参照图4，当包括A1、A2和A3三个着力点时，计算布料抓取装置的属性点的位置坐标包括以下步骤：
31)以自动缝纫设备平台为坐标平面，以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首点Q1坐标(x0，y0)、尾点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)。
需要说明的是，L1并不要求为d1的整数倍。当L1不为d1的整数倍时，从连接线A1A2的A2点开始，按照距离d1依次获取A11、A12…A1x即可，最后一段的长度不为d1不影响后续的计算。同理，L2并不要求为d2的整数倍。当L2不为d2的整数倍时，从连接线A2A3的A2点开始，按照距离d2依次获取A31、A32…A3y即可，最后一段的长度不为d2不影响后续的计算。
其中，d1和d2的取值可以相同，也可以不同。
32)计算点A2的坐标：
Figure BDA0001135933920000081
其中，θ3为连接线Q1Qn与y轴之间的夹角，
Figure BDA0001135933920000082
Figure BDA0001135933920000083
具体地，[xqn’ yqn’]表示连接线Q1Qn与y轴平行时，点Q|n/2|的坐标。由坐标旋转变换与几何知识可知，当直线Q1Qn与Y轴平行时点Q|n/2|的坐标为：
Figure BDA0001135933920000084
33)计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure BDA0001135933920000085
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure BDA0001135933920000086
其中，θ1表示连接线A1A2与y轴的夹角，θ2表示连接线A2A3与y轴的夹角。因此，可得连接线A1A2与连接线A2A3间的夹角θ＝π+θ1-θ2。
34)计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure BDA0001135933920000087
Figure BDA0001135933920000088
步骤S4、判断hmax和
Figure BDA0001135933920000089
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域。
步骤S5、调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure BDA00011359339200000810
不是安全距离，则
Figure BDA0001135933920000091
取代hmin；若hmax是安全距离，
Figure BDA0001135933920000092
是安全距离，则
Figure BDA0001135933920000093
取代hmax。
其中，若hmax不是安全距离，则无法求解最小安全距离。对于布料抓取装置而言，其必然存在最小安全距离。故初次计算时所选取的hmax须为合适的值。
步骤S6、判断调整后的hmax与hmin的差值是否小于预定误差；若是，
Figure BDA0001135933920000094
为布料抓取装置的最小安全距离，即最优安全距离；该最优安全距离及其所对应的固定点的位置坐标即为布料抓取装置的位置和姿态参数。
若否，根据调整后的hmax和hmin，重复上述流程，直至调整后的hmax与hmin的差值小于预定误差，则所得到的
Figure BDA0001135933920000095
即为布料抓取装置的最优安全距离。具体地，调整hmax和hmin后，重新执行步骤S3-S6，直至获得布料抓取装置的最优安全距离。
具体地，预定误差取值越小，则所获得的布料抓取装置的最优安全距离的精度越高。
参照图5，本发明的布料抓取装置的抓取位置和姿态控制系统应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值。
本发明的布料抓取装置的抓取位置和姿态控制系统包括属性点设置模块1、距离设定模块2、计算模块3、第一判断模块4、调整模块5和第二判断模块6。
属性点设置模块1用于设置布料抓取装置的属性点；其中设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点。
下面以设置三个着力点为例来说明。其中点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/d1向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
需要说明的是，采用d1和d2等距离分割连接线以获取属性点是为了后续计算的便利性。在实际操作中，并不局限于上述属性点获取方式，可以任意选取连接线上的点作为属性点。
设定模块2用于设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]。
优选地，设定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
21)根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形。
22)设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax。
23)自定义距离最小值hmin。优选地，距离最小值hmin可设置为0。
在本发明另一实施例中，根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形，将布料抓取装置的着力点设置在裁片上。如图3所示，选取极端条件，即A1和A3中一点在对面一缝制线上，另一点要在裁片区域，计算此时点A2的位置，即可确定距离最大值hmax。同时，自定义距离最小值hmin。优选地，距离最小值hmin可设置为0。
计算模块3与属性点设置模块1和距离设定模块2相连，用于在固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure BDA0001135933920000101
时，分别计算对应的布料抓取装置的属性点的位置坐标。
优选地，a和b相等。
参照图4，当包括A1、A2和A3三个着力点时，计算布料抓取装置的属性点的位置坐标包括以下步骤：
31)以自动缝纫设备平台为坐标平面，以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首点Q1坐标(x0，y0)、尾点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)。
需要说明的是，L1并不要求为d1的整数倍。当L1不为d1的整数倍时，从连接线A1A2的A2点开始，按照距离d1依次获取A11、A12…A1x即可，最后一段的长度不为d1不影响后续的计算。同理，L2并不要求为d2的整数倍。当L2不为d2的整数倍时，从连接线A2A3的A2点开始，按照距离d2依次获取A31、A32…A3y即可，最后一段的长度不为d2不影响后续的计算。
其中，d1和d2的取值可以相同，也可以不同。
32)计算点A2的坐标：
Figure BDA0001135933920000102
其中，θ3为连接线Q1Qn与y轴之间的夹角，
Figure BDA0001135933920000103
Figure BDA0001135933920000111
具体地，[xqn’ yqn’]表示连接线Q1Qn与y轴平行时，点Q|n/2|的坐标。由坐标旋转变换与几何知识可知，当直线Q1Qn与Y轴平行时点Q|n/2|的坐标为：
Figure BDA0001135933920000112
33)计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure BDA0001135933920000113
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure BDA0001135933920000114
其中，θ1表示连接线A1A2与y轴的夹角，θ2表示连接线A2A3与y轴的夹角。因此，可得连接线A1A2与连接线A2A3间的夹角θ＝π+θ1-θ2。
34)计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure BDA0001135933920000115
Figure BDA0001135933920000116
第一判断模块4与计算模块3相连，用于判断hmax和
Figure BDA0001135933920000117
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域。
调整模块5与第一判断模块4相连，用于调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure BDA0001135933920000118
不是安全距离，则
Figure BDA0001135933920000119
取代hmin；若hmax是安全距离，
Figure BDA00011359339200001110
是安全距离，则
Figure BDA00011359339200001111
取代hmax。
其中，若hmax不是安全距离，则无法求解最小安全距离。对于布料抓取装置而言，其必然存在最小安全距离。故初次计算时所选取的hmax须为合适的值。
第二判断模块6与计算模块3、第一判断模块4和调整模块5相连，用于判断调整后的hmax与hmin的差值是否小于预定误差；若是，
Figure BDA00011359339200001112
为布料抓取装置的最小安全距离，即最优安全距离；该最优安全距离及其所对应的固定点的位置坐标即为布料抓取装置的位置和姿态参数。
若否，根据调整后的hmax和hmin，重复上述流程，直至调整后的hmax与hmin的差值小于预定误差，则所得到的
Figure BDA0001135933920000121
即为布料抓取装置的最优安全距离。具体地，调整hmax和hmin后，重新计算调整判断，直至获得布料抓取装置的最优安全距离。
具体地，预定误差取值越小，则所获得的布料抓取装置的最优安全距离的精度越高。
综上所述，本发明的布料抓取装置的抓取位置和姿态控制方法及系统能够根据不同裁片形状，自适应地计算出最佳的抓取位置和姿态；能够自适应地计算布料抓取装置与自动缝纫设备之间的安全距离，防止与自动缝纫设备碰撞的发生；保证了布料抓取装置的着力点在裁片范围内，避免了无法控制裁片的现象；在对不同缝制线进行缝制时，能够自动调整布料抓取装置的姿态，无需人工操作，提高了工作效率。所以，本发明有效克服了现有技术中的种种缺点而具高度产业利用价值。
上述实施例仅例示性说明本发明的原理及其功效，而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下，对上述实施例进行修饰或改变。因此，举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想下所完成的一切等效修饰或改变，仍应由本发明的权利要求所涵盖。

Claims (10)

1.一种布料抓取装置的抓取位置和姿态控制方法，其特征在于：应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值；
n表示自然数；
包括以下步骤：
设置布料抓取装置的属性点，其中，设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点；所述若干点为所述着力点连接线上的点；
设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]；其中，hmax表示距离最大值，hmin表示距离最小值；
当固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure FDA0002519678690000011
时，分别计算对应的布料抓取装置的属性点的位置坐标；
判断hmax和
Figure FDA0002519678690000012
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域，a和b均为自然数；
调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure FDA0002519678690000013
不是安全距离，则
Figure FDA0002519678690000014
取代hmin；若hmax是安全距离，
Figure FDA0002519678690000015
是安全距离，则
Figure FDA0002519678690000016
取代hmax；
判断调整后的hmax与hmin的差值是否小于预定误差；若是，则
Figure FDA0002519678690000017
为布料抓取装置的最优安全距离，该最优安全距离及其所对应的着力点的位置坐标即为布料抓取装置的位置和姿态参数。
2.根据权利要求1所述的布料抓取装置的抓取位置和姿态控制方法，其特征在于：设置点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/dl向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
3.根据权利要求2所述的布料抓取装置的抓取位置和姿态控制方法，其特征在于：设定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形；
设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax；
自定义距离最小值hmin。
4.根据权利要求2所述的布料抓取装置的抓取位置和姿态控制方法，其特征在于：计算布料抓取装置的属性点的位置坐标包括以下步骤：
以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首缝制点Q1坐标(x0，y0)、尾缝制点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)；
计算点A2的坐标：
Figure FDA0002519678690000021
其中，
Figure FDA0002519678690000022
Figure FDA0002519678690000023
计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure FDA0002519678690000024
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure FDA0002519678690000025
计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure FDA0002519678690000026
Figure FDA0002519678690000031
5.根据权利要求1所述的布料抓取装置的抓取位置和姿态控制方法，其特征在于：若调整后的hmax与hmin的差值不小于预定误差，则根据调整后的hmax和hmin，重新计算对应的属性点，直至调整后的hmax与hmin的差值小于预定误差。
6.一种布料抓取装置的抓取位置和姿态控制系统，其特征在于：应用于自动缝纫设备的布料抓取装置上，以自动缝纫设备平台作为平面坐标系平面，设定裁片缝制线包括若干个缝制点，表示为Q1、Q2、Q3、Q4…Qn；Q|n/2|为缝制线中间点，|n/2|表示n/2向上取整后的值；
n表示自然数；
包括属性点设置模块、距离设定模块、计算模块、第一判断模块、调整模块和第二判断模块；
所述属性点设置模块用于设置布料抓取装置的属性点；其中，设置布料抓取装置的若干个着力点，且其中一个着力点为固定点；将所有着力点依次连接并在连接线上选取若干点，所选取的若干点和所有着力点作为布料抓取装置的属性点；所述若干点为所述着力点连接线上的点；
所述距离设定模块用于设定固定点与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]；其中，hmax表示距离最大值，hmin表示距离最小值；
所述计算模块用于在固定点与缝制线中间点Q|n/2|的距离h取值为hmax和
Figure FDA0002519678690000032
时，分别计算对应的布料抓取装置的属性点的位置坐标，a和b均为自然数；
所述第一判断模块用于判断hmax和
Figure FDA0002519678690000033
是否为布料抓取装置的安全距离；其中，若缝制线的各个缝制点一一通过机针时，布料抓取装置的所有属性点均不在缝纫机区域内，则对应的固定点与缝制线中间点Q|n/2|的距离为布料抓取装置的安全距离，其中缝纫机区域为缝纫机的最小外接矩形区域；
所述调整模块用于调整hmax和hmin的取值；其中调整原则为：若hmax是安全距离，
Figure FDA0002519678690000034
不是安全距离，则
Figure FDA0002519678690000035
取代hmin；若hmax是安全距离，
Figure FDA0002519678690000036
是安全距离，则
Figure FDA0002519678690000037
取代hmax；
所述第二判断模块用于判断调整后的hmax与hmin的差值是否小于预定误差；若是，
Figure FDA0002519678690000041
为布料抓取装置的最优安全距离，该最优安全距离及其所对应的着力点的位置坐标即为布料抓取装置的位置和姿态参数。
7.根据权利要求6所述的布料抓取装置的抓取位置和姿态控制系统，其特征在于：设置点A1、A2、A3为布料抓取装置的三个着力点，点A2为固定点；将长度为L1的连接线A1A2按距离d1分割成x个点，分别为A11、A12…A1x；将长度为L2的连接线A2A3按距离d2分割成y个点，分别为A31、A32…A3y；x为L1/d1向上取整后的值，y为L2/d2向上取整后的值；点A1、A2、A3、点A11、A12…A1x和点A31、A32…A3y为布料抓取装置的属性点。
8.根据权利要求7所述的布料抓取装置的抓取位置和姿态控制系统，其特征在于：所述距离设定模块设定固定点A2与缝制线中间点Q|n/2|的距离h的可取区间[hmax，hmin]包括以下步骤：
根据裁片所有缝制线确定一边与连接线Q1Qn平行的的缝制线最小外接矩形；
设定缝制线最小外接矩形中与连接线Q1Qn垂直的一边的长度为距离最大值hmax；
自定义距离最小值hmin。
9.根据权利要求7所述的布料抓取装置的抓取位置和姿态控制系统，其特征在于：所述计算模块计算布料抓取装置的属性点的位置坐标包括以下步骤：
以自动缝纫设备平台上任意一点为原点，沿机针向上的方向为y向建立平面直角坐标系；获取缝制线的首缝制点Q1坐标(x0，y0)、尾缝制点Qn坐标(xn，yn)、缝制线中间点Q|n/2|坐标(xqn，yqn)、连接线A1A2长度L1和连接线A2A3长度L2；设定三个着力点A1、A2、A3坐标分别为(xa1，ya1)、(xa2，ya2)、(xa3，ya3)，A11、A12…A1x的坐标记为(xa11，ya11)、(xa12，ya12)…(xa1x，ya1x)，A31、A32…A3y的坐标记为(xa31，ya31)、(xa32，ya32)…(xa3y，ya3y)；
计算点A2的坐标：
Figure FDA0002519678690000042
其中，
Figure FDA0002519678690000051
Figure FDA0002519678690000052
计算点A1、点A3的坐标：
[xa1 ya1]＝[xa2+L1·sinθ1 ya2+L1·cosθ1]，其中，
Figure FDA0002519678690000053
[xa3 ya3]＝[xa2-L2·sinθ2 ya2-L2·cosθ2]，其中，
Figure FDA0002519678690000054
计算点A11、A12…A1x和点A31、A32…A3y的坐标：
Figure FDA0002519678690000055
Figure FDA0002519678690000056
10.根据权利要求6所述的布料抓取装置的抓取位置和姿态控制系统，其特征在于：所述第二判断模块中，若调整后的hmax与hmin的差值不小于预定误差，则根据调整后的hmax和hmin，重新计算对应的属性点，直至调整后的hmax与hmin的差值小于预定误差。
CN201610920500.6A 2016-10-21 2016-10-21 布料抓取装置的抓取位置和姿态控制方法及系统 Active CN107977019B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610920500.6A CN107977019B (zh) 2016-10-21 2016-10-21 布料抓取装置的抓取位置和姿态控制方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610920500.6A CN107977019B (zh) 2016-10-21 2016-10-21 布料抓取装置的抓取位置和姿态控制方法及系统

Publications (2)

Publication Number Publication Date
CN107977019A CN107977019A (zh) 2018-05-01
CN107977019B true CN107977019B (zh) 2020-07-28

Family

ID=62003795

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610920500.6A Active CN107977019B (zh) 2016-10-21 2016-10-21 布料抓取装置的抓取位置和姿态控制方法及系统

Country Status (1)

Country Link
CN (1) CN107977019B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115715609B (zh) * 2022-11-02 2023-07-07 宁波得立丰服饰有限公司 一种成衣服装生产方法、系统、存储介质及智能终端

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1115809A (zh) * 1994-02-03 1996-01-31 兄弟工业株式会社 缝纫数据修改装置
EP0704780A1 (en) * 1994-04-15 1996-04-03 Fanuc Ltd. Industrial robot device and method for executing jobs using the same
CN1321208A (zh) * 1999-04-02 2001-11-07 三菱电机株式会社 自动缝纫机控制装置
CN102443972A (zh) * 2010-09-07 2012-05-09 Juki株式会社 自动缝制缝纫机
CN104018297A (zh) * 2014-06-12 2014-09-03 新杰克缝纫机股份有限公司 一种智能缝制装置及系统
CN204366598U (zh) * 2014-11-19 2015-06-03 方云涛 应用于机械臂抓取的供料装置
CN104793654A (zh) * 2015-02-10 2015-07-22 杰克缝纫机股份有限公司 一种操作速度获取方法及装置
CN105014666A (zh) * 2015-07-13 2015-11-04 广州霞光技研有限公司 一种多自由度机械手自主抓取逆解工程算法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1115809A (zh) * 1994-02-03 1996-01-31 兄弟工业株式会社 缝纫数据修改装置
EP0704780A1 (en) * 1994-04-15 1996-04-03 Fanuc Ltd. Industrial robot device and method for executing jobs using the same
CN1321208A (zh) * 1999-04-02 2001-11-07 三菱电机株式会社 自动缝纫机控制装置
CN102443972A (zh) * 2010-09-07 2012-05-09 Juki株式会社 自动缝制缝纫机
CN104018297A (zh) * 2014-06-12 2014-09-03 新杰克缝纫机股份有限公司 一种智能缝制装置及系统
CN204366598U (zh) * 2014-11-19 2015-06-03 方云涛 应用于机械臂抓取的供料装置
CN104793654A (zh) * 2015-02-10 2015-07-22 杰克缝纫机股份有限公司 一种操作速度获取方法及装置
CN105014666A (zh) * 2015-07-13 2015-11-04 广州霞光技研有限公司 一种多自由度机械手自主抓取逆解工程算法

Also Published As

Publication number Publication date
CN107977019A (zh) 2018-05-01

Similar Documents

Publication Publication Date Title
CN107808401A (zh) 机械臂末端的单相机的手眼标定方法
CN104615092B (zh) 工作机械控制系统及其方法
CN107977019B (zh) 布料抓取装置的抓取位置和姿态控制方法及系统
CN106363304B (zh) 一种多相机矫正和定位方法及玻璃激光切割的装置
CN104457645A (zh) 一种利用二维测量功能平板的机器人工具中心点标定方法
CN108139730A (zh) 机器人离线编程方法以及使用其的装置
CN109457400B (zh) 一种基于双机器人协同的布料缝制方法
CN112077843A (zh) 机器人图形化码垛方法、计算机存储介质及机器人
CN110781588B (zh) 一种螺旋面与回转体曲面相交生成铺丝角度参考线方法
CN108393896A (zh) 用于焊接机器人焊枪工具点及工件坐标系标定装置及方法
CN106054814A (zh) 基于图像灰度的计算机辅助加工方法
DE102015115229B4 (de) Positionierungssteuergerät
CN116423526B (zh) 一种机械臂工具坐标的自动标定方法及系统、存储介质
CN211278404U (zh) 一种机械臂的手眼标定装置
CN207447918U (zh) 装夹定位工装及产品定位装置
CN207577594U (zh) 攻丝机及自动攻丝机
CN105798793B (zh) 一种垫铁可调式平口虎钳
CN103838182B (zh) 数控机床编程辅助方法
CN103558871A (zh) 一种涂层厚度自动控制系统及方法
CN112792818A (zh) 一种快速引导机械手抓取目标的视觉对位方法
TWI679506B (zh) 鋼構建材之翻轉加工規劃方法
CN108268137A (zh) 一种虚拟装配中握取、移动和放手动作测算方法
CN100399867C (zh) 以软件自动执行电路布局的方法
CN108068108B (zh) 平面内摆动伸缩型机器人运动控制方法
CN109866069B (zh) 一种桁架机械手矩形料仓放料孔自动定位的计算方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: 318010 No. 1008, east section of Donghai Avenue, Sanjia, Jiaojiang District, Taizhou City, Zhejiang Province

Patentee after: Jack Technology Co.,Ltd.

Address before: 318010 No. 15 Airport South Road, Jiaojiang District, Zhejiang, Taizhou

Patentee before: JACK SEWING MACHINE Co.,Ltd.

CP03 Change of name, title or address