CN111390968B - 一种料盘及其点位补偿方法 - Google Patents
一种料盘及其点位补偿方法 Download PDFInfo
- Publication number
- CN111390968B CN111390968B CN201911417818.2A CN201911417818A CN111390968B CN 111390968 B CN111390968 B CN 111390968B CN 201911417818 A CN201911417818 A CN 201911417818A CN 111390968 B CN111390968 B CN 111390968B
- Authority
- CN
- China
- Prior art keywords
- point
- calibration
- coordinates
- line segment
- weight
- 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
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/0096—Programme-controlled manipulators co-operating with a working support, e.g. work-table
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种料盘及其点位补偿方法,旨在解决现在的取料机器人无法对取料盘的点位进行补偿,或者存在补偿偏差,补偿不到位的不足。该发明包括步骤:校准装置通过检测校准点位置,获得所述校准点的实际坐标;得到各个校准点相对于所求点的权重;所述校准点在机器手控制器中存储有理论坐标,P点的偏差值为各个校准点的理论坐标到实际坐标形成的向量与对应的最终权重K的乘积之和;将零位到P点坐标形成的向量与步骤S9中形成的偏差值求和即为P点的实际坐标。通过计算和对校准点的检测,可以快速计算出对应的放料点的偏差,得到其实际位置,进而可以更准确的实现取料动作。
Description
技术领域
本发明涉及一种机器人自动化领域,更具体地说,它涉及一种料盘及其点位补偿方法。
背景技术
多轴机器人在料盘上取料,需要得到料盘上的放料点的精准位置,在取一些夹持点比较小,容错率较高的料体时,对放料点的位置的精度要求会更加的高。为了提高生产节拍,加快生产效率,料盘的表面积越来越大以容纳更多的料体,减少来回移动料盘装料的时间。但是随着料盘的变大,公差也会逐步放大,甚至影响机械手的取料。进而,料盘自身的刚性也随之变化,在装载不同数量的料体的时候,各个取料的点位之间的距离也会变化。当料盘足够大时,其误差会影响到机械人的取料,导致出现无法取料,时不时的需要重新手工校准。亟需一种补偿方法实现对点位进行位置补偿,取得各个放料点的精准位置。
中国专利公告号CN207560471U,名称为一种单臂机器人冲压搬运装置,该申请案公开了一种单臂机器人冲压搬运装置,包括机台,机台的中部设有直线升降平台,机台位于直线升降平台的一端设有可升降的机器人搬运装置,机台位于直线升降平台的另一端设有隔离纸摆盘和将该隔离纸摆盘上的隔离纸一张一张搬运至成品摆盘上的隔离纸搬运装置,成品摆盘位于直线升降平台上,直线升降平台上还设置有具有补偿升降功能的来料盘结构。该实用新型主要是针对柔性FPC板冲压搬运。本装置底座可升降的4轴机器人,该机器人的Z轴在于底座,便于机器人在冲床的上下模组狭窄的空间中工作。机器人末端是吸盘,吸盘吸附位置增加了产品保护功能;吸盘可旋转,便于对称性产品实现二次冲压功能;底座可升降的4 轴机器人,主要用于物料的搬运。它具有无法对取料盘的点位进行补偿,导致机械人不能精准取料。
发明内容
本发明克服了现在的取料机器人无法对取料盘的点位进行补偿,或者存在补偿偏差,补偿不到位的不足,提供了一种料盘及其点位补偿方法,它能对各个取料点位进行精准计算,计算出实际点位。
为了解决上述技术问题,本发明采用以下技术方案:
一种料盘,料盘上设有放料位,放料位中设有放料点,放料点放置料体。
放料位为若干放料点阵列形成。料盘的放料位为一个平面。该料盘滑动连接在导轨上,通过滑轨的导向和连接在该料盘上的驱动装置驱动,在装料和卸料位置之间往复运动。
一种料盘点位补偿方法,机器人上设有用于定位的校准装置,料盘上设有数量为n的校准点,对于需要求出实际坐标的位置的P点,包括步骤:
(S1)校准装置通过检测得到校准点位置,获得所述校准点的实际坐标为(P1、P2至Pn);
(S6)所述第一线段的长度除以对应的连线段的长度的比值被1减去后为对应的校准点的第二权重K2;
(S7)所述第一权重K1和第二权重K2之积为第三权重K3;
(S8)每个校准点与其他校准点形成的连线数量为n-1,形成有n-1的第三权重K3,各个校准点的n-1个第三权重K3之和为该校准点的最终权重K;
(S9)所述校准点在机器手控制器中存储有理论坐标为(P1’、P2’至Pn’),P点的偏差值为各个校准点的理论坐标到实际坐标形成的向量与对应的最终权重K的乘积之和;
(S10)将零位到P点坐标形成的向量与步骤S9中形成的偏差值求和即为P点的实际坐标。
该方法是通过将各个校准点位在设计时的理论值与在使用时的位置之间的变化,来推断需要得到的点位的实际位置。具体的,是通过需要检测的P点和各个检测点之间的距离来改变加权值,来更精确的得到P点的位置。将各个校准点连线在一起,形成L线段,再将理论P点和L线段形成的D垂线段,交点为A,由于有Cn 2个线条,也有对应数量的点。采用各个校准点相对需要检测点的偏移量之和乘以一个系数即为该点的偏移量,该值与该点的位置之和就是对应的所求点的实际坐标位置。具体的加权方式是所求点的理论坐标到L线段的垂线段长度之和作为分母,对应线段垂线段D作为分子,得到的一个比1小的值,该值在被 1减去后得到的过渡值,每个垂线段对应有一个数,对这些数进行归一化,可以得到对应的得到的一个第一权重K1,该第一权重对于各个都有对应D的L线段都具有,所求点距离附近的L线段越近,其垂线段长度也越小,通过这个方式求得的过渡值越大,比重更大。各个校准点到A的长度占对应的线段之比与1的差值为第二权重K2(校准点到垂点A的长度越小,所求点与该校准点偏移的距离也会更接近,因此设置更大的权重),二者相乘就形成了第三权重K3,由于每个校准点均和其他所有的校准点连线,那么对应的,每个校准点也就有了n-1个权重K3,将这些系数求和就得到了最终的权重K3。若是这些线段的权重为向量,其相加之和与校准点的理论和实际的偏差形成的向量是同向的,因此可以作为系数直接相乘。各个方向的校准点偏移形成的向量乘以权重就可以得到对应的P点的偏差向量。P点与零点形成的向量与该偏差向量之和就可以得到P点的实际值。对于其他各点,由于已知各校准点位置,因此可以略过校准过程,通过各点的理论值直接计算,得到对应的实际坐标。
作为优选,所述校准装置为激光检测器,校准点上设有特征点。特征点是易为检测器捕捉的特征点,例如反光系数与料盘其他位置不同。确定特征点是通过三点定位法定位实现的。通过移动机器人的手臂,移动激光检测器,在三点位置进行检测,实现对校准点的精准定位。
作为优选,n的数量大于或等于3。在步骤S10中,需要对校准点的各个权重求和,至少需要除所求点外两个点相加才能形成向量。
所述机器人为工业六轴机器人。机器人的多轴方向移动和转动实现了对工件的定位和姿态的调整。
作为优选,所述校准点围绕放料位设置。保证各个放料点和附近的校准点的距离大致相同。减少偏差值,提高精度。
作为优选,机器人中设有控制器,控制器中存储有放料位中各个放置料体的点位的理论坐标;控制器中存储有各个校准点的理论坐标。机器人记录有各个放料点和校准点的理论坐标。再通过测量和计算得到对应的放料点的实际坐标。
作为优选,所述校准点设置在放料位中心位置。中心位置的校准点附近具有更多的放料点,这些放料点的位置计算更精确。更靠近校准点的放料点受到该校准点的权重更大,计算出的实际值更靠近真实坐标。
作为优选,放料位呈矩形,校准点设置在靠近料盘角点位置。该位置设置方式是为了更精准的测量校准点,避免放料点位置影响了校准装置的判断。
与现有技术相比,本发明的有益效果是:通过计算和对校准点的检测,可以快速计算出对应的放料点的偏差,得到其实际位置,进而可以更准确的实现取料动作。对于放料点在两个校准点连线之间的情况,直接计算各个校准点到计算点位置的长度除以这些线条的长度之和的方式就会受到来自不在这个线条上的其余各校准点的误差,导致计算出的点位偏离实际点位,不能很好的拟合,通过该计算方法就可以涵盖这种情况,进而将校准点设置到放料点之间。
附图说明
图1是本发明的示意图;
图2是本发明的校准点和所求点位的示意图;
图中:放料位1、机器人2、放料点3、料盘4、校准点5。
具体实施方式
下面通过具体实施例,并结合附图,对本发明的技术方案作进一步的具体描述:实施例1:
一种料盘4,如图1所示,料盘上设有放料位1,放料位中设有放料点3,放料点3放置料体。
放料位1为若干放料点3阵列形成。料盘4的放料位1为一个平面。该料盘4滑动连接在导轨上,通过滑轨的导向和连接在该料盘上的驱动装置驱动,在装料和卸料位置之间往复运动。
一种料盘点位补偿方法,机器人2上设有用于定位的校准装置,料盘4上设有数量为 n的校准点5,对于需要求出实际坐标的位置的P点,包括步骤:
(S6)所述第一线段的长度除以对应的连线段的长度的比值被1减去后为对应的校准点5的第二权重K2;
(S7)所述第一权重K1和第二权重K2之积为第三权重K3;
(S8)每个校准点5与其他校准点5形成的连线数量为n-1,形成有n-1的第三权重K3,各个校准点5的n-1个第三权重K3之和为该校准点5的最终权重K;
(S9)所述校准点5在机器手2控制器中存储有理论坐标为(P1’、P2’至Pn’),P点的偏差值为各个校准点5的理论坐标到实际坐标之间形成的向量与对应的最终权重K的乘积之和;
(S10)将零位到P点坐标形成的向量与步骤S9中形成的偏差值求和即为P点的实际坐标。
该方法是通过将各个校准点5位在设计时的理论值与在使用时的位置之间的变化,来推断需要得到的点位的实际位置。具体的,是通过需要检测的P点和各个检测点之间的距离来改变加权值,来更精确的得到P点的位置。将各个校准点5连线在一起,形成L线段,再将理论P点和L线段形成的D垂线段,交点为A,由于有Cn 2个线条,也有对应数量的点。采用各个校准点5相对需要检测点的偏移量之和乘以一个系数即为该点的偏移量,该值与该点的位置之和就是对应的所求点的实际坐标位置。具体的加权方式是所求点的理论坐标到L线段的长度之和作为分母,对应线段垂线段D作为分子,通过将求得的值被1减去后得到的过渡值,对应各个线段L对应的过渡值,通过将其归一化,使得各个值相加之和为1,由此得到的一个第一权重K1,该第一权重对于各个都有对应D的L线段都具有。各个校准点到A 的长度占对应的线段之比与1的差值为第二权重K2,二者相乘就形成了第三权重K3,由于每个校准点均和其他所有的校准点连线,那么对应的,每个校准点也就有了n-1个权重K3,将这些系数求和就得到了最终的权重K3。K1和K2与1求差的意义在于,使得更靠近所求点的校准点的理论与实际的坐标差值具有更大的权重,能更多的影响到所求点的坐标。若是这些线段的权重为向量,其相加之和与校准点5的理论和实际的偏差形成的向量是同向的,因此可以作为系数直接相乘。各个方向的校准点5偏移形成的向量乘以权重就可以得到对应的P点的偏差向量。P点与零点形成的向量与该偏差向量之和就可以得到P点的实际值。对于其他各点,由于已知各校准点5位置,因此可以略过校准过程,通过各点的理论值直接计算,得到对应的实际坐标。
所述校准装置为激光检测器,校准点上设有特征点。特征点是易为检测器捕捉的特征点,例如反光系数与料盘其他位置不同。确定特征点是通过三点定位法定位实现的。通过移动机器人2的手臂,移动激光检测器,在三点位置进行检测,实现对校准点的精准定位。
n的数量大于或等于3。在步骤S10中,需要对校准点的各个权重求和,至少需要除所求点外两个点相加才能形成向量。具体的,本实施例中,n的数量为4,L的数量为6。
所述机器人为工业六轴机器人2。机器人2的多轴方向移动和转动实现了对工件的定位和姿态的调整。机器人2中电连接控制器,控制器中存储有放料位中各个放置料体的点位的理论坐标;控制器中存储有各个校准点的理论坐标。机器人2记录有各个放料点和校准点 5的理论坐标。再通过测量和计算得到对应的放料点的实际坐标。所述校准点围绕放料位设置。保证各个放料点和附近的校准点的距离大致相同。减少偏差值,提高精度。如图2所示,放料位1呈矩形,校准点5设置在靠近料盘4角点位置。该位置设置方式是为了更精准的测量校准点5,避免放料点3位置影响了校准装置的判断。
实施例2:
实施例2与实施例1的不同之处在于校准点在料盘上的位置:
校准点5设置在放料位1中心位置。中心位置的校准点5附近具有更多的放料点3,这些放料点3的位置计算更精确。更靠近校准点5的放料点3受到该校准点5的权重更大,计算出的实际值更靠近真实坐标。
以上所述的实施例只是本发明的一种较佳的方案,并非对本发明作任何形式上的限制,在不超出权利要求所记载的技术方案的前提下还有其它的变体及改型。
Claims (8)
1.一种料盘点位补偿方法,机器人上设有用于定位的校准装置,其特征是,料盘上设有放料位,放料位中设有放料点,放料点放置料体,所述料盘上设有数量为n的校准点,对于需要求出实际坐标的位置的P点,包括步骤:
(S1)校准装置通过检测得到校准点位置,获得所述校准点的实际坐标为(P1、P2至Pn;)
(S7)所述第一权重K1和第二权重K2之积为第三权重K3;
(S8)每个校准点与其他校准点形成的连线数量为n-1,形成有n-1的第三权重K3,各个校准点的n-1个第三权重K3之和为该校准点的最终权重K;
(S9)所述校准点在机器手控制器中存储有理论坐标为(P′1、P′2至P′n,)P点的偏差值为各个校准点的理论坐标到实际坐标之间形成的向量与对应的最终权重K的乘积之和;
(S10)将零位到P点坐标形成的向量与步骤S9中形成的偏差值求和即为P点的实际坐标。
2.根据权利要求1所述的一种料盘点位补偿方法,其特征是,所述校准装置为激光检测器,校准点上设有特征点。
3.根据权利要求1所述的一种料盘点位补偿方法,其特征是,n的数量大于或等于3。
4.根据权利要求1所述的一种料盘点位补偿方法,其特征是,所述机器人为工业六轴机器人。
5.根据权利要求1所述的一种料盘点位补偿方法,其特征是,所述校准点围绕放料位设置。
6.根据权利要求1或4所述的一种料盘点位补偿方法,其特征是,机器人中设有控制器,控制器中存储有放料位中各个放置料体的点位的理论坐标;控制器中存储有各个校准点的理论坐标。
7.根据权利要求1或5所述的一种料盘点位补偿方法,其特征是,所述校准点设置在放料位中心位置。
8.根据权利要求7所述的一种料盘点位补偿方法,其特征是,放料位呈矩形,校准点设置在靠近料盘角点位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911417818.2A CN111390968B (zh) | 2019-12-31 | 2019-12-31 | 一种料盘及其点位补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911417818.2A CN111390968B (zh) | 2019-12-31 | 2019-12-31 | 一种料盘及其点位补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111390968A CN111390968A (zh) | 2020-07-10 |
CN111390968B true CN111390968B (zh) | 2022-05-10 |
Family
ID=71414985
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911417818.2A Active CN111390968B (zh) | 2019-12-31 | 2019-12-31 | 一种料盘及其点位补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111390968B (zh) |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5769315A (en) * | 1980-10-13 | 1982-04-28 | Fanuc Ltd | Control system of industrial robot |
CN102230783B (zh) * | 2011-05-04 | 2012-09-26 | 南京航空航天大学 | 一种用于工业机器人的空间立体网格精度补偿方法 |
CN102501251A (zh) * | 2011-11-08 | 2012-06-20 | 北京邮电大学 | 带有动态摩擦补偿的机械臂关节定位控制方法 |
CN104302163B (zh) * | 2013-07-19 | 2018-01-09 | 泰科电子(上海)有限公司 | 自动装配系统和方法 |
DE102014119654A1 (de) * | 2014-12-29 | 2016-06-30 | Brötje-Automation GmbH | Verfahren zur Kompensation einer Abweichung eines Arbeitspunkts |
DE102015211407A1 (de) * | 2015-06-22 | 2016-12-22 | Kuka Roboter Gmbh | Verbesserung der Temperaturdriftkompensation durch geregelte Überkompensation |
CN105563104B (zh) * | 2015-12-10 | 2018-04-24 | 宁波大正工业机器人技术有限公司 | 全自动组装设备 |
CN105563218A (zh) * | 2015-12-10 | 2016-05-11 | 宁波大正工业机器人技术有限公司 | 机床上下料自动操作设备 |
CN106092009B (zh) * | 2016-06-29 | 2018-07-20 | 南京航空航天大学 | 一种基于拉线编码器的站点可动式测量机构的初始位置校准方法 |
CN107042527B (zh) * | 2017-05-20 | 2023-04-28 | 天津大学 | 一种基于三维力传感器的工业机器人标定装置及标定方法 |
CN107421442B (zh) * | 2017-05-22 | 2019-12-17 | 天津大学 | 一种外部测量辅助的机器人定位误差在线补偿方法 |
CN107443382B (zh) * | 2017-09-12 | 2020-09-22 | 清华大学 | 工业机器人结构参数误差辨识与补偿方法 |
-
2019
- 2019-12-31 CN CN201911417818.2A patent/CN111390968B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111390968A (zh) | 2020-07-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6242879B1 (en) | Touch calibration system for wafer transfer robot | |
CN107340098B (zh) | 一种四点法测量质量、质心和质偏的方法 | |
CN110360957B (zh) | 一种h型钢构热加工过程角变形测量方法 | |
EP1239263A2 (en) | Position measuring apparatus and working apparatus using the same | |
CN112008491B (zh) | 一种基于测头的ca型五轴数控机床rtcp精度标定方法 | |
US10744653B2 (en) | Holding mechanism, transfer device, handling robot system, and robot handling method | |
CN105514010A (zh) | 一种硅片安全运输方法 | |
CN113146613B (zh) | 一种工业机器人d-h参数三维自标定校准装置及方法 | |
TW201803706A (zh) | 機器人校正系統與方法 | |
CN215866440U (zh) | 一种晶圆外观检测设备 | |
CN111390968B (zh) | 一种料盘及其点位补偿方法 | |
CN110395557A (zh) | 一种工件翻转上料方法及其设备 | |
CN107255509A (zh) | 一种四点法的质量特性测量系统 | |
CN113390560B (zh) | 一种用于测量大型带翼飞行体质量三维质心的测量机构 | |
CN114188254A (zh) | 一种晶圆搬运机械手位置教具及其示教方法 | |
CN219956462U (zh) | 一种用于测量物体表面的测量设备 | |
CN113059579A (zh) | 一种柔性作业装置 | |
CN112440269B (zh) | 机器人臂长校正方法及系统 | |
KR940006570B1 (ko) | 온도변화에 의한 로보트 팔길이 보정용 캘리브레이션 시스템(calibration system) | |
CN214021687U (zh) | 一种基于3d轮廓扫描仪的点胶机 | |
CN216283232U (zh) | 一种挠度检测水准系统 | |
CN206291815U (zh) | 码垛机器人端部运动重复定位精度的检测装置 | |
CN110954268A (zh) | 一种偏载校准系统 | |
CN221564851U (zh) | 自动测距取放料装置 | |
CN111071714A (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 | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: A material tray and its point compensation method Effective date of registration: 20220627 Granted publication date: 20220510 Pledgee: Jiajiang sub branch of Ningbo Beilun Rural Commercial Bank Co.,Ltd. Pledgor: DAZHENG INDUSTRIAL ROBOT TECHNOLOGY Corp. Registration number: Y2022980009035 |