CN109631851B - 一种平粮机器人的同步计算方法 - Google Patents
一种平粮机器人的同步计算方法 Download PDFInfo
- Publication number
- CN109631851B CN109631851B CN201910100973.5A CN201910100973A CN109631851B CN 109631851 B CN109631851 B CN 109631851B CN 201910100973 A CN201910100973 A CN 201910100973A CN 109631851 B CN109631851 B CN 109631851B
- Authority
- CN
- China
- Prior art keywords
- grain leveling
- robot
- grain
- leveling robot
- chassis
- 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
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 43
- 238000004364 calculation method Methods 0.000 title claims abstract description 35
- 238000000034 method Methods 0.000 claims abstract description 37
- 238000006073 displacement reaction Methods 0.000 claims abstract description 19
- 238000001514 detection method Methods 0.000 claims description 40
- 230000000007 visual effect Effects 0.000 claims description 22
- 239000003086 colorant Substances 0.000 claims description 8
- 238000007689 inspection Methods 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000004075 alteration Effects 0.000 claims description 3
- 238000002474 experimental method Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 2
- 239000012535 impurity Substances 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 239000013589 supplement Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/02—Picture taking arrangements specially adapted for photogrammetry or photographic surveying, e.g. controlling overlapping of pictures
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G69/00—Auxiliary measures taken, or devices used, in connection with loading or unloading
- B65G69/04—Spreading out the materials conveyed over the whole surface to be loaded; Trimming heaps of loose materials
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Multimedia (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Adjustment And Processing Of Grains (AREA)
Abstract
本发明公开一种平粮机器人的同步计算方法,其计算过程中使用同步走道使用的平粮机器人和走道板,其中平粮机器人通过连接的平粮杆对粮仓平整表面进行平整,通过底盘驱动和转动;通过OpenMV模块采集图像信息,计算出平粮机器人的位移偏移量、偏移角度,通过全向轮转向速度模型计算出平粮机器人的移动速度;该方法能够实时反馈数据,及时地对平粮机器人作出调整,使得平粮机器人主机和平粮机器人从机行进方向和角度一致,保持速度相同而同步,实现双机的协调运动,提供保持平粮机器人的同步和一致性的计算方法。
Description
技术领域
本发明涉及粮食储存和平整技术领域,具体而言,涉及一种平粮机器人的同步计算方法。
背景技术
在粮食储藏过程中,平仓作业是储粮管理的基本要求,其次是要布设测温电缆,这两种作业均采用人工操作完成。近年来,国家投资兴建了大批中央粮食储备库,这些储备库多以高大平房仓和浅圆仓为主,粮食储存、运输方式多为散装和散运的形式。我国智能平仓除杂设备的严重缺失,直接制约了提升总公司仓储技术装备水平的发展要求,因此应加快平仓除杂关键技术及配套装备的研制工作。
平粮机器人专门为粮仓内粮食表面的最终平整阶段而设计。平粮工作分为两个阶段:初平和精平,精平机器人是为精平阶段所用设备,该设备工作效果是让粮食平整后如镜面般水平。
在运行前,粮仓表面已经被粗略的平整过,并且已经铺好井字型走道,底盘在井字型走道上移动,然后机器人在底盘的运行作用下进行横扫和旋扫粮食表面,以达到粮面精平的效果,该平粮过程中平粮机器人需保持同步性和一致性,这样才能使得机器人平稳地工作,实现同步操作。
发明内容
本发明的目的在于提供一种平粮机器人的同步计算方法,其能够实时反馈数据,及时地对平粮机器人作出调整,使得平粮机器人主机和平粮机器人从机行进方向和角度一致,保持速度相同而同步,提供保持平粮机器人的同步和一致性的计算方法。
本发明的实施例是这样实现的:
一种平粮机器人的同步计算方法,其包括:S1、通过OpenMV模块采集的各检测区域内巡线带的中心点至该检测区域中心的距离数据,采用加权平均的方法计算平粮机器人的位移偏移量的平均值;S2、通过OpenMV模块的摄像头视野区域的长度和宽度,利用三角函数关系求得平粮机器人的偏移角度δ;S3、通过平粮机器人底盘的轮子半径、底盘半径和各轮的转速,利用全向轮转向速度模型计算平粮机器人的移动速度;S4、接收摄像头检测的平粮机器人的位移偏移量average,通过摄像头视野区域的长度,计算出偏差信号Dx;S5、判断Dx是否大于0,若Dx大于0,则通过得到的δ调整角度顺时针转动,若Dx小于0,则通过得到的δ调整角度逆时针转动,若Dx等于0,则直接进入S6;S6、通过计算全向轮转向速度模型得到平粮机器人的移动速度。
在本发明较佳的实施例中,上述S1中检测区域至少为2个,加权平均的方法计算如下:
在本发明较佳的实施例中,上述S2中利用三角函数关系求偏移角度的方法计算如下:
在本发明较佳的实施例中,上述S3中全向轮转向速度模型为至少两轮的全向轮底盘,轮呈对称等距间隔设置于底盘底部且各轮的大小相同。
在本发明较佳的实施例中,上述S3中全向轮底盘为三个全向轮的底盘,全向轮转向速度模型的计算方法如下:
其中,Vx、Vy、Vz分别表示在当前平粮机器人底盘坐标系下的x轴、y轴和z轴的速度,ω表示在当前平粮机器人底盘坐标系下绕自身几何中心的旋转速度,ω1、ω2ω3分别表示底盘三个轮子的旋转速度a1、a2、a3、b1、b2、b3、c1、c2和c3分别为计算速度的矩阵的系数,L为底盘的半径,R为轮子的半径。
在本发明较佳的实施例中,上述偏差信号Dx的计算方法为:
Dx=S-a
其中,S为检测区域长度的一半,a为平粮机器人的位移偏移量average。
在本发明较佳的实施例中,上述S3中全向轮转向速度模型为三轮的全向轮底盘的转向速度模型。
本发明的有益效果是:
本发明通过OpenMV模块采集图像信息,通过图像信息中的检测区域一端至巡线带的距离计算出平粮机器人的位移偏移量,通过偏移量的三角关系计算出偏移角度,通过全向轮的数据计算出平粮机器人的移动速度;该方法能够实时反馈数据,及时地对平粮机器人作出调整,使得平粮机器人主机和平粮机器人从机行进方向和角度一致,保持速度相同而同步,提供保持平粮机器人的同步和一致性的计算方法。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定。
图1为本发明机器视觉模块检测的示意图;
图2为本发明平粮机器人同步计算的应用的示意图;
图标:1-走道板;2-检测区域。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
第一实施例
请参照图1,本实施例提供一种平粮机器人的同步计算方法,其计算过程中使用同步走道使用的平粮机器人和走道板1,其中,平粮机器人包括平粮机器人主机和平粮机器人从机,平粮机器人主机和平粮机器人从机之间设置有用于对粮仓平整表面的平粮杆,底盘连接至平粮机器人的底部,底盘的直径大小为600mm,机器视觉模块为OpenMV模块,OpenMV模块包括摄像头且设置于平粮机器人行进方向的一端,巡线带从一端至另一端设置于走道板1顶面,通过OpenMV模块采集图像信息,图像信息分为多个检测区域2,距离x为检测区域2内巡线带的中心点距检测区域2的一端的距离;巡线带与走道板1的颜色分别设置为具有色差的颜色,巡线带为白色,走道板1设为墨绿色。在底盘上安装照明灯,尽量让摄像头能够区分走道板1颜色和巡线带的白色,摄像头正对白色巡线带安装,使捕捉到的白色巡线带图像位于整体图像的正中。
该巡线方案是平粮机器人使用OpenMV模块,根据走道板1的白色线带进行主机和从机双机巡线,使用OpenMV模块的视觉开源算法检测平粮机器人中线距离巡线带中线的距离,当平粮机器人中线偏离巡线带的中线后,视为偏离巡线带,平粮机器人通过此距离x进行PID控制,不停地调整平粮机器人转向角度,使平粮机器人在行进过程一直处于巡线带中心,以达到巡线的效果,防止平粮机器人偏离走道板1。平粮机器人主机和平粮机器人从机的通信方式为无线串口通信,其中,串口波特率为115200bps,接口方式为RS485,摄像头输出数据为TTL信号,电路板所接收的只能是RS232或RS485信号,所以通过TTL转RS485模块将TTL信号转换成RS485信号。
一种平粮机器人的同步计算方法,其计算过程使用以上平粮机器人和走道板1,方法包括:
设置底盘的初始速度,底盘驱动平粮机器人主机和平粮机器人从机分别沿不同的走道板1行进,平粮机器人主机和平粮机器人从机通过机器视觉模块识别巡线带颜色并保持行进方向;
通过OpenMV模块双机巡线,可以保证平粮机器人不会偏离走道板1,达到巡线的效果,但是要实现完整的精平作业,还要保证两平粮机器人同步,为了防止平粮机器人一前一后不同步的情况,本方案使用同步两平粮机器人速度的方法保持两平粮机器人同步。平粮机器人主机和平粮机器人从机在测试过程中设置0.1m/s的速度同时前进,其中该巡线的速度可以根据实际情况进行调整,平粮机器人行进速度范围为Vx1=0.1±0.05m/s,Vx2=0.1±0.05m/s。
通过OpenMV模块设定识别巡线带的阀值并确定阀值范围,通过外部补光灯照明巡线将阀值维持在固定值,设置该白色巡线带的阀值为(-80,80),调节阈值找到在摄像头视野的白线,算出当前摄像头位置相对于白色巡线带的角度偏移量δ,以δ为偏差值运用全向轮转向速度模型将速度解算到底盘的三个轮子,左右调节平粮机器人的位置,始终保持平粮机器人Vx方向与白线的中线重合,当发生角度偏移δ时,全向轮底盘转动将角度偏移量调节至0,这样将平粮机器人尽量限定在走道板1上;OpenMV模块是一个封装好的视觉处理模块,搭载了MicroPython解释器,能够使用python进行编程,使得机器视觉算法编程变得简单。本次巡线方案中使用如下的开源算法,最大矩形框为摄像头的视野范围设为160×120像素,视野区域内横向距离为160,竖向距离为120,将视野范围分为三个区域,运用封装好的函数find_blobs()找每个区域的最大块白色巡线带,对每块检测区域2的白色巡线带的中心点进行加权平均,根据中心公式求出白色巡线带相对于屏幕竖直中线的偏移。加权平均的值按如下公式计算:
其中W1、W2、W3是根据重要程度设定的权值,X1、X2、X3是当前各个检测区域白色巡线带的中心至检测区域中心的距离;通过反复实验设定出W1、W2、W3的值,不同实验环境取值不同,该实施例取W1=0.2、W2=0.3、W3=0.5,X1、X2、X3根据实际试验中测试得到,则:
S2、通过OpenMV模块的摄像头视野区域的长度和宽度,利用三角函数关系求得平粮机器人的偏移角度δ;
OpenMV模块的摄像头的最大矩形框的视野范围设为160×120像素,视野区域内横向距离为160,竖向距离为120,通过机器视觉模块分别检测平粮机器人相对于巡线带的距离x,平粮机器人主机检测区域2一端相对于巡线带中心的距离为x1,平粮机器人从机检测区域2一端相对于巡线带中心的距离为x2,平粮机器人相对于巡线带的角度偏移量δ,平粮机器人主机和平粮机器人从机沿走道板1同时前进,并通过底盘转动而调整角度偏移量δ至0。
偏移角度按照如下的公式计算:
为了使得平粮机器人的主控板便于接收摄像头的数据,需要把摄像头输出的数据转成三位数,于是当所寻找的颜色在最左边的时候,摄像头输出数据范围在±80之间,所以把摄像头数据加了180以后最小的数据为100,最大数据为260。在处理了数据以后,当摄像头输出数据为180时,表示此时寻找的目标在视野的正中央,此时不对平粮机器人进行调整,当输出数据小于180时,需要控制平粮机器人顺时针旋转,当输出数据大于180时,控制平粮机器人逆时针旋转。
S3、通过平粮机器人底盘的轮子半径、底盘半径和各轮的转速,利用全向轮转向速度模型计算平粮机器人的移动速度。平粮机器人的旋转通过使用全向轮的底盘进行转动,从而调节角度偏移量。全向轮底盘共设置有3个滚轮,该全向轮底盘使用的是现有技术的三角底盘总成的全向轮底盘,该3个滚轮围绕平粮机器人中心转动进行调节。
平粮机器人主机检测自身速度,每间隔时间200ms向平粮机器人从机发送沿巡线带方向的速度Vx1,平粮机器人从机接收速度信息并反馈自身速度Vx2至平粮机器人主机;使两台平粮机器人在行走的同时相互接发速度指令,即以其中一台平粮机器人为主机,运行过程中每200ms向从机发送一次自身的Vx方向的速度指令,从机接到速度指令即以该给定速度行走,并且在接到速度后立即将自身Vx的速度信息返回给主机,主机接收到从机返回速度指令后同样将该速度作为自身运行速度。
平粮机器人从机将Vx1作为速度指令并沿巡线带方向行进,平粮机器人主机接收速度信息并将Vx2作为速度指令沿巡线带方向行进;使两台平粮机器人在行走的同时相互接发速度指令,即以其中一台平粮机器人为主机,运行过程中每200ms向从机发送一次自身的Vx方向的速度指令,从机接到速度指令即以该给定速度行走,并且在接到速度后立即将自身Vx的速度信息返回给主机,主机接收到从机返回速度指令后同样将该速度作为自身运行速度;从机接收到巡线速度指令后同时以0.1m/s的速度进行巡线,以确保两平粮机器人同步,主机接收到巡线速度指令后同时以0.1m/s的速度进行巡线,以确保两平粮机器人同步。
在程序控制中平粮机器人主机和平粮机器人从机采用主从机的方式进行同步,在平粮机器人开机后,主机首先发送准备指令,以确认从机已经准备好开始巡线,待主机确认从机准备完毕后,向从机发送速度指令(0.1m/s速度),同时以该速度进行巡线,从机接收到巡线速度指令后同时以0.1m/s的速度进行巡线,以确保两平粮机器人同步。
平粮机器人主机和平粮机器人从机通过全向轮底盘进行驱动行进,行进速度通过全向轮转向速度模型计算出;或平粮机器人安装有检测速度的仪器,通过仪器测试平粮机器人的行进速度;全向轮底盘为三个等距分布全向轮的底盘,通过底盘的半径、全向轮半径和全向轮转速计算出平粮机器人沿巡线带方向的速度,三个轮子的转动速度和平粮机器人的移动速度根据实际偏差随时调整,计算公式如下:
其中,Vx、Vy、Vz分别表示在当前平粮机器人底盘坐标系下的x轴、y轴和z轴的速度,ω表示在当前平粮机器人底盘坐标系下绕自身几何中心的旋转速度,ω1、ω2、ω3分别表示底盘三个轮子左轮、右轮和后轮的旋转速度,a1、a2、a3、b1、b2、b3、c1、c2和c3分别为计算速度的矩阵的系数,L为底盘的半径,R为轮子的半径。
三个轮子的转动速度和平粮机器人的移动速度根据实际偏差随时调整,三滚轮的全向轮底盘的速度与轮子转速的计算如下:
其中,ω1、ω2、ω3分别表示底盘三个轮子左轮、右轮和后轮的旋转速度,底盘的半径为0.6m,轮子的半径为0.3m。
平粮机器人主机和平粮机器人从机重复以上过程,保持速度同步和角度一致,完成同步走道,平粮杆在平粮机器人主机和平粮机器人从机的带动下对滑过区域进行平整。
S4、接收摄像头检测的平粮机器人的位移偏移量average,通过摄像头视野区域的长宽,计算出偏差信号Dx;
S5、判断Dx是否大于0,若Dx大于0,则通过得到的δ调整角度顺时针转动,若Dx小于0,则通过得到的δ调整角度逆时针转动,若Dx等于0,则直接进入S6;
S6、通过计算全向轮转向速度模型得到平粮机器人的移动速度,该全向轮转向速度模型为三轮的全向轮底盘的转向速度模型,偏差信号Dx的计算方法为:
Dx=80-a
其中,S为检测区域2长度的一半,a为实验中平粮机器人的位移偏移量average,该值在实验中不断变化。
第二实施例
请参照图1,本实施例提供一种平粮机器人的同步计算方法,其计算过程中使用同步走道使用的平粮机器人和走道板1,其中,平粮机器人包括平粮机器人主机和平粮机器人从机,平粮机器人主机和平粮机器人从机之间设置有用于对粮仓平整表面的平粮杆,底盘连接至平粮机器人的底部,底盘的直径大小为500mm,机器视觉模块为OpenMV模块,OpenMV模块包括摄像头且设置于平粮机器人行进方向的一端,巡线带从一端至另一端设置于走道板1顶面,通过OpenMV模块采集图像信息,图像信息分为多个检测区域2,距离x为检测区域2内巡线带的中心点距检测区域2的一端的距离;巡线带与走道板1的颜色分别设置为具有色差的颜色,巡线带为白色,走道板1设为墨绿色。在底盘上安装照明灯,尽量让摄像头能够区分走道板1颜色和巡线带的白色,摄像头正对白色巡线带安装,使捕捉到的白色巡线带图像位于整体图像的正中。
第二实施例和第一实施例部分相同,不同之处在于使用该方法所计算的平粮机器人和走道板的参数不同。
该巡线方案是平粮机器人使用OpenMV模块,根据走道板1的白色线带进行主机和从机双机巡线,使用OpenMV模块的视觉开源算法检测平粮机器人中线距离巡线带中线的距离,当平粮机器人中线偏离巡线带的中线后,视为偏离巡线带,平粮机器人通过此距离x进行PID控制,不停地调整平粮机器人转向角度,使平粮机器人在行进过程一直处于巡线带中心,以达到巡线的效果,防止平粮机器人偏离走道板1。平粮机器人主机和平粮机器人从机的通信方式为无线串口通信,其中,串口波特率为115200bps,接口方式为RS485,摄像头输出数据为TTL信号,电路板所接收的只能是RS232或RS485信号,所以通过TTL转RS485模块将TTL信号转换成RS485信号。
一种平粮机器人的同步计算方法,其计算过程使用以上平粮机器人和走道板1,方法包括:
设置底盘的初始速度,底盘驱动平粮机器人主机和平粮机器人从机分别沿不同的走道板1行进,平粮机器人主机和平粮机器人从机通过机器视觉模块识别巡线带颜色并保持行进方向;
通过OpenMV模块双机巡线,可以保证平粮机器人不会偏离走道板1,达到巡线的效果,但是要实现完整的精平作业,还要保证两平粮机器人同步,为了防止平粮机器人一前一后不同步的情况,本方案使用同步两平粮机器人速度的方法保持两平粮机器人同步。平粮机器人主机和平粮机器人从机在测试过程中设置0.15m/s的速度同时前进,其中该巡线的速度可以根据实际情况进行调整,平粮机器人行进速度范围为Vx1=0.15±0.05m/s,Vx2=0.15±0.05m/s。
通过OpenMV模块设定识别巡线带的阀值并确定阀值范围,通过外部补光灯照明巡线将阀值维持在固定值,设置该白色巡线带的阀值为(-100,100),调节阈值找到在摄像头视野的白线,算出当前摄像头位置相对于白色巡线带的角度偏移量δ,以δ为偏差值运用全向轮转向速度模型将速度解算到底盘的三个轮子,左右调节平粮机器人的位置,始终保持平粮机器人Vx方向与白线的中线重合,当发生角度偏移δ时,全向轮底盘转动将角度偏移量调节至0,这样将平粮机器人尽量限定在走道板1上;OpenMV模块是一个封装好的视觉处理模块,搭载了MicroPython解释器,能够使用python进行编程,使得机器视觉算法编程变得简单。本次巡线方案中使用如下的开源算法,最大矩形框为摄像头的视野范围设为200×140像素,视野区域内横向距离为200,竖向距离为140,将视野范围分为三个区域,运用封装好的函数find_blobs()找每个区域的最大块白色巡线带,对每块检测区域2的白色巡线带的中心点进行加权平均,根据中心公式求出白色巡线带相对于屏幕竖直中线的偏移。加权平均的值按如下公式计算:
其中W1、W2、W3是根据重要程度设定的权值,X1、X2、X3是当前各个检测区域白色巡线带的中心至检测区域中心的距离;通过反复实验设定出W1、W2、W3的值,不同实验环境取值不同,该实施例取W1=0.1、W2=0.35、W3=0.55,X1、X2、X3根据实际试验中测试得到,则:
S2、通过OpenMV模块的摄像头视野区域的长度和宽度,利用三角函数关系求得平粮机器人的偏移角度δ;
OpenMV模块的摄像头的最大矩形框的视野范围设为200×140像素,视野区域内横向距离为200,竖向距离为140,通过机器视觉模块分别检测平粮机器人相对于巡线带的距离x,平粮机器人主机检测区域2一端相对于巡线带中心的距离为x1,平粮机器人从机检测区域2一端相对于巡线带中心的距离为x2,平粮机器人相对于巡线带的角度偏移量δ,平粮机器人主机和平粮机器人从机沿走道板1同时前进,并通过底盘转动而调整角度偏移量δ至0。
偏移角度按照如下的公式计算:
为了使得平粮机器人的主控板便于接收摄像头的数据,需要把摄像头输出的数据转成三位数,于是当所寻找的颜色在最左边的时候,摄像头输出数据范围在±100之间,所以把摄像头数据加了100以后最小的数据为0,最大数据为200。在处理了数据以后,当摄像头输出数据为100时,表示此时寻找的目标在视野的正中央,此时不对平粮机器人进行调整,当输出数据小于100时,需要控制平粮机器人顺时针旋转,当输出数据大于100时,控制平粮机器人逆时针旋转。
S3、通过平粮机器人底盘的轮子半径、底盘半径和各轮的转速,利用全向轮转向速度模型计算平粮机器人的移动速度。平粮机器人的旋转通过使用全向轮的底盘进行转动,从而调节角度偏移量。全向轮底盘共设置有3个滚轮,该全向轮底盘使用的是现有技术的三角底盘总成的全向轮底盘,该3个滚轮围绕平粮机器人中心转动进行调节。
平粮机器人主机检测自身速度,每间隔时间500ms向平粮机器人从机发送沿巡线带方向的速度Vx1,平粮机器人从机接收速度信息并反馈自身速度Vx2至平粮机器人主机;使两台平粮机器人在行走的同时相互接发速度指令,即以其中一台平粮机器人为主机,运行过程中每500ms向从机发送一次自身的Vx方向的速度指令,从机接到速度指令即以该给定速度行走,并且在接到速度后立即将自身Vx的速度信息返回给主机,主机接收到从机返回速度指令后同样将该速度作为自身运行速度。
平粮机器人从机将Vx1作为速度指令并沿巡线带方向行进,平粮机器人主机接收速度信息并将Vx2作为速度指令沿巡线带方向行进;使两台平粮机器人在行走的同时相互接发速度指令,即以其中一台平粮机器人为主机,运行过程中每500ms向从机发送一次自身的Vx方向的速度指令,从机接到速度指令即以该给定速度行走,并且在接到速度后立即将自身Vx的速度信息返回给主机,主机接收到从机返回速度指令后同样将该速度作为自身运行速度;从机接收到巡线速度指令后同时以0.15m/s的速度进行巡线,以确保两平粮机器人同步,主机接收到巡线速度指令后同时以0.15m/s的速度进行巡线,以确保两平粮机器人同步。
在程序控制中平粮机器人主机和平粮机器人从机采用主从机的方式进行同步,在平粮机器人开机后,主机首先发送准备指令,以确认从机已经准备好开始巡线,待主机确认从机准备完毕后,向从机发送速度指令(0.15m/s速度),同时以该速度进行巡线,从机接收到巡线速度指令后同时以0.15m/s的速度进行巡线,以确保两平粮机器人同步。
平粮机器人主机和平粮机器人从机通过全向轮底盘进行驱动行进,行进速度通过全向轮转向速度模型计算出;或平粮机器人安装有检测速度的仪器,通过仪器测试平粮机器人的行进速度;全向轮底盘为三个等距分布全向轮的底盘,通过底盘的半径、全向轮半径和全向轮转速计算出平粮机器人沿巡线带方向的速度,三个轮子的转动速度和平粮机器人的移动速度根据实际偏差随时调整,计算公式如下:
其中,Vx、Vy、Vz分别表示在当前平粮机器人底盘坐标系下的x轴、y轴和z轴的速度,ω表示在当前平粮机器人底盘坐标系下绕自身几何中心的旋转速度,ω1、ω2、ω3分别表示底盘三个轮子左轮、右轮和后轮的旋转速度,a1、a2、a3、b1、b2、b3、c1、c2和c3分别为计算速度的矩阵的系数,L为底盘的半径,R为轮子的半径。
三个轮子的转动速度和平粮机器人的移动速度根据实际偏差随时调整,三滚轮的全向轮底盘的速度与轮子转速的计算如下:
其中,ω1、ω2、ω3分别表示底盘三个轮子左轮、右轮和后轮的旋转速度,底盘的半径为0.5m,轮子的半径为0.3m。
平粮机器人主机和平粮机器人从机重复以上过程,保持速度同步和角度一致,完成同步走道,平粮杆在平粮机器人主机和平粮机器人从机的带动下对滑过区域进行平整。
S4、接收摄像头检测的平粮机器人的位移偏移量average,通过摄像头视野区域的长宽,计算出偏差信号Dx;
S5、判断Dx是否大于0,若Dx大于0,则通过得到的δ调整角度顺时针转动,若Dx小于0,则通过得到的δ调整角度逆时针转动,若Dx等于0,则直接进入S6;
S6、通过计算全向轮转向速度模型得到平粮机器人的移动速度,该全向轮转向速度模型为三轮的全向轮底盘的转向速度模型,偏差信号Dx的计算方法为:
Dx=100-a
其中,S为检测区域2长度的一半,a为实验中平粮机器人的位移偏移量average,该值在实验中不断变化。
综上所述,本发明实例通过OpenMV模块采集图像信息,通过图像信息中的检测区域一端至巡线带的距离计算出平粮机器人的位移偏移量,通过偏移量的三角关系计算出偏移角度,通过全向轮的数据计算出平粮机器人的移动速度;该方法能够实时反馈数据,及时地对平粮机器人作出调整,使得平粮机器人主机和平粮机器人从机行进方向和角度一致,保持速度相同而同步,提供保持平粮机器人的同步和一致性的计算方法。
本说明书描述了本发明的实施例的示例,并不意味着这些实施例说明并描述了本发明的所有可能形式。本领域的普通技术人员将会意识到,这里所述的实施例是为了帮助读者理解本发明的原理,应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。本领域的普通技术人员可以根据本发明公开的这些技术启示做出各种不脱离本发明实质的其它各种具体变形和组合,这些变形和组合仍然在本发明的保护范围内。
Claims (7)
1.一种平粮机器人的同步计算方法,其特征在于,计算过程中使用同步走道使用的平粮机器人和走道板,其中,平粮机器人包括平粮机器人主机和平粮机器人从机,平粮机器人主机和平粮机器人从机之间设置有用于对粮仓平整表面的平粮杆,底盘连接至平粮机器人的底部,机器视觉模块为OpenMV模块,OpenMV模块包括摄像头且设置于平粮机器人行进方向的一端,巡线带从一端至另一端设置于走道板顶面,通过OpenMV模块采集图像信息,图像信息分为多个检测区域,距离x为各检测区域内巡线带的中心点距该检测区域的中心的距离;巡线带与走道板的颜色分别设置为具有色差的颜色,在底盘上安装照明灯,尽量让摄像头能够区分走道板颜色和巡线带,摄像头正对巡线带安装,使捕捉到的巡线带图像位于整体图像的正中;
方法包括:
S2、通过OpenMV模块的摄像头视野区域的长度和宽度,利用三角函数关系求得平粮机器人的偏移角度δ;
S3、通过平粮机器人底盘的轮子半径、底盘半径和各轮的转速,利用全向轮转向速度模型计算平粮机器人的移动速度;
S4、接收摄像头检测的平粮机器人的位移偏移量,通过摄像头视野区域的长度,计算出偏差信号Dx;
S5、判断Dx是否大于0,若Dx大于0,则通过得到的δ调整角度顺时针转动,若Dx小于0,则通过得到的δ调整角度逆时针转动,若Dx等于0,则直接进入S6;
S6、通过计算全向轮转向速度模型得到平粮机器人的移动速度。
4.根据权利要求1所述的平粮机器人的同步计算方法,其特征在于,所述S3中全向轮转向速度模型为至少两轮的全向轮底盘,轮呈对称等距间隔设置于底盘底部且各轮的大小相同。
6.根据权利要求1所述的平粮机器人的同步计算方法,其特征在于,所述偏差信号Dx的计算方法为:
Dx=S-a
其中,S为检测区域长度的一半,a为平粮机器人的位移偏移量。
7.根据权利要求1所述的平粮机器人的同步计算方法,其特征在于,所述S3中全向轮转向速度模型为三轮的全向轮底盘的转向速度模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910100973.5A CN109631851B (zh) | 2019-01-31 | 2019-01-31 | 一种平粮机器人的同步计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910100973.5A CN109631851B (zh) | 2019-01-31 | 2019-01-31 | 一种平粮机器人的同步计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109631851A CN109631851A (zh) | 2019-04-16 |
CN109631851B true CN109631851B (zh) | 2021-06-11 |
Family
ID=66064551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910100973.5A Active CN109631851B (zh) | 2019-01-31 | 2019-01-31 | 一种平粮机器人的同步计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109631851B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109799825A (zh) * | 2019-01-31 | 2019-05-24 | 电子科大科园股份有限公司 | 一种平粮机器人的同步走道方法 |
CN110032191A (zh) * | 2019-04-28 | 2019-07-19 | 中北大学 | 一种仿人型机器人快速行走循迹避障实现方法 |
CN110660097A (zh) * | 2019-09-12 | 2020-01-07 | 四川阿泰因机器人智能装备有限公司 | 一种平粮机器人定位和动作控制方法 |
CN111240330B (zh) * | 2020-01-17 | 2021-03-23 | 电子科技大学 | 一种平粮机器人同步导航和精确定位方法及系统 |
CN111915812B (zh) * | 2020-08-06 | 2022-02-01 | 广州狸园科技有限公司 | 一种基于5g大数据的图书馆图书展示位置识别系统 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202841952U (zh) * | 2012-05-29 | 2013-04-03 | 湖北叶威粮油机械有限公司 | 一种履带式的平粮机器人 |
CN104227250B (zh) * | 2014-09-16 | 2016-06-22 | 佛山市利迅达机器人系统有限公司 | 基于平面的机器人三维寻位纠偏方法及焊接机器人 |
CN104181926B (zh) * | 2014-09-17 | 2017-06-13 | 上海畔慧信息技术有限公司 | 机器人的导航控制方法 |
CN105486309B (zh) * | 2015-12-02 | 2018-08-17 | 广州市吉特科技有限公司 | 一种基于颜色模式与辅助识别的室内机器人导航与定位方法 |
CN108781787B (zh) * | 2018-08-03 | 2021-08-13 | 武汉轻工大学 | 一种用于粮仓平整的移动式平粮机器人 |
CN108886976B (zh) * | 2018-08-03 | 2021-03-09 | 武汉轻工大学 | 平粮机器人及平粮机器人系统 |
-
2019
- 2019-01-31 CN CN201910100973.5A patent/CN109631851B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109631851A (zh) | 2019-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109631851B (zh) | 一种平粮机器人的同步计算方法 | |
CN108571971B (zh) | 一种agv视觉定位系统及方法 | |
CN109955222B (zh) | 物品搬运装置、机器人系统和物品搬运方法 | |
US11113843B2 (en) | Method for calibrating the orientation of a camera mounted to a vehicle | |
CN109799825A (zh) | 一种平粮机器人的同步走道方法 | |
RU2223463C2 (ru) | Устройство для определения геометрических параметров установки колес и положения осей и мостов автотранспортных средств | |
CN111735445B (zh) | 融合单目视觉与imu的煤矿巷道巡检机器人系统及导航方法 | |
Krajník et al. | Navigation without localisation: reliable teach and repeat based on the convergence theorem | |
CN107031523A (zh) | 利用已知目标进行基于摄像头的车辆位置确定 | |
CN104199452B (zh) | 移动机器人、移动机器人系统、移动及通信方法 | |
CN106462968A (zh) | 用于校准机动车的摄影机系统的方法和装置 | |
CN110366474A (zh) | 自动研磨系统 | |
JP2004255486A (ja) | 自動作業装置及び自動作業装置制御プログラム | |
CN110816355B (zh) | 车辆充电方法、设备及计算机可读存储介质 | |
CN109795900B (zh) | 一种精平机器人的平粮方法 | |
CN104132818B (zh) | 三维四轮定位仪及其测量方法 | |
CN110555878A (zh) | 物体空间位置形态的确定方法、装置、存储介质及机器人 | |
WO2020119781A1 (zh) | 一种车辆直行导航方法以及车辆直行导航装置 | |
CN111754577B (zh) | 目标识别系统及基于其的拖拉机倒车与农具连接方法 | |
CN107055331A (zh) | 集装箱对箱引导系统 | |
CN114873465B (zh) | 基于机器视觉高精度井下单轨吊车定位方法、系统 | |
CN113860172A (zh) | 一种纠偏方法、装置、交通工具及存储介质 | |
JP6423670B2 (ja) | 車両制御装置 | |
CN106774339A (zh) | 基于图像处理的轮胎吊自动过街系统及方法 | |
US20200265588A1 (en) | Road surface area detection device |
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 |