一种基于机器人的光伏电池串定位方法与流程

1.本发明涉及机器人光伏电池串定位领域，具体是一种基于机器人的光伏电池串定位方法。


背景技术：

2.目前在实际生产中，电池串的种类较多，尺寸大小不一，需要对机器人的光伏电池串进行定位，如中国专利申请号为111127553a公开了一种基于多相机的光伏电池串定位方法，通过角位相机获取光伏电池串的角部图像，长边位相机获取光伏电池串长边的图像。建立机器人参考坐标系r和角位相机参考坐标系。计算光伏电池串标准排版位置c3(x3,y3,a3)和长边位相机获取的光伏电池串位置c4(x4,y4,a4)，然后计算光伏电池串位置与光伏电池串标准排版位置的差异(dx,dy,da)。最后利用以太网的通讯，将数据发给排版机器人，机器人在点位r6的基础上，加上[dx,dy,da]，并执行。本发明通过拟合、权重计算、推演计算等定位局部特征等方法，提高精度的同时，让现场的光伏定位精度能达到0.1mm以内，提升工作的效率，通过在光伏电池串某一个角边安装一台相机，在长边安装多台相机。利用角边相机进行位置定位，利用所有相机拟合的直线与各自标准直线的夹角的平均值进行姿态定位。该方案具有一定的局限性，要求所有电池串的尺寸一致。在实际生产中，电池串的种类较多，尺寸大小不一，该方案不能满足柔性生产需求。


技术实现要素：

[0003]
为了解决上述问题，本发明提出一种基于机器人的光伏电池串定位方法。
[0004]
一种基于机器人的光伏电池串定位方法，其具体步骤如下：
[0005]
s1、搭建实施平台：搭建实施平台确保相机一和相机二分别获取光伏电池串的对角位置；
[0006]
s2、手眼标定关系：相机一与机器人的手眼标定关系为a1(r1,t1),相机二与机器人的手眼标定关系为a2(r2,t2)；
[0007]
s3、将一个光伏电池串放在传送带上,并认为是标准光伏电池串；
[0008]
s4、角点位置：相机一得到的角点位置为c0(x0,y0)，相机二得到的角点位置为c1(x1,y1)，根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
00
(x
00
,y
00
),p
10
(x
10
,y
10
)；
[0009]
s5、标准抓取位姿：机器人示教标准光伏电池串的中心位置，得到标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)；
[0010]
s6、根据步骤s5中的数据计算得到机器人的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)，其中：
[0011]
x1＝min(x
00,
x
10
) |x
00
‑
x
10
|/2
[0012]
y1＝min(y
00,
y
10
) |y
00
‑
y
10
|/2
[0013]
r
z1
＝arctan((y
00
‑
y
10
)/(x
00
‑
x
10
))(x
00
‑
x
10
≠0；if x
00
‑
x
10
＝0,r
z1
＝0)
[0014]
s7、偏差公式：求标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)与计算得到机器人5的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)之间的偏差δp＝p1‑
p0＝(x1‑
x
0,
y1‑
y
0,
0,0,0,r
z1
‑
r
z0
)；
[0015]
s8、角点位置公式：任一光伏电池串放在传送带1上，相机一得到的角点位置为c2(x2,y2),相机二4得到的角点位置为c3(x3,y3),根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
20
(x
20
,y
20
),p
30
(x
30
,y
30
)，结合δp计算抓取位姿p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)，其中：
[0016]
x2＝min(x
20,
x
30
) |x
20
‑
x
30
|/2 (x1‑
x0)
[0017]
y2＝min(y
20,
y
30
) |y
20
‑
y
30
|/2 (y1‑
y0)
[0018]
α
＝arctan((y
30
‑
y
20
)/(x
30
‑
x
20
))(x
30
‑
x
20
≠0；if x
30
‑
x
20
＝0,α＝0)
[0019]
r
z2
＝α (r
z1
‑
r
z0
)。
[0020]
所述的步骤s1中搭建实施平台，通过机器人的抓手将光伏电池串铺设在传送带上，将相机一和相机二安装在能够获取光伏电池串的角点一、角点二位置处。
[0021]
所述的步骤s4的角点位置c0(x0,y0),c1(x1,y1)是根据如下方法得到的：
[0022]
a、图像预处理：原图像
‑
>灰度图
‑
>二值化
‑
>形态学运算
‑
>canny边缘检测；
[0023]
b、粗定位：canny边缘检测
‑
>roi_1
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点1；
[0024]
c、精定位：根据交点1
‑
>roi_2
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点
‑
>亚像素拟合交点2
‑
>结束。
[0025]
d、交点2的坐标即为最终求得的角点位置。
[0026]
所述的步骤s8的c0(x0,y0),c2(x2,y2)是基于相机一的相机坐标系下的位置；c1(x1,y1),c3(x3,y3)是基于相机二的相机坐标系下的位置；
[0027]
p0(x0,y0,z0,r
x0
,r
y0
,r
z0
),p
00
(x
00
,y
00
),p
10
(x
10
,y
10
),p
20
(x
20
,y
20
),p
30
(x
30
,y
30
),p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)是基于机器人基坐标系下的位姿。
[0028]
本发明的有益效果是：与现有技术相比，通过将光伏电池串的两个对角分别对应相机一和相机二的视野内，不更改任何硬件设施以及软件参数，机器人就能对光伏电池串进行定位抓取，从而提高了生产柔性，解决了光伏生产时尺寸不一致问题；本发明通过相机一和相机二对图像进行预处理，基于开源软件实现，即机器人自身的程序软件，不是购买商业视觉软件实现的，大大降低了使用成本。
附图说明
[0029]
下面结合附图和实施例对本发明进一步说明。
[0030]
图1为本发明的搭建实施平台结构示意图；
[0031]
图2为本发明的标准抓取位姿结构示意图；
[0032]
图3为本发明的角点位置结构示意图；
[0033]
图4为本发明的角点在机器人基坐标系下的位置结构示意图；
[0034]
图5为本发明的使用流程示意图；
[0035]
附图标记：1、传送带；2、光伏电池串；2.1、角点一；2.2、角点二；3、相机一；4、相机二；5、机器人；6、抓具。
具体实施方式
[0036]
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解，下面对本发明进一步阐述。
[0037]
如图1至图5所示，一种基于机器人的光伏电池串定位方法，其具体步骤如下：
[0038]
s1、搭建实施平台：搭建实施平台确保相机一3和相机二4分别获取光伏电池串2的对角位置；
[0039]
s2、手眼标定关系：相机一3与机器人5的手眼标定关系为a1(r1,t1),相机二4与机器人5的手眼标定关系为a2(r2,t2)；
[0040]
s3、将一个光伏电池串2放在传送带1上,并认为是标准光伏电池串；
[0041]
s4、角点位置：相机一3得到的角点位置为c0(x0,y0)，相机二4得到的角点位置为c1(x1,y1)，根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
00
(x
00
,y
00
),p
10
(x
10
,y
10
)；
[0042]
s5、标准抓取位姿：机器人示教标准光伏电池串的中心位置，得到标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)；
[0043]
s6、根据步骤s5中的数据计算得到机器人5的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)，其中：
[0044]
x1＝min(x
00,
x
10
) |x
00
‑
x
10
|/2
[0045]
y1＝min(y
00,
y
10
) |y
00
‑
y
10
|/2
[0046]
r
z1
＝arctan((y
00
‑
y
10
)/(x
00
‑
x
10
))(x
00
‑
x
10
≠0；if x
00
‑
x
10
＝0,r
z1
＝0)
[0047]
s7、偏差公式：求标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)与计算得到机器人5的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)之间的偏差δp＝p1‑
p0＝(x1‑
x
0,
y1‑
y
0,
0,0,0,r
z1
‑
r
z0
)；
[0048]
s8、角点位置公式：任一光伏电池串2放在传送带1上，相机一3得到的角点位置为c2(x2,y2),相机二4得到的角点位置为c3(x3,y3),根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
20
(x
20
,y
20
),p
30
(x
30
,y
30
)，结合δp计算抓取位姿p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)，其中：
[0049]
x2＝min(x
20,
x
30
) |x
20
‑
x
30
|/2 (x1‑
x0)
[0050]
y2＝min(y
20,
y
30
) |y
20
‑
y
30
|/2 (y1‑
y0)
[0051]
α
＝arctan((y
30
‑
y
20
)/(x
30
‑
x
20
))(x
30
‑
x
20
≠0；if x
30
‑
x
20
＝0,α＝0)
[0052]
r
z2
＝α (r
z1
‑
r
z0
)。
[0053]
与现有技术相比，通过将光伏电池串2的两个对角分别对应相机一3和相机二4的视野内，不更改任何硬件设施以及软件参数，机器人5就能对光伏电池串2进行定位抓取，从而提高了生产柔性，解决了光伏生产时尺寸不一致问题；本发明通过相机一3和相机二4对图像进行预处理，基于开源软件实现，即机器人5自身的程序软件，不是购买商业视觉软件实现的，大大降低了使用成本。
[0054]
所述的相机一3和相机二4为任意视觉传感器均可。
[0055]
如图1所示，所述的步骤s1中搭建实施平台，通过机器人5的抓手6将光伏电池串2铺设在传送带1上，将相机一3和相机二4安装在能够获取光伏电池串2的角点一2.1、角点二2.2位置处。
[0056]
将相机一3和相机二4对物体的定位统一到同一坐标系下
‑
机器人基坐标系；然后
求出机器人示教的抓取位姿与根据相机定位计算得到的抓取位姿偏差；最后根据相机定位计算的位姿加上偏差得到实际的抓取位姿；通过图像预处理、粗定位和精定位方法求取角点位置。
[0057]
如图5所示，所述的步骤s4的角点位置c0(x0,y0),c1(x1,y1)是根据如下方法得到的：
[0058]
a、图像预处理：原图像
‑
>灰度图
‑
>二值化
‑
>形态学运算
‑
>canny边缘检测；
[0059]
b、粗定位：canny边缘检测
‑
>roi_1
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点1；
[0060]
c、精定位：根据交点1
‑
>roi_2
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点
‑
>亚像素拟合交点2
‑
>结束。
[0061]
d、交点2的坐标即为最终求得的角点位置。
[0062]
所述的步骤s8的c0(x0,y0),c2(x2,y2)是基于相机一3的相机坐标系下的位置；c1(x1,y1),c3(x3,y3)是基于相机二4的相机坐标系下的位置；
[0063]
p0(x0,y0,z0,r
x0
,r
y0
,r
z0
),p
00
(x
00
,y
00
),p
10
(x
10
,y
10
),p
20
(x
20
,y
20
),p
30
(x
30
,y
30
),p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)是基于机器人基坐标系下的位姿。
[0064]
计算机器人5示教的抓取位姿与根据相机一3和相机二4定位计算得到的抓取位姿偏差，同时粗定位光伏电池串2，然后加上抓取位姿偏差得到实际抓取位姿；对图像预处理，通过粗定位和精定位方法求取角点位置，解决了在实际生产中，电池串的种类较多、尺寸大小不一的问题，满足柔性生产需求。
[0065]
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是本发明的原理，在不脱离本发明精神和范围的前提下，本发明还会有各种变化和改进，这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

技术特征：
1.一种基于机器人的光伏电池串定位方法，其特征在于：其具体步骤如下：s1、搭建实施平台：搭建实施平台确保相机一(3)和相机二(4)分别获取光伏电池串(2)的对角位置；s2、手眼标定关系：相机一(3)与机器人(5)的手眼标定关系为a1(r1,t1),相机二(4)与机器人(5)的手眼标定关系为a2(r2,t2)；s3、将一个光伏电池串(2)放在传送带(1)上,并认为是标准光伏电池串；s4、角点位置：相机一(3)得到的角点位置为c0(x0,y0)，相机二(4)得到的角点位置为c1(x1,y1)，根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
00
(x
00
,y
00
),p
10
(x
10
,y
10
)；s5、标准抓取位姿：机器人示教标准光伏电池串的中心位置，得到标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)；s6、根据步骤s5中的数据计算得到机器人(5)的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)，其中：x1＝min(x
00,
x
10
) |x
00
‑
x
10
|/2y1＝min(y
00,
y
10
) |y
00
‑
y
10
|/2r
z1
＝arctan((y
00
‑
y
10
)/(x
00
‑
x
10
))(x
00
‑
x
10
≠0；if x
00
‑
x
10
＝0,r
z1
＝0)s7、偏差公式：求标准抓取位姿p0(x0,y0,z0,r
x0
,r
y0
,r
z0
)与计算得到机器人(5)的抓取位姿p1(x1,y1,z0,r
x0
,r
y0
,r
z1
)之间的偏差δp＝p1‑
p0＝(x1‑
x
0,
y1‑
y
0,
0,0,0,r
z1
‑
r
z0
)；s8、角点位置公式：任一光伏电池串(2)放在传送带(1)上，相机一(3)得到的角点位置为c2(x2,y2),相机二(4)得到的角点位置为c3(x3,y3),根据手眼标定结果，得到角点在机器人基坐标系下的位置分别为p
20
(x
20
,y
20
),p
30
(x
30
,y
30
)，结合δp计算抓取位姿p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)，其中：x2＝min(x
20,
x
30
) |x
20
‑
x
30
|/2 (x1‑
x0)y2＝min(y
20,
y
30
) |y
20
‑
y
30
|/2 (y1‑
y0)
α
＝arctan((y
30
‑
y
20
)/(x
30
‑
x
20
))(x
30
‑
x
20
≠0；if x
30
‑
x
20
＝0,α＝0)r
z2
＝α (r
z1
‑
r
z0
)。2.根据权利要求1所述的一种基于机器人的光伏电池串定位方法，其特征在于：所述的步骤s1中搭建实施平台，通过机器人(5)的抓手(6)将光伏电池串(2)铺设在传送带(1)上，将相机一(3)和相机二(4)安装在能够获取光伏电池串(2)的角点一(2.1)、角点二(2.2)位置处。3.根据权利要求1所述的一种基于机器人的光伏电池串定位方法，其特征在于：所述的步骤s4的角点位置c0(x0,y0),c1(x1,y1)是根据如下方法得到的：a、图像预处理：原图像
‑
>灰度图
‑
>二值化
‑
>形态学运算
‑
>canny边缘检测；b、粗定位：canny边缘检测
‑
>roi_1
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点1；c、精定位：根据交点1
‑
>roi_2
‑
>hough直线检测
‑
>直线最优检测
‑
>求交点
‑
>亚像素拟合交点2
‑
>结束。d、交点2的坐标即为最终求得的角点位置。4.根据权利要求1所述的一种基于机器人的光伏电池串定位方法，其特征在于：所述的步骤s8的c0(x0,y0),c2(x2,y2)是基于相机一(3)的相机坐标系下的位置；c1(x1,y1),c3(x3,
y3)是基于相机二(4)的相机坐标系下的位置；p0(x0,y0,z0,r
x0
,r
y0
,r
z0
),p
00
(x
00
,y
00
),p
10
(x
10
,y
10
),p
20
(x
20
,y
20
),p
30
(x
30
,y
30
),p2(x2,y2,z0,r
x0
,r
y0
,r
z2
)是基于机器人基坐标系下的位姿。
技术总结
本发明涉及机器人光伏电池串定位领域，具体是一种基于机器人的光伏电池串定位方法，其具体步骤如下：S1、搭建实施平台；S2、手眼标定关系；S3、将一个光伏电池串放在传送带上,并认为是标准光伏电池串；S4、角点位置；S5、标准抓取位姿；S6、根据步骤S5中的数据计算得到机器人的抓取位姿；S7、偏差公式；S8、角点位置公式；与现有技术相比，通过将光伏电池串的两个对角分别对应相机一和相机二的视野内，不更改任何硬件设施以及软件参数，机器人就能对光伏电池串进行定位抓取，从而提高了生产柔性，解决了光伏生产时尺寸不一致问题。光伏生产时尺寸不一致问题。光伏生产时尺寸不一致问题。


技术研发人员：马英 易廷昊 李祖云 储昭琦
受保护的技术使用者：埃夫特智能装备股份有限公司
技术研发日：2021.02.23
技术公布日：2021/6/29