[发明专利]一种料盘及其点位补偿方法有效
申请号: | 201911417818.2 | 申请日: | 2019-12-31 |
公开(公告)号: | CN111390968B | 公开(公告)日: | 2022-05-10 |
发明(设计)人: | 戴翔 | 申请(专利权)人: | 宁波大正工业机器人技术有限公司 |
主分类号: | B25J19/00 | 分类号: | B25J19/00;B25J9/00;B25J9/16 |
代理公司: | 杭州杭诚专利事务所有限公司 33109 | 代理人: | 尉伟敏 |
地址: | 315800 浙江省*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 及其 补偿 方法 | ||
1.一种料盘点位补偿方法,机器人上设有用于定位的校准装置,其特征是,料盘上设有放料位,放料位中设有放料点,放料点放置料体,所述料盘上设有数量为n的校准点,对于需要求出实际坐标的位置的P点,包括步骤:
(S1)校准装置通过检测得到校准点位置,获得所述校准点的实际坐标为(P1、P2至Pn;)
(S2)将各个校准点连线,形成有条线段,形成有L1、L2至连线段;
(S3)建立所述P点的理论坐标P0到L1、L2至的垂线段,记为D1、D2至交点为A1、A2至
(S4)D1、D2至中各个垂线段长度占D1、D2至之和的比值在被1减去之后求得有过渡值,所述各个垂线段长度对应的过渡值进行归一化,可以得到L1、L2至连线段的第一权重K1;
(S5)A1、A2至在L1、L2至LCn2的连线段上,将对应的L1、L2至分成了第一线段和第二线段;(S6)所述第一线段的长度除以对应的连线段的长度的比值被1减去后为对应的校准点的第二权重K2;
(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所述的一种料盘点位补偿方法,其特征是,放料位呈矩形,校准点设置在靠近料盘角点位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于宁波大正工业机器人技术有限公司,未经宁波大正工业机器人技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911417818.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种过滤装置
- 下一篇:一种定子线头自动裁剪机