一种高精度相机拍照定位的方法与流程

文档序号:17844197发布日期:2019-06-11 21:33阅读:743来源:国知局
一种高精度相机拍照定位的方法与流程

本发明涉及太阳能电池生产领域,具体涉及一种高精度相机拍照定位的方法。



背景技术:

在太阳能电池生产过程中,需将多个串接好的电池串按要求放置在铺好eva的钢化玻璃上以便连接,对位置精度要求较高。

目前通常的是采用人工搬运和调整方式进行安装,但这种方式不仅劳动效率低,精度差,且由于光伏电池串易碎。

为了提高效率,目前逐渐使用移栽机构对电池串进行搬运,但移栽机构后依然存在精度差的问题。



技术实现要素:

为了克服现有技术中的问题,提供一种高精度相机拍照定位的方法,能够对移栽机构搬运的电池串进行调整,定位精度高。

本发明提供一种高精度相机拍照定位的方法,具体包括以下步骤:

s1、定位相机对模板进行拍照,选取两个定位点,获取定位点的像素坐标系坐标;

s2、将获取的定位点的像素坐标系坐标转化为直角坐标系坐标;

s3、确定两个定位点连线中心点的直角坐标系坐标以及连线倾斜角;

s4、对待调整电池串进行拍照,获取待调整电池串定位点的直角坐标系坐标,获取两定位点连线中心点的直角坐标系坐标以及倾斜角;

s5、获取定位纠偏向量以及移栽机构需要旋转的角度,根据定位纠偏向量以及移栽机构需要旋转的角度对待调整电池串进行调整。

进一步地,所述步骤s1中记载的选取两个定位点,获取定位点的像素坐标系坐标具体为:

s101、从模板电池串中的任意一个电池片上任选两个顶点或任意两个电池片上各任选一个顶点作为定位点a和定位点b;

s102、根据定位相机拍照获得定位点a和b在像素坐标系下的坐标。

进一步地,所述步骤s2中记载的将获取的定位点的像素坐标系坐标转化为直角坐标系坐标具体为:

s201、依据定位相机相对位置以及相机参数对到像素坐标系与直角坐标系的转换关系;

s202、将获取的定位点的像素坐标系坐标转化为直角坐标系坐标,定位点a的直角坐标系坐标为a0(xa0,ya0),定位点b的直角坐标系坐标为b0(xb0,yb0)。

进一步地,所述步骤s3中记载的确定两个定位点连线中心点的直角坐标系坐标以及连线倾斜角具体为:

将定位点a和定位点b连接,得到线段k0,k0的中心点为m0,m0的直角坐标系坐标为线段k0在直角坐标系的倾斜角为

进一步地,所述步骤s4中记载的对待调整电池串进行拍照,获取待调整电池串定位点的直角坐标系坐标,获取两定位点连线中心点的直角坐标系坐标以及倾斜角具体为:

待调整电池串定位点a1的直角坐标系坐标a1(xa1,ya1),定位点b1的直角坐标系坐标为b1(xb1,yb1),将定位点a1和定位点b1连接,得到线段k1,k1的中心点为m1,m1的直角坐标系坐标为线段k1在直角坐标系的倾斜角为

进一步地,当所述步骤s5中对待调整电池串进行调整是先进行纠正在通过移栽机构搬运时,所述步骤s5具体为:

s501、在定位相机视觉范围内旋转移栽机构三次或三次以上;

s502、获取每次旋转时定位点a或定位点b的直角坐标系坐标;

s503、根据三次或三次以上定位点a的直角坐标系坐标,确定移栽机构旋转中心点投影的直角坐标系坐标c0(xc0,yc0);

s504、计算m0和c0之间的距离l,

s505、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s506、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s507、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s508、将调整好的电池串移送到放料位置。

进一步地,当所述步骤s5中对待调整电池串进行调整是先进行移栽机构搬运在进行纠正时,所述步骤s5具体为:

s511、在定位相机视觉范围内旋转移栽机构三次或三次以上;

s512、获取每次旋转时定位点a或定位点b的直角坐标系坐标;

s513、根据三次或三次以上定位点a的直角坐标系坐标,确定移栽机构旋转中心点投影的直角坐标系坐标c0(xc0,yc0);

s514、获取待调整电池串在x方向上的偏移量dx和在y方向上的偏移量dy,

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s515、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s516、将待调整电池串移送到放料位置;

s517、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置。

进一步地,所述两个定位点为电池串短边顶点时,所述步骤s5具体包括:

s521、获取所述电池串的料长l;

s522、计算m0和c0之间的距离l,

s523、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s524、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s525、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s526、将调整好的电池串移送到放料位置。

进一步地,所述两个定位点为电池串长边顶点时,所述步骤s5具体包括:

s531、获取所述电池串的料宽w;

s532、计算m0和c0之间的距离l,

s533、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s534、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s535、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s536、将调整好的电池串移送到放料位置。

进一步地,所述定位相机为两个或两个以上。

本发明相对于现有技术,具有以下有益效果:

仅通过摄像头对电池串的两个顶点进行定位,通过计算获得定位纠偏向量,对电池串位置进行调整,提高了移栽机构搬运的电池串精度,使得精度控制在0.1mm以内,提高了工作效率。

附图说明

图1是本发明方法的流程图;

图2是本发明一实施方式中定位相机像素坐标系的示意图;

图3是本发明一实施方式中转换后的直角坐标系的示意图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。

一种高精度相机拍照定位的方法,如图1所示,具体包括以下步骤:

s1、如图2所示,定位相机对模板进行拍照,选取两个定位点,获取定位点的像素坐标系坐标;

s2、如图3所示,将获取的定位点的像素坐标系坐标转化为直角坐标系坐标;

s3、确定两个定位点连线中心点的直角坐标系坐标以及连线倾斜角;

s4、对待调整电池串进行拍照,获取待调整电池串定位点的直角坐标系坐标,获取两定位点连线中心点的直角坐标系坐标以及倾斜角;

s5、获取定位纠偏向量以及移栽机构需要旋转的角度,根据定位纠偏向量以及移栽机构需要旋转的角度对待调整电池串进行调整。

在上述方案的基础上,进一步地,所述步骤s1中记载的选取两个定位点,获取定位点的像素坐标系坐标具体为:

s101、从模板电池串中的任意一个电池片上任选两个顶点或任意两个电池片上各任选一个顶点作为定位点a和定位点b;

s102、根据定位相机拍照获得定位点a和b在像素坐标系下的坐标。

在本实施方式中,由于电池串是由多个电池片串成一串构成,若两个定位点设在同一个短边上,则两个定位点正好是短边的两个端点。

采用上述技术方案,电池串中电池片的顶点均可以作为定位点,定位点的选取非常灵活,仅仅通过两个定位点就能够准确确定电池串的位置,计算简单定位准确,提高了效率。

进一步地,所述步骤s2中记载的将获取的定位点的像素坐标系坐标转化为直角坐标系坐标具体为:

s201、依据定位相机相对位置以及相机参数对到像素坐标系与直角坐标系的转换关系;

s202、将获取的定位点的像素坐标系坐标转化为直角坐标系坐标,定位点a的直角坐标系坐标为a0(xa0,ya0),定位点b的直角坐标系坐标为b0(xb0,yb0)。

采用上述技术方案,将多个定位相机的坐标系统一,使得所有的坐标均在一个直角坐标系下。

在上述方案的基础上,进一步地,所述步骤s3中记载的确定两个定位点连线中心点的直角坐标系坐标以及连线倾斜角具体为:

将定位点a和定位点b连接,得到线段k0,k0的中心点为m0,m0的直角坐标系坐标为线段k0在直角坐标系的倾斜角为

在上述方案的基础上,进一步地,所述步骤s4中记载的对待调整电池串进行拍照,获取待调整电池串定位点的直角坐标系坐标,获取两定位点连线中心点的直角坐标系坐标以及倾斜角具体为:

待调整电池串定位点a1的直角坐标系坐标a1(xa1,ya1),定位点b1的直角坐标系坐标为b1(xb1,yb1),将定位点a1和定位点b1连接,得到线段k1,k1的中心点为m1,m1的直角坐标系坐标为线段k1在直角坐标系的倾斜角为

在上述方案的基础上,进一步地,当所述步骤s5中对待调整电池串进行调整是先进行纠正在通过移栽机构搬运时,所述步骤s5具体为:

s501、在定位相机视觉范围内旋转移栽机构三次或三次以上;

s502、获取每次旋转时定位点a或定位点b的直角坐标系坐标;

s503、根据三次或三次以上定位点a的直角坐标系坐标,确定移栽机构旋转中心点投影的直角坐标系坐标c0(xc0,yc0);

s504、计算m0和c0之间的距离l,

s505、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s506、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s507、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s508、将调整好的电池串移送到放料位置。

在上述方案的基础上,进一步地,当所述步骤s5中对待调整电池串进行调整是先进行移栽机构搬运在进行纠正时,所述步骤s5具体为:

s511、在定位相机视觉范围内旋转移栽机构三次或三次以上;

s512、获取每次旋转时定位点a或定位点b的直角坐标系坐标;

s513、根据三次或三次以上定位点a的直角坐标系坐标,确定移栽机构旋转中心点投影的直角坐标系坐标c0(xc0,yc0);

s514、获取待调整电池串在x方向上的偏移量dx和在y方向上的偏移量dy,

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s515、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s516、将待调整电池串移送到放料位置;

s517、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置。

在上述方案的基础上,进一步地,所述两个定位点为电池串短边顶点时,所述步骤s5具体包括:

s521、获取所述电池串的料长l;

s522、计算m0和c0之间的距离l,

s523、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s524、获取定位纠偏向量以及移栽机构需要旋转的角度

移栽机构需要旋转的角度δ∝=θ-∝;

s525、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s526、将调整好的电池串移送到放料位置。

在本实施方式中,由于电池串的规格是已知的,电池串的料长可以直接获得,也可以通过定位相机进行测量获取。

采用上述技术方案,当定位相机视觉范围较窄或者移栽机构转动不方便,无法通过旋转移栽机构的方式获取移栽机构的旋转中心时,并且定位点为电池串短边的两个端点时,可以利用m0和c0之间的距离约等于半料长的方式进行计算。采用这种方式,精度依然能够保证在0.1mm以内。

在上述方案的基础上,进一步地,所述两个定位点为电池串长边顶点时,所述步骤s5具体包括:

s531、获取所述电池串的料宽w;

s532、计算m0和c0之间的距离l,

s533、计算在x方向上的偏移量dx和在y方向上的偏移量dy,

dx=±l×(cos∝±cosθ),

dy=±l×(sin∝±sinθ),

其中,∝为模板两定位点连线在直角坐标系倾斜角,θ为待调整电池串两定位点连线在直角坐标系倾斜角,c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号;

s534、获取定位纠偏向量以及移栽机构需要旋转的角度,其中定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝;

s535、移栽机构根据定位纠偏向量以及移栽机构需要旋转的角度δ∝调整待调整电池串位置;

s536、将调整好的电池串移送到放料位置。

在本实施方式中,由于电池串的规格是已知的,电池串的料宽可以直接获得,也可以通过定位相机进行测量获取。

采用上述技术方案,当定位相机视觉范围较窄或者移栽机构转动不方便,无法通过旋转移栽机构的方式获取移栽机构的旋转中心时,并且定位点为电池串长边的两个端点时,可以利用m0和c0之间的距离约等于半料宽的方式进行计算。采用这种方式,精度依然能够保证在0.1mm以内。

在上述方案的基础上,进一步地,所述定位相机为两个或多个。

采用上述技术方案,当定位相机为两个时,可以通过两个定位点确定电池串的位置,当定位相机为多个时可以更好确定电池串的位置,可以测量料长和料宽。

下面通过四个具体实施方式对本发明的方法进行详细说明。

实施方式一

s601、定位相机对模板进行拍照,选取任意两边缘相交点中的两个点,在本实施方式中选取长边的两个端点作为定位点,在平面坐标系下像素坐标pa(xpa,ypa),pb(xpb,ypb)。

通过预先完成定位相机的标定工作,可以将定位相机所捕捉图像的像素坐标pa,pb转换为同一平面的直角坐标系下,得到直角坐标系坐标a0(xa0,ya0),b0(xb0,yb0)。根据定位相机的相对位置以及相机参数进行标定。相机的参数包括单个像元的宽和高,焦距,kappa,中心点x坐标和y坐标,图像宽和高,相机位姿(x,y,z以及x,y,z方向的旋转)等等。

s602、根据a、b两点确定一条线段,k0,则该线段k0在直角坐标系中的中心点为该线段在直角坐标系中的角度为将该线段的中点m0,角度∝作为基准位置,将移载机构的拍照位置的基准坐标保存。

s603、在相机视野的允许范围内控制移载机构在拍照位置平行于直角坐标系旋转至少3次,由平面中三点确定一个圆,比如选取定位点a,根据旋转3次定位点a的三个位置确定圆心,该圆心点在直角坐标系下垂直方向的投影为c0(xc0,yc0)。圆心的计算方式是该领域常规的计算方法。

如果移载机构拍照位置不发生改变,该投影坐标在直角坐标系下的坐标将不会发生改变。

s604、移栽机构搬运待调整电池串到定位相机拍照位置,获取待调整电池串定位点a1、b1连线k1中心点为m1的直角坐标系坐标为

在实际生产中,移栽机构在直角坐标系下的旋转中心点c0(xc0,yc0)和线段中心点m1在直角坐标系下的坐标重合是小概率事件,此方法需保证每次移栽机构的旋转中心点坐标相对于线段中心点的位置不发生变化,m0到c0的距离就是固定不变的,此距离就是:

所以移栽机构旋转过程中,很大概率会导致线段中心点在直角坐标系下x和y方向的坐标发生改变。

该改变在x方向上表现为:dx=±l×(cos∝±cosθ)。

该改变在y方向上表现为:dy=±l×(sin∝±sinθ)。

其中注:c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号。

由此可以得出定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝。

通过上述方法s601-s604,计算出向量后可以直接将向量叠加到平行于直角坐标系的任意坐标系中的移栽机构的抓取位置上,并且让移栽机构旋转δ∝角度,从而实现对来料x,y和θ三个自由度的偏位纠正。将此向量录入移栽机构的控制系统,在之后的重复性过程中m0和m1的相对位置不会发生改变。

实施方式二

s701、移载机构将模块电池串吸取至相机拍照位置触发拍照。

s702、相机拍照,选取任意两边缘相交点中的两个点,在本实施方式中选取长边的两个端点作为定位点,在平面坐标系下像素坐标pa(xpa,ypa),pb(xpb,ypb)。

s703、通过预先完成定位相机的标定工作可以将相机所捕捉图像的像素坐标pa,pb转换为同一平面直角坐标系下的实际坐标a0(xa0,ya0),b0(xb0,yb0)。根据定位相机的相对位置以及相机参数进行标定。相机的参数包括单个像元的宽和高,焦距,kappa,中心点x坐标和y坐标,图像宽和高,相机位姿(x,y,z以及x,y,z方向的旋转)等等。

s704、根据两点确定一条线段,由a0、b0两点确定一条线段k0,则该线段k0在直角坐标系中的中心点为该线段在直角坐标系中的角度为将该线段的中点m0,角度∝作为基准位置,将移载机构的拍照位置的基准坐标保存。

s705、在相机视野的允许范围内控制移载机构在拍照位置平行于直角坐标系旋转至少3次,比如选取定位点a,根据旋转3次定位点a的三个位置确定圆心,该圆心点在直角坐标系下垂直方向的投影为c0(xc0,yc0),如果移载机构拍照位置不发生改变,该投影坐标在直角坐标系下的坐标将不会发生改变。

s706、移栽机构搬运待调整电池串到定位相机拍照位置,获取待调整电池串定位点a1、b1连线k1中心点为m1的直角坐标系坐标为

在实际生产中,移栽机构在相机坐标系下的旋转中心点c0(xc0,yc0)和线段k1中心点m1在直角坐标系下的坐标重合是小概率事件,所以移栽机构旋转过程中,很大概率会导致线段中心点在直角坐标系下x和y方向的坐标发生改变。

该改变在x方向上表现为:

该改变在y方向上表现为:

其中注:c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号。

由此可以得出定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝。

对于外形尺寸相同的来料,通过上述方法s701-s706,计算出向量后可以直接将向量叠加到平行于直角坐标系的任意坐标系中的放料位置上,并且让移栽机构旋转δ∝,从而实现对来料x,y和θ三个自由度的偏位纠正。

有些情况下定位相机视觉范围比较小,无法通过移栽机构旋转获取移栽机构旋转圆心的位置。此时通过获取料宽的一半或者料长的一半来近似等于m0到c0的距离。

实施方式三

s801、定位相机对模板进行拍照,选取任意两边缘相交点中的两个点,在本实施方式中选取短边的两个端点作为定位点,在平面坐标系下像素坐标pa(xpa,ypa),pb(xpb,ypb),获取模板的料长l。

通过预先完成定位相机的标定工作,可以将定位相机所捕捉图像的像素坐标pa,pb转换为同一平面的直角坐标系下,得到直角坐标系坐标a0(xa0,ya0),b0(xb0,yb0)。根据定位相机的相对位置以及相机参数进行标定。相机的参数包括单个像元的宽和高,焦距,kappa,中心点x坐标和y坐标,图像宽和高,相机位姿(x,y,z以及x,y,z方向的旋转)等等。s802、根据a、b两点确定一条线段,k0,则该线段k0在直角坐标系中的中心点为该线段在直角坐标系中的角度为将该线段的中点m0,角度∝作为基准位置,将移载机构的拍照位置的基准坐标保存。

s803、在相机视野的允许范围内控制移载机构在拍照位置平行于直角坐标系旋转至少3次,由平面中三点确定一个圆,比如选取定位点a,根据旋转3次定位点a的三个位置确定圆心,该圆心点在直角坐标系下垂直方向的投影为c0(xc0,yc0)。圆心的计算方式是该领域常规的计算方法。

如果移载机构拍照位置不发生改变,该投影坐标在直角坐标系下的坐标将不会发生改变。

s804、移栽机构搬运待调整电池串到定位相机拍照位置,获取待调整电池串定位点a1、b1连线k1中心点为m1的直角坐标系坐标为

在实际生产中,移栽机构在直角坐标系下的旋转中心点c0(xc0,yc0)和线段中心点m1在直角坐标系下的坐标重合是小概率事件,此方法需保证每次移栽机构的旋转中心点坐标相对于线段中心点的位置不发生变化,m0到c0的距离就是固定不变的,此距离就是:

所以移栽机构旋转过程中,很大概率会导致线段中心点在直角坐标系下x和y方向的坐标发生改变。

该改变在x方向上表现为:dx=±l×(cos∝±cosθ)。

该改变在y方向上表现为:dy=±l×(sin∝±sinθ)。

其中注:c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号。

由此可以得出定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝。

通过上述方法s801-s804,计算出向量后可以直接将向量叠加到平行于直角坐标系的任意坐标系中的移栽机构的抓取位置上,并且让移栽机构旋转δ∝角度,从而实现对来料x,y和θ三个自由度的偏位纠正。将此向量录入移栽机构的控制系统,在之后的重复性过程中m0和m1的相对位置不会发生改变。

实施方式四

s901、定位相机对模板进行拍照,选取任意两边缘相交点中的两个点,在本实施方式中选取长边的两个端点作为定位点,在平面坐标系下像素坐标pa(xpa,ypa),pb(xpb,ypb),获取模板的料宽w。

通过预先完成定位相机的标定工作,可以将定位相机所捕捉图像的像素坐标pa,pb转换为同一平面的直角坐标系下,得到直角坐标系坐标a0(xa0,ya0),b0(xb0,yb0)。根据定位相机的相对位置以及相机参数进行标定。相机的参数包括单个像元的宽和高,焦距,kappa,中心点x坐标和y坐标,图像宽和高,相机位姿(x,y,z以及x,y,z方向的旋转)等等。s902、根据a、b两点确定一条线段,k0,则该线段k0在直角坐标系中的中心点为该线段在直角坐标系中的角度为将该线段的中点m0,角度∝作为基准位置,将移载机构的拍照位置的基准坐标保存。

s903、在相机视野的允许范围内控制移载机构在拍照位置平行于直角坐标系旋转至少3次,由平面中三点确定一个圆,比如选取定位点a,根据旋转3次定位点a的三个位置确定圆心,该圆心点在直角坐标系下垂直方向的投影为c0(xc0,yc0)。圆心的计算方式是该领域常规的计算方法。

如果移载机构拍照位置不发生改变,该投影坐标在直角坐标系下的坐标将不会发生改变。

s904、移栽机构搬运待调整电池串到定位相机拍照位置,获取待调整电池串定位点a1、b1连线k1中心点为m1的直角坐标系坐标为

在实际生产中,移栽机构在直角坐标系下的旋转中心点c0(xc0,yc0)和线段中心点m1在直角坐标系下的坐标重合是小概率事件,此方法需保证每次移栽机构的旋转中心点坐标相对于线段中心点的位置不发生变化,m0到c0的距离就是固定不变的,此距离就是:

所以移栽机构旋转过程中,很大概率会导致线段中心点在直角坐标系下x和y方向的坐标发生改变。

该改变在x方向上表现为:dx=±l×(cos∝±cosθ)。

该改变在y方向上表现为:dy=±l×(sin∝±sinθ)。

其中注:c0点和m1点在直角坐标系下相对位置不同时需要考虑到±的正负号。

由此可以得出定位纠偏向量

移栽机构需要旋转的角度δ∝=θ-∝。

通过上述方法s901-s904,计算出向量后可以直接将向量叠加到平行于直角坐标系的任意坐标系中的移栽机构的抓取位置上,并且让移栽机构旋转δ∝角度,从而实现对来料x,y和θ三个自由度的偏位纠正。将此向量录入移栽机构的控制系统,在之后的重复性过程中m0和m1的相对位置不会发生改变。

上面的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的构思和范围进行限定。在不脱离本发明设计构思的前提下,本领域普通人员对本发明的技术方案做出的各种变型和改进,均应落入到本发明的保护范围,本发明请求保护的技术内容,已经全部记载在权利要求书中。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1