CN115549533A - 基于摄像头的一维滑轨控制方法 - Google Patents
基于摄像头的一维滑轨控制方法 Download PDFInfo
- Publication number
- CN115549533A CN115549533A CN202211277244.5A CN202211277244A CN115549533A CN 115549533 A CN115549533 A CN 115549533A CN 202211277244 A CN202211277244 A CN 202211277244A CN 115549533 A CN115549533 A CN 115549533A
- Authority
- CN
- China
- Prior art keywords
- motor
- time
- camera
- stop
- offset
- 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.)
- Pending
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P7/00—Arrangements for regulating or controlling the speed or torque of electric DC motors
- H02P7/06—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current
- H02P7/18—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了基于摄像头的一维滑轨控制方法,包括摄像头工作,电机预热,测量输入延迟和制动时间和位移,记录全程摄像头偏移量和电机计数并拟合摄像头偏移量和电机转动量的线性关系后进入就绪状态;就绪状态下判断是否空闲:如不空闲,则进行作业,对滑块位置实时跟踪,预判目标位置运动并判断停止位置是否准确,若不准确,则补偿位置偏移量并反馈制动时间距离量,若准确则进入就绪状态;若是长期空闲,则记录全程摄像头像素偏移量和电机计数,拟合摄像头偏移量和电机转动量的线性方程后进入就绪状态,若是短期空闲,则测量输入延迟、制动时间和距离,拟合位置与制动距离的线性关系后进入就绪状态。可提高滑块对目标位置定位的精确性和实时性。
Description
技术领域
本发明属于直流电机控制技术领域,具体涉及基于摄像头的一维滑轨控制方法。
背景技术
直流电机控制领域一般使用电机电流和编码器计数(电机转速)作为输入来对直流电机进行控制计算。但对于非水平轨道而言,上升和下降受重力影响,所受的力也会不同,滑块在上升过程中,减速会偏快,从而未到目标位置就停止了,或不断的再进行修正而延长了工作时间。
现有的直流电机控制技术,若周围环境发生微小变化,如:负载变化、或滑轨上出现异物产生附加阻力,对电机的控制也会造成影响,从而降低工作效率。
发明内容
本发明所要解决的技术问题是针对上述现有技术的不足,提供基于摄像头的一维滑轨控制方法,除常规的电机编码器,引入摄像头作为控制算法的一部分来提高电机运动位置的实时性和精确性;利用摄像头的像素偏移量来计算与目标位置的距离和预判电机停止运动;利用在系统空闲时段,让电机进行自测计算,从为接下来电机作业的运动状况提供的预判,并使预判越来越准确,可提高滑块对目标位置定位的精确性和实时性,实现了基于摄像头的滑轨位置校准和制动预判以提高直流电机在滑轨上位移精准性的目的。
为实现上述技术目的,本发明采取的技术方案为:
基于摄像头的一维滑轨控制方法,应用于由电机驱动滑块的一维的滑轨上,所述摄像头安装于滑块上,配合上层图像识别应用,对目标物进行识别,来确定滑块的停止时间和距离;利用在闲时进行自测校准,和对于不同位置的电机停止测试,计算出在不同位置、不同负载情况下的制动预判,所述方法包括以下步骤:
步骤一、摄像头工作,电机预热,测量输入延迟和制动时间和位移,记录全程摄像头偏移量和电机计数并拟合摄像头偏移量和电机转动量的线性关系后进入就绪状态;
步骤二、就绪状态下,判断是否空闲:
如不空闲,则进行作业,对滑块位置进行实时跟踪,对目标位置进行运动预判,并判断最终停止位置是否准确,若不准确,则对位置偏移量进行补偿并对制动时间距离量进行反馈,若准确,则作业完成,重新进入就绪状态;
若空闲,则进行是否长期空闲判断,若是,则进入步骤四,否则进入步骤三;
步骤三、在不同位置,测量输入延迟并计算最小值,测量制动时间和距离,拟合位置与制动距离的线性关系后进入就绪状态;
步骤四、记录全程摄像头像素偏移量和电机计数,拟合摄像头像素偏移量和电机转动量的线性方程后进入就绪状态;
为优化上述技术方案,采取的具体措施还包括:
上述的步骤一中,摄像头工作,实时获取摄像头像素偏移量,具体为:
将图像进行转换成灰度图像,然后使用Canny边缘检测算法计算出图像特征物的边缘线条,即轮廓线,并将轮廓线的像素点进行保存;
持续记录摄像头每一帧的轮廓线的像素点,将当前帧的像素点与上一帧的像素点进行比对,并计算出每个像素点的位移量,并求出所有像素点位移量的中值,最终计算出每一帧的像素偏移量;该步骤与其它步骤并行执行。
上述的步骤一中,电机预热,驱动滑块沿滑轨边界运动,具体为:
假设滑轨的行程为X轴,电机驱动滑块移动到x=0的边界处,且继续向X轴的负方向(X-)运动,使电机堵转一段时间,使电机实现快速预热,随后再从x=0处向X轴正方向(X+)运动,当电机到达另一端边界时,电机发生堵转,电机电流增大和编码器计数不增长,故判定为到边界x=xmax处,随后电机驱动滑块立刻返回x=0处,使电机在运动过程中,靠空气对电机进行快速散热,从而达到较为恒定的状态。
上述的步骤一中,测量输入延迟和制动时间和位移,具体为:
在滑块静止的情况下,发送指令使电机转动,该时刻记为t1,使电机驱动滑块向X轴正方向(X+)开始运动;
当编码器计数从0到1时,该时刻记为t2;
当摄像头画面从静止状态刚到运动状态时,该时刻设置为t3;
从而计算得:
发送指令至电机编码器计数变化的延迟为dmot=min(dmot,t2-t1),首次计算时dmot=t2-t1,即电机延迟时间;
发送指令至摄像头变化的延迟为dcam=min(dcam,t3-t1),首次计算时dcam=t3-t1,即摄像头延迟时间;
在滑块匀速运动时,停止对电机输出,该时刻记为t4,此时电机编码器的计数从m=0开始计数;
滑块因惯性逐渐停止运动;
当摄像头画面从运动状态刚到静止状态时,该时刻记为t5,此时m=mstop;
从而计算出,从发送停止指令至实际停止,需要Δtstop=t5-t4,滑行距离为m=mstop-0;
同理,使电机驱动滑块向X轴负方向(X-)开始运动,二次测量输入延迟;
进入匀速状态后,停止对电机的输出,并记录负向运动的制动时间和位移;
除首次执行,之后的每次执行将建立mstop与Loc的X+方向和X-方向的两组线性关系:mstop=mstop1(Loc)X+运动方向,mstop=mstop2(Loc)X-运动方向。
上述的步骤一中,记录全程摄像头偏移量和电机计数,具体为:
将滑块从X=0边界移动到另一端x=xmax边界,此时n=0,m=0,当电机进入匀速状态时,记录为t6时刻;从t6+dcam时刻开始n=n1,记录每一帧的像素偏移量ΔSn;当电机驱动滑块到边界x=xmax处时,记录为t7时刻;在t7+dcam时刻,此时n=nend;
同时,在t6+dmot时刻,从m=m1开始实时记录编码器的计数m和每一计数的记录时刻tm;直到滑块运动到另一端边缘x=xmax处,t7时刻;在t7+dmot时刻,此时m=mend;最终求出匀速状态的平均速率:v=(mend-m1)/(t7-t6);
同理,再从x=xmax处运动到x=0边界处,记录全程摄像头偏移量和电机计数;当正反行程的mend不一致时,取其最大值mend=max(mend1,mend2);
建立像素偏移量ΔSi与编码器计数Cj关系;
像素偏移量ΔSi所对应的时间(ti=t6+dcam+(n-n1)/fps)与摄像头的帧率关联,而编码器计数Cj所对应的时间(tj=t6+dmot+(m-m1)/v)与计数的记录时刻关联,通过统一的时间单位的换算和插值后,建立像素偏移量ΔS与编码器计数C的关系图,并对两个来回的行程进行拼合,建立线性关系ΔS(C)。
上述的就绪状态下,若有待执行的作业,表示不空闲;若空闲时间在短期时间阈值内,且无作业安排,表示短期空闲;若空闲时间达到长期空闲时间阈值,且无作业安排,表示长期空闲。
上述的步骤二具体包括:
步骤B1:进行作业,执行作业指令;
步骤B2:对滑块位置进行预估和跟踪:
滑块的位置为Loc=m/mend×100%
其中,mend为滑轨全长,m为当前的电机编码器的计数;
步骤B3:对目标位置进行运动预判,使电机驱动滑块停止在指定目标物前;
步骤B4:通过上层应用对摄像头内容进行识别判断滑块停止位置是否准确,若准确执行步骤B5;否则执行步骤B6;
步骤B5:执行上层应用的操作,所有指令执行完毕后,进入就绪状态;
步骤B6:对偏移进行纠正:
根据上层应用对摄像头内容进行识别,识别出目标位置基准,再次用电机驱动滑块移动到目标基准处;计算出初始停止位置与基准处的像素偏移量ΔSerr,并记录在纠正过程中的电机编码器计数merr;
步骤B7:对制动时间距离量进行反馈:
将制动起始点Loc和ΔS(Loc)+ΔSerr重新带入ΔS(C)函数,并对函数重新进行线性回归计算;
将制动起始点Loc和mstop(Loc)+merr重新带入mstop(Loc)函数,并对函数重新进行线性回归计算。
上述的步骤B3包括:
步骤B3.1:通过上层应用获得目标位置,计算当前位置与目标位置的像素偏移量ΔSaim;根据之前对于制动距离的估算mstop(Loc)函数,计算出制动所需的距离;再将mstop(Loc)代入ΔS(C)得到预计的制动像素偏移量
步骤B3.2:
当ΔSaim>ΔSstop时,系统先不处理,重复执行步骤B3.1;
当ΔSaim<ΔSstop时,系统对制动距离进行预判,并计算出像素偏差量ΔSsa=ΔSstop-ΔSaim,通过ΔS(C)的线性关系,转化为ΔC=ΔS-1(ΔSsa),根据ΔC的大小,对电机施加反向作用,进行减速。
上述的步骤三拟合位置与制动时间距离的线性关系,具体包括:
分别建立X+方向运动的位置Loc与像素偏移量Sstop的关系,X-方向运动的位置Loc与像素偏移量Sstop的关系;对同一方向的不同位置点的位置Loc与像素偏移量Sstop进行线性回归拟合,得到Sstop(Loc)函数。
本发明具有以下有益效果:
本发明除常规的电机编码器,引入摄像头作为控制算法的一部分来提高电机运动位置的实时性和精确性;利用摄像头的像素偏移量来计算与目标位置的距离和预判电机停止运动;利用在系统空闲时段,让电机进行自测计算,从为接下来电机作业的运动状况提供的预判,并使预判越来越准确,可提高滑块对目标位置定位的精确性和实时性;在保证平滑运动的情况下,提高运动的响应速率;对于直线滑轨,可以减少因形变弯曲所带来的影响;可适用于任意方向且弯曲的滑轨;对于越是高速的滑轨,对于算法的运动要求就越高,本发明可适用于高速滑轨;减小因滑轨的微小形变给运动系统带来的影响;减小因异常环境(如皮带打滑、滑轨异物)给运动系统带来的影响;减小因负载变化给运动系统带来的影响;在保证平滑运动的情况下,提高运动的响应速率;提高滑块对目标位置定位的精确性和实时性;此外,利用摄像头来改善滑块的运动,降低了设备成本。
附图说明
图1为本发明基于摄像头的一维滑轨控制方法流程图。
具体实施方式
以下结合附图对本发明的实施例作进一步详细描述。
如图1所示,本发明基于摄像头的一维滑轨控制方法,应用于由电机驱动滑块的一维的滑轨上,所述摄像头安装于滑块上,配合上层图像识别应用,对目标物进行识别,来确定滑块的停止时间和距离;利用在闲时进行自测校准,和对于不同位置的电机停止测试,计算出在不同位置、不同负载情况下的制动预判,提高整个电机系统的运动效率,以及使滑块可以更为平滑地运动;同时,也适应对于非直线、非水平滑轨的电机工作情况;所述方法包括以下步骤:
步骤一、摄像头工作,电机预热,测量输入延迟和制动时间和位移,记录全程摄像头偏移量和电机计数并拟合摄像头偏移量和电机转动量的线性关系后进入就绪状态;
步骤二、就绪状态下,判断是否空闲:
如不空闲,则进行作业,对滑块位置进行实时跟踪,对目标位置进行运动预判,并判断最终停止位置是否准确,若不准确,则对位置偏移量进行补偿并对制动时间距离量进行反馈,若准确,则作业完成,重新进入就绪状态;
若空闲,则进行是否长期空闲判断,若是,则进入步骤四,否则进入步骤三;
步骤三、在不同位置,测量输入延迟并计算最小值,测量制动时间和距离,拟合位置与制动距离的线性关系后进入就绪状态;
步骤四、记录全程摄像头像素偏移量和电机计数,拟合摄像头像素偏移量和电机转动量的线性方程后进入就绪状态;
实施例中,所述步骤一包括:
步骤A1:摄像头工作,实时获取摄像头像素偏移量:
将图像进行转换成灰度图像,然后使用Canny边缘检测算法计算出图像特征物的边缘线条,即轮廓线,并将轮廓线的像素点进行保存;
持续记录摄像头每一帧的轮廓线的像素点,将当前帧的像素点与上一帧的像素点进行比对,并计算出每个像素点的位移量,并求出所有像素点位移量的中值,最终计算出每一帧的像素偏移量;该步骤与其它步骤并行执行;
步骤A2:电机预热,驱动滑块沿滑轨边界运动:
假设滑轨的行程为X轴,电机驱动滑块移动到x=0的边界处,且继续向X轴的负方向(X-)运动,使电机堵转一段时间,使电机实现快速预热,随后再从x=0处向X轴正方向(X+)运动,当电机到达另一端边界时,电机会发生堵转,电机电流增大和编码器计数不增长,故判定为到边界x=xmax处,随后电机驱动滑块立刻返回x=0处,使电机在运动过程中,靠空气对电机进行快速散热,从而达到较为恒定的状态;
步骤A3:测量输入延迟和制动时间和位移:
在滑块静止的情况下,发送指令使电机转动,该时刻记为t1,使电机驱动滑块向X轴正方向(X+)开始运动;
当编码器计数从0到1时,该时刻记为t2;
当摄像头画面从静止状态刚到运动状态时,该时刻设置为t3;
从而计算得:
发送指令至电机编码器计数变化的延迟为dmot=min(dmot,t2-t1)(首次计算时dmot=t2-t1),即电机延迟时间;
发送指令至摄像头变化的延迟为dcam=min(dcam,t3-t1)(首次计算时dcam=t3-t1),即摄像头延迟时间;
在滑块匀速运动时,停止对电机输出(输出的PWM占空比为0),该时刻记为t4,此时电机编码器的计数从m=0开始计数;
滑块因惯性逐渐停止运动;
当摄像头画面从运动状态刚到静止状态时,该时刻记为t5,此时m=mstop;
从而计算出,从发送停止指令至实际停止,需要Δtstop=t5-t4,滑行距离为m=mstop-0;
同理,使电机驱动滑块向X轴负方向(X-)开始运动,二次测量输入延迟;
进入匀速状态后,停止对电机的输出,并记录负向运动的制动时间和位移;
除首次执行,之后的每次执行将建立mstop与Loc的X+方向和X-方向的两组线性关系:mstop=mstop1(Loc)X+运动方向,mstop=mstop2(Loc)X-运动方向;
步骤A4:记录全程摄像头偏移量和电机计数:
将滑块从X=0边界移动到另一端x=xmax边界,此时n=0,m=0,当电机进入匀速状态时,记录为t6时刻;从t6+dcam时刻开始n=n1,记录每一帧的像素偏移量ΔSn;当电机驱动滑块到边界x=xmax处时,记录为t7时刻;在t7+dcam时刻,此时n=nend;
同时,在t6+dmot时刻,从m=m1开始实时记录编码器的计数m和每一计数的记录时刻tm;直到滑块运动到另一端边缘x=xmax处(t7时刻);在t7+dmot时刻,此时m=mend;最终求出匀速状态的平均速率:v=(mend-m1)/(t7-t6);
同理,再从x=xmax处运动到x=0边界处,记录全程摄像头偏移量和电机计数;当正反行程的mend不一致时,取其最大值mend=max(mend1,mend2);
在匀速状态下,因摄像头的角度或弯曲的轨道,每帧的“像素偏移量ΔSi”并非是定值,为了更好的预判制动距离和时间,需要建立“像素偏移量ΔSi”与“编码器计数Cj”关系;
“像素偏移量ΔSi”所对应的时间(ti=t6+dcam+(n-n1)/fps)与摄像头的帧率关联,而“编码器计数Cj”所对应的时间(tj=t6+dmot+(m-m1)/v)与计数的记录时刻关联,故可以通过统一的时间单位的换算和插值后,建立“像素偏移量ΔS”与“编码器计数C”的关系图(即摄像头所侦测到的位移与电机侦测到的位移量进行对应),并对两个来回的行程进行拼合,建立线性关系ΔS(C);
步骤A5:就绪状态:
若有待执行的作业,表示不空闲,执行步骤B1(进行作业);
若空闲一段时间(如3分钟)后,且无作业安排,表示短期空闲,执行步骤C1;
若长时间空闲(如30分钟),且无作业安排,表示长期空闲,执行步骤D1。
实施例中,步骤二具体包括:
步骤B1:进行作业
执行作业指令;
步骤B2:对滑块位置进行预估和跟踪:
根据电机编码器的计数来估算滑块的位置,编码器的计数随着电机正反旋转而加减;根据在步骤A4的测量中,已知滑轨全长为mend;故通过当前的电机编码器的计数m,可以得出滑块的大致位置为Loc=m/mend×100%
步骤B3:对目标位置进行运动预判;
当摄像头在作业状态下,检测到目标物时,将对其位置进行制动预判,使电机驱动滑块可以精确的停止在指定目标物前;减少和避免非必要的二次校准;
首先通过上层应用,定位目标位置,得到在摄像头中的目标位置;
步骤B3.1:计算当前位置与目标位置的像素偏移量ΔSaim;根据之前对于制动距离的估算mstop(Loc)函数,计算出制动所需的距离;再将mstop(Loc)代入ΔS(C)得到预计的制动像素偏移量
步骤B3.2:
当ΔSaim>ΔSstop时,系统先不处理,重复执行步骤B3.1;
当ΔSaim<ΔSstop时,系统对制动距离进行预判,并计算出像素偏差量ΔSsa=ΔSstop-ΔSaim,通过ΔS(C)的线性关系,转化为ΔC=ΔS-1(ΔSsa),根据ΔC的大小,对电机施加反向作用,进行减速;
步骤B4:判断最终停止位置是否准确?
通过上层应用对摄像头内容进行识别判断滑块停止位置是否准确,若准确执行步骤B5;否则执行步骤B6;
步骤B5:作业完成
执行上层应用的操作,所有指令执行完毕后,返回步骤A5(就绪状态);
步骤B6:对偏移进行纠正
根据上层应用对摄像头内容进行识别,识别出目标位置基准,再次用电机驱动滑块移动到目标基准处;计算出初始停止位置与基准处的像素偏移量ΔSerr,并记录在纠正过程中的电机编码器计数merr;
步骤B7:对制动时间距离量进行反馈
将制动起始点Loc和ΔS(Loc)+ΔSerr重新带入ΔS(C)函数,并对函数重新进行线性回归计算;
将制动起始点Loc和mstop(Loc)+merr重新带入mstop(Loc)函数,并对函数重新进行线性回归计算。
实施例中,步骤三具体包括:
步骤C1:短期空闲
在不同位置,执行步骤A3(测量输入延迟、测量制动时间和位移),随后执行C2;
步骤C2:拟合位置与制动时间距离的线性关系
因滑轨可能是非直线、非水平的滑轨,所以X+和X-方向,以及不同位置的制动时间和距离均有略微的不同;为了能更精确的估算出不同位置的制动时间和距离,将分别建立X+方向运动的“位置Loc”与“像素偏移量Sstop”的关系;X-方向运动的“位置Loc”与“像素偏移量Sstop”的关系;对同一方向的不同位置点的“位置Loc”与“像素偏移量Sstop”进行线性回归拟合,得到Sstop(Loc)函数;
实施例中,步骤四包括:
步骤D1:长期空闲:执行步骤A4(记录全程摄像头偏移量和电机计数)
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (9)
1.基于摄像头的一维滑轨控制方法,应用于由电机驱动滑块的一维的滑轨上,所述摄像头安装于滑块上,配合上层图像识别应用,对目标物进行识别,来确定滑块的停止时间和距离;利用在闲时进行自测校准,和对于不同位置的电机停止测试,计算出在不同位置、不同负载情况下的制动预判,其特征在于,所述方法包括以下步骤:
步骤一、摄像头工作,电机预热,测量输入延迟和制动时间和位移,记录全程摄像头偏移量和电机计数并拟合摄像头偏移量和电机转动量的线性关系后进入就绪状态;
步骤二、就绪状态下,判断是否空闲:
如不空闲,则进行作业,对滑块位置进行实时跟踪,对目标位置进行运动预判,并判断最终停止位置是否准确,若不准确,则对位置偏移量进行补偿并对制动时间距离量进行反馈,若准确,则作业完成,重新进入就绪状态;
若空闲,则进行是否长期空闲判断,若是长期空闲,则进入步骤四,若是短期空闲,则进入步骤三;
步骤三、在不同位置,测量输入延迟,测量制动时间和距离,拟合位置与制动距离的线性关系后进入就绪状态;
步骤四、记录全程摄像头像素偏移量和电机计数,拟合摄像头像素偏移量和电机转动量的线性方程后进入就绪状态;
2.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤一中,摄像头工作,实时获取摄像头像素偏移量,具体为:
将图像进行转换成灰度图像,然后使用Canny边缘检测算法计算出图像特征物的边缘线条,即轮廓线,并将轮廓线的像素点进行保存;
持续记录摄像头每一帧的轮廓线的像素点,将当前帧的像素点与上一帧的像素点进行比对,并计算出每个像素点的位移量,并求出所有像素点位移量的中值,最终计算出每一帧的像素偏移量;该步骤与其它步骤并行执行。
3.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤一中,电机预热,驱动滑块沿滑轨边界运动,具体为:
假设滑轨的行程为X轴,电机驱动滑块移动到x=0的边界处,且继续向X轴的负方向(X-)运动,使电机堵转一段时间,使电机实现快速预热,随后再从x=0处向X轴正方向(X+)运动,当电机到达另一端边界时,电机发生堵转,电机电流增大和编码器计数不增长,故判定为到边界x=xmax处,随后电机驱动滑块立刻返回x=0处,使电机在运动过程中,靠空气对电机进行快速散热,从而达到较为恒定的状态。
4.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤一中,测量输入延迟和制动时间和位移,具体为:
在滑块静止的情况下,发送指令使电机转动,该时刻记为t1,使电机驱动滑块向X轴正方向(X+)开始运动;
当编码器计数从0到1时,该时刻记为t2;
当摄像头画面从静止状态刚到运动状态时,该时刻设置为t3;
从而计算得:
发送指令至电机编码器计数变化的延迟为dmot=min(dmot,t2-t1),首次计算时dmot=t2-t1,即电机延迟时间;
发送指令至摄像头变化的延迟为dcam=min(dcam,t3-t1),首次计算时dcam=t3-t1,即摄像头延迟时间;
在滑块匀速运动时,停止对电机输出,该时刻记为t4,此时电机编码器的计数从m=0开始计数;
滑块因惯性逐渐停止运动;
当摄像头画面从运动状态刚到静止状态时,该时刻记为t5,此时m=mstop;
从而计算出,从发送停止指令至实际停止,需要Δtstop=t5-t4,滑行距离为m=mstop-0;
同理,使电机驱动滑块向X轴负方向(X-)开始运动,二次测量输入延迟;
进入匀速状态后,停止对电机的输出,并记录负向运动的制动时间和位移;
除首次执行,之后的每次执行将建立mstop与Loc的X+方向和X-方向的两组线性关系:mstop=mstop1(Loc)X+运动方向,mstop=mstop2(Loc)X-运动方向。
5.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤一中,记录全程摄像头偏移量和电机计数,具体为:
将滑块从X=0边界移动到另一端x=xmax边界,此时n=0,m=0,当电机进入匀速状态时,记录为t6时刻;从t6+dcam时刻开始n=n1,记录每一帧的像素偏移量ΔSn;当电机驱动滑块到边界x=xmax处时,记录为t7时刻;在t7+dcam时刻,此时n=nend;
同时,在t6+dmot时刻,从m=m1开始实时记录编码器的计数m和每一计数的记录时刻tm;直到滑块运动到另一端边缘x=xmax处,t7时刻;在t7+dmot时刻,此时m=mend;最终求出匀速状态的平均速率:v=(mend-m1)/(t7-t6);
同理,再从x=xmax处运动到x=0边界处,记录全程摄像头偏移量和电机计数;当正反行程的mend不一致时,取其最大值mend=max(mend1,mend2);
建立像素偏移量ΔSi与编码器计数Cj关系;
像素偏移量ΔSi所对应的时间(ti=t6+dcam+(n-n1)/fps)与摄像头的帧率关联,而编码器计数Cj所对应的时间(tj=t6+dmot+(m-m1)/v)与计数的记录时刻关联,通过统一的时间单位的换算和插值后,建立像素偏移量ΔS与编码器计数C的关系图,并对两个来回的行程进行拼合,建立线性关系ΔS(C)。
6.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,就绪状态下,若有待执行的作业,表示不空闲;若空闲时间在短期时间阈值内,且无作业安排,表示短期空闲;若空闲时间达到长期空闲时间阈值,且无作业安排,表示长期空闲。
7.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤二具体包括:
步骤B1:进行作业,执行作业指令;
步骤B2:对滑块位置进行预估和跟踪:
滑块的位置为Loc=m/mend×100%
其中,mend为滑轨全长,m为当前的电机编码器的计数;
步骤B3:对目标位置进行运动预判,使电机驱动滑块停止在指定目标物前;
步骤B4:通过上层应用对摄像头内容进行识别判断滑块停止位置是否准确,若准确执行步骤B5;否则执行步骤B6;
步骤B5:执行上层应用的操作,所有指令执行完毕后,进入就绪状态;
步骤B6:对偏移进行纠正:
根据上层应用对摄像头内容进行识别,识别出目标位置基准,再次用电机驱动滑块移动到目标基准处;计算出初始停止位置与基准处的像素偏移量ΔSerr,并记录在纠正过程中的电机编码器计数merr;
步骤B7:对制动时间距离量进行反馈:
将制动起始点Loc和ΔS(Loc)+ΔSerr重新带入ΔS(C)函数,并对函数重新进行线性回归计算;
将制动起始点Loc和mstop(Loc)+merr重新带入mstop(Loc)函数,并对函数重新进行线性回归计算。
8.根据权利要求7所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤B3包括:
步骤B3.1:通过上层应用获得目标位置,计算当前位置与目标位置的像素偏移量ΔSaim;根据之前对于制动距离的估算mstop(Loc)函数,计算出制动所需的距离;再将mstop(Loc)代入ΔS(C)得到预计的制动像素偏移量
步骤B3.2:
当ΔSaim>ΔSstop时,系统先不处理,重复执行步骤B3.1;
当ΔSaim<ΔSstop时,系统对制动距离进行预判,并计算出像素偏差量ΔSsa=ΔSstop-ΔSaim,通过ΔS(C)的线性关系,转化为ΔC=ΔS-1(ΔSsa),根据ΔC的大小,对电机施加反向作用,进行减速。
9.根据权利要求1所述的基于摄像头的一维滑轨控制方法,其特征在于,所述步骤三拟合位置与制动时间距离的线性关系,具体包括:
分别建立X+方向运动的位置Loc与像素偏移量Sstop的关系,X-方向运动的位置Loc与像素偏移量Sstop的关系;对同一方向的不同位置点的位置Loc与像素偏移量Sstop进行线性回归拟合,得到Sstop(Loc)函数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211277244.5A CN115549533A (zh) | 2022-10-19 | 2022-10-19 | 基于摄像头的一维滑轨控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211277244.5A CN115549533A (zh) | 2022-10-19 | 2022-10-19 | 基于摄像头的一维滑轨控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115549533A true CN115549533A (zh) | 2022-12-30 |
Family
ID=84734615
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211277244.5A Pending CN115549533A (zh) | 2022-10-19 | 2022-10-19 | 基于摄像头的一维滑轨控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115549533A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115880646A (zh) * | 2023-02-20 | 2023-03-31 | 中国民航大学 | 一种飞机入离位状态识别方法 |
-
2022
- 2022-10-19 CN CN202211277244.5A patent/CN115549533A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115880646A (zh) * | 2023-02-20 | 2023-03-31 | 中国民航大学 | 一种飞机入离位状态识别方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115549533A (zh) | 基于摄像头的一维滑轨控制方法 | |
US10690243B2 (en) | Range switching device for automatic transmission and switching method therefor | |
JP4782766B2 (ja) | 機械診断方法及びその装置 | |
US9952249B2 (en) | Inertia estimating method and inertia estimation apparatus of position control apparatus | |
US20110054680A1 (en) | Method of determining failure of robot | |
JP2008211905A (ja) | サーボモータ制御装置 | |
EP3808618B1 (en) | Brake system | |
US8082647B2 (en) | Method for determining the optimal insertion force of a fastener press | |
CN105487484B (zh) | 电动机控制装置 | |
US4878077A (en) | Motor drive and control apparatus for a camera | |
EP3355140B1 (en) | Performing position control of a controlled object | |
CN101470243B (zh) | 摄像设备及其控制方法 | |
US10059564B2 (en) | Method for determining moving mass of a door system | |
US20150336201A1 (en) | Spot welding system and spot welding method | |
US20160263854A1 (en) | Servo press and control method | |
US7099761B2 (en) | Method and device for determining a position of a part of a motor vehicle seat which can be displaced by means of a drive device | |
CN112224788B (zh) | 一种自动定位智慧物流输送线的控制方法 | |
US6796155B2 (en) | Sheet thickness detecting method and device therefor in bending machine, reference inter-blade distance detecting method and device therefor, and bending method and bending device | |
JP5561459B2 (ja) | プレス機械装置およびそのモータ制御装置 | |
JP2005279872A (ja) | ロボットの制御方法 | |
US20240075519A1 (en) | Computer implemented method for adjusting a fastener setting tool | |
US20230324872A1 (en) | Servo control device | |
CN116317774A (zh) | 一种考虑重力影响的机器人电机端惯量及摩擦力辨识方法 | |
CN113704953A (zh) | 寿命估算方法及其装置、介质、终端及伺服进给系统 | |
JP7236876B2 (ja) | ワイパ装置及びワイパ制御装置 |
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 |