CN112558607A - 单舵轮agv车自动校准的方法、装置及设备 - Google Patents
单舵轮agv车自动校准的方法、装置及设备 Download PDFInfo
- Publication number
- CN112558607A CN112558607A CN202011431873.XA CN202011431873A CN112558607A CN 112558607 A CN112558607 A CN 112558607A CN 202011431873 A CN202011431873 A CN 202011431873A CN 112558607 A CN112558607 A CN 112558607A
- Authority
- CN
- China
- Prior art keywords
- agv
- angle
- motion
- delt
- wheel
- 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
- 238000000034 method Methods 0.000 title claims abstract description 60
- 238000004590 computer program Methods 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000010586 diagram Methods 0.000 description 12
- 230000006870 function Effects 0.000 description 10
- 230000008569 process Effects 0.000 description 8
- 238000012545 processing Methods 0.000 description 6
- 238000004891 communication Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000010897 surface acoustic wave method Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- 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/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- 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/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/60—Electric or hybrid propulsion means for production processes
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种单舵轮AGV车自动校准的方法、装置及设备,方法包括以下步骤:建立单舵轮AGV车的运动模型;按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;获取激光器运行路线数据;计算激光器与AGV车体运动中心的偏差;根据计算的偏差值对单舵轮AGV车进行校准。本发明不仅操作简单,而且在不需要额外的设备基础上大大提高了单舵轮AGV车的校准精准度。
Description
技术领域
本发明涉及一种单舵轮AGV车自动校准的方法、装置及设备,属于AGV校准技术领域。
背景技术
AGV控制需要根据AGV的运动中心的位置进行控制,这就需要定位部分将激光器的定位点转移到车体中心的定位点。这个转移的过程就需要激光器相对车体中心的位置偏差。要想车流畅运动,就要求计算的这个偏差比较精准。
目前计算单舵轮底盘车运动中心位置的方法一般是直接用图纸参数。因为单舵轮底盘车一般工作区域较大,对运行的精准度要求较低,所以这种方法虽然会有误差,但对实际使用的影响很小,因此一直使用旧方法。当多辆车同时工作时,就需要对车与车之间的误差进行单独较准,此时一般使用已一辆车为基准,将这辆车开到一个固定位置,记录坐标,然后载将其余车开到相同位置查看坐标和第一辆车坐标的偏差,通过修改激光器偏差将所有车在统一位置的定位相同,消除不同车间的误差。
但是,当随着现在工作环境变复杂对运动的精准度变高之后,这种方法变不适合了,就需要找一种能精准计算激光器和车体运动中心偏差的方法。并且将多车一致性的较准来拿出来,不通过修改单车的激光器偏差实现。
发明内容
为了解决上述问题,本发明提出了一种单舵轮AGV车自动校准的方法、装置及设备,不仅操作简单,而且在不需要额外的设备基础上大大提高了单舵轮AGV车的校准精准度。
本发明解决其技术问题采取的技术方案是:
第一方面,本发明实施例提供的一种单舵轮AGV车自动校准的方法,包括以下步骤:
建立单舵轮AGV车的运动模型;
按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
获取激光器运行路线数据;
计算激光器与AGV车体运动中心的偏差;
根据计算的偏差值对单舵轮AGV车进行校准。
作为本实施例一种可能的实现方式,所述建立单舵轮AGV车的运动模型,具体为:
将单舵轮AGV车视为由一个舵轮和两个固定从动轮的运动模型,AGV车的运动可视为围绕一个圆心的圆周运动,该圆心是两个固定从动轮轮所在直线与舵轮方向垂线的交点。
作为本实施例一种可能的实现方式,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
作为本实施例一种可能的实现方式,所述设定的路线为8字形路线。
作为本实施例一种可能的实现方式,所述激光器运行路线数据为(x,y,a),其中,(x,y)为激光器的定位坐标,a为激光器的运动角度。
作为本实施例一种可能的实现方式,所述计算激光器与AGV车体运动中心的偏差,具体为:通过最小二乘法计算激光器与AGV车体运动中心的最小误差偏移量。
第二方面,本发明实施例提供的一种单舵轮AGV车自动校准的装置,包括:
模型建立模块,用于建立单舵轮AGV车的运动模型;
车体控制模块,用于按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
数据获取模块,用于获取激光器运行路线数据;
偏差计算模块,用于计算激光器与AGV车体运动中心的偏差;
校准模块,用于根据计算的偏差值对单舵轮AGV车进行校准。
作为本实施例一种可能的实现方式,所述模型建立模块建立单舵轮AGV车的运动模型具体过程为:
将单舵轮AGV车视为由一个舵轮和两个固定从动轮的运动模型,AGV车的运动可视为围绕一个圆心的圆周运动,该圆心是两个固定从动轮轮所在直线与舵轮方向垂线的交点。
作为本实施例一种可能的实现方式,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
作为本实施例一种可能的实现方式,所述设定的路线为8字形路线。
作为本实施例一种可能的实现方式,所述激光器运行路线数据为(x,y,a),其中,(x,y)为激光器的定位坐标,a为激光器的运动角度。
作为本实施例一种可能的实现方式,所述偏差计算模块通过最小二乘法计算激光器与AGV车体运动中心的偏差。
进行单舵轮AGV车校准过程中需要AGV车保证两点:1.车在舵轮0度时为直线运动;2.车原地旋转运动中新位置不变。让车直线前进一段距离,记录这条直线的起止点,计算直线的角度;直线角度和车角度的误差越小,角度偏差越精确。在角度偏差正确的情况下,让车进行原地旋转,计算原地旋转360度的最大位置变化;位置变化越小,x、y的校准值越精确。
第三方面,本发明实施例提供的一种计算机设备,包括处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当所述装置运行时,所述处理器与所述存储器之间通过总线通信,所述处理器执行所述机器可读指令,以执行时执行如上述任意单舵轮AGV车自动校准的方法的步骤。
第四方面,本发明实施例提供的一种存储介质,该存储介质上存储有计算机程序,该计算机程序被处理器运行时执行如上述任意单舵轮AGV车自动校准的方法的步骤。
本发明实施例的技术方案可以具有的有益效果如下:
利用本发明进行单舵轮AGV车自动校准,不仅操作简单,而且在不需要额外的设备基础上大大提高了单舵轮AGV车的校准精准度。
附图说明:
图1是根据一示例性实施例示出的一种单舵轮AGV车自动校准的方法的流程图;
图2是根据一示例性实施例示出的一种单舵轮AGV车的运动模型示意图;
图3是根据一示例性实施例示出的一种单舵轮AGV车自动校准的装置的结构图;
图4是根据一示例性实施例示出的一种计算机设备的结构图。
具体实施方式
下面结合附图与实施例对本发明做进一步说明:
为能清楚说明本方案的技术特点,下面通过具体实施方式,并结合其附图,对本发明进行详细阐述。下文的公开提供了许多不同的实施例或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。此外,本发明可以在不同例子中重复参考数字和/或字母。这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施例和/或设置之间的关系。应当注意,在附图中所图示的部件不一定按比例绘制。本发明省略了对公知组件和处理技术及工艺的描述以避免不必要地限制本发明。
图1是根据一示例性实施例示出的单舵轮AGV车自动校准的方法的流程图。如图1所示,本发明实施例提供的一种单舵轮AGV车自动校准的方法,包括以下步骤:
建立单舵轮AGV车的运动模型;
按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
获取激光器运行路线数据;
计算激光器与AGV车体运动中心的偏差;
根据计算的偏差值对单舵轮AGV车进行校准。
作为本实施例一种可能的实现方式,所述建立单舵轮AGV车的运动模型,具体为:
将单舵轮AGV车视为由一个舵轮和两个固定从动轮的运动模型,AGV车的运动可视为围绕一个圆心的圆周运动,该圆心是两个固定从动轮轮所在直线与舵轮方向垂线的交点。根据此运动模型,可以通过主动轮的运动距离和实时的偏转角度,计算AGV的运行路线。
作为本实施例一种可能的实现方式,假设在两帧激光数据的周期内,车是按照图一的运动圆心做圆周运动,舵轮偏移角度是后一帧数据的舵轮角度,就可以根据舵轮的运动距离,计算两帧的数据间车的位置和角度变化。如图2所示,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
上述运动模型列出的是AGV车前进时的计算过程。如果是AGV车后退,dth_angle需要乘以-1;如果now_angle的值特别小,可认为车时直线运行,此时可认为origin_s=run_length;如果车时原地旋转,那么r=WheelBase。
作为本实施例一种可能的实现方式,所述设定的路线为8字形路线。如果环境允许,走个8字形可以得到一个比较好的校结果。此过程虽然是人为控制的,但对控制的精准度要求不高,只需要随便走一个8字形路线或者走几段曲线即可。只要符合这一点要求,不走一条直线,最终的定位结果受人为控制的影响就比较小。
作为本实施例一种可能的实现方式,所述激光器运行路线数据为(x,y,a),其中,(x,y)为激光器的定位坐标,a为激光器的运动角度。激光器运行路线数据需要提前建立反光柱地图(自然导航地图精准度较低,因此使用反光柱地图),使用激光器在这个地图中进行定位。通过对定位结果的汇总即可获取激光器的运行路线。在进行较准时,可直接使用反光柱定位的结果(x,y,a),一个二维坐标系下的坐标。因此相邻两个坐标的差即为运行距离。
作为本实施例一种可能的实现方式,所述计算激光器与AGV车体运动中心的偏差,具体为:通过最小二乘法计算激光器与AGV车体运动中心的最小误差偏移量。
因为激光器和AGV车体运动中心有一个固定的偏差,因此AGV的运行路线和激光器的运行路线是不一样的。但这两个运行路线是可以通过加减一个偏差来进行转换的。因此可以在每个时间点上根据这个时间点的激光器路线变化和AGV路线变化,获取一个这个时间点的偏移量。
有了大量的偏移量计算数据后,可通过最小二乘法计算一个整体误差最小的偏移量的值。
偏差值计算使用ceres中的最小二乘法函数来进行计算。以编码器的计算函数为cost_function,获取最终的计算结果。
problem.AddResidualBlock(cost_function,new ceres::CauchyLoss(0.5),estimated_paramter_.data(),T_OC.data());
其中cost_function为编码器的计算函数,estimated_paramter_为编码器计算的输入值(轴距等参数),T_OC为偏差值(偏差值需要有一个默认值。只需要尽量接近实际值即可,这样可减少计算结果的而偏差),使用图纸值即可。
如图3所示,本发明实施例提供的一种单舵轮AGV车自动校准的装置,包括:
模型建立模块,用于建立单舵轮AGV车的运动模型;
车体控制模块,用于按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
数据获取模块,用于获取激光器运行路线数据;
偏差计算模块,用于计算激光器与AGV车体运动中心的偏差;
校准模块,用于根据计算的偏差值对单舵轮AGV车进行校准。
作为本实施例一种可能的实现方式,所述模型建立模块建立单舵轮AGV车的运动模型具体过程为:
将单舵轮AGV车视为由一个舵轮和两个固定从动轮的运动模型,AGV车的运动可视为围绕一个圆心的圆周运动,该圆心是两个固定从动轮轮所在直线与舵轮方向垂线的交点。
作为本实施例一种可能的实现方式,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
作为本实施例一种可能的实现方式,所述设定的路线为8字形路线。
作为本实施例一种可能的实现方式,所述激光器运行路线数据为(x,y,a),其中,(x,y)为激光器的定位坐标,a为激光器的运动角度。
作为本实施例一种可能的实现方式,所述偏差计算模块通过最小二乘法计算激光器与AGV车体运动中心的偏差。
图4是根据一示例性实施例示出的一种计算机设备的结构图。如图4所示,本发明实施例提供的一种计算机设备,包括处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当所述装置运行时,所述处理器与所述存储器之间通过总线通信,所述处理器执行所述机器可读指令,以执行时执行如上述任意单舵轮AGV车自动校准的方法的步骤。
具体地,上述存储器和处理器能够为通用的存储器和处理器,这里不做具体限定,当处理器运行存储器存储的计算机程序时,能够执行上述单舵轮AGV车自动校准的方法。
本领域技术人员可以理解,图4中示出的计算机设备的结构并不构成对计算机设备的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者拆分某些部件,或者不同的部件布置。
在一些实施例中,该计算机设备还可以包括触摸屏可用于显示图形用户界面(例如,应用程序的启动界面)和接收用户针对图形用户界面的操作(例如,针对应用程序的启动操作)。具体的触摸屏可包括显示面板和触控面板。其中显示面板可以采用LCD(LiquidCrystal Display,液晶显示器)、OLED(Organic Light-Emitting Diode,有机发光二极管)等形式来配置。触控面板可收集用户在其上或附近的接触或者非接触操作,并生成预先设定的操作指令,例如,用户使用手指、触笔等任何适合的物体或附件在触控面板上或在触控面板附近的操作。另外,触控面板可包括触摸检测装置和触摸控制器两个部分。其中,触摸检测装置检测用户的触摸方位、姿势,并检测触摸操作带来的信号,将信号传送给触摸控制器;触摸控制器从触摸检测装置上接收触摸信息,并将它转换成处理器能够处理的信息,再送给处理器,并能接收处理器发来的命令并加以执行。此外,可以采用电阻式、电容式、红外线以及表面声波等多种类型实现触控面板,也可以采用未来发展的任何技术实现触控面板。进一步的,触控面板可覆盖显示面板,用户可以根据显示面板显示的图形用户界面,在显示面板上覆盖的触控面板上或者附近进行操作,触控面板检测到在其上或附近的操作后,传送给处理器以确定用户输入,随后处理器响应于用户输入在显示面板上提供相应的视觉输出。另外,触控面板与显示面板可以作为两个独立的部件来实现也可以集成而来实现。
对应于上述应用程序的启动方法,本发明实施例还提供了一种存储介质,该存储介质上存储有计算机程序,该计算机程序被处理器运行时执行如上述任意单舵轮AGV车自动校准的方法的步骤。
本申请实施例所提供的应用程序的启动装置可以为设备上的特定硬件或者安装于设备上的软件或固件等。本申请实施例所提供的装置,其实现原理及产生的技术效果和前述方法实施例相同,为简要描述,装置实施例部分未提及之处,可参考前述方法实施例中相应内容。所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,前述描述的系统、装置和单元的具体工作过程,均可以参考上述方法实施例中的对应过程,在此不再赘述。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
在本申请所提供的实施例中,应该理解到,所揭露装置和方法,可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,模块的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,又例如,多个模块或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口,装置或模块的间接耦合或通信连接,可以是电性,机械或其它的形式。
作为分离部件说明的模块可以是或者也可以不是物理上分开的,作为模块显示的部件可以是或者也可以不是物理模块,即可以位于一个地方,或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
另外,在本申请提供的实施例中的各功能模块可以集成在一个处理模块中,也可以是各个模块单独物理存在,也可以两个或两个以上模块集成在一个模块中。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制,尽管参照上述实施例对本发明进行了详细的说明,所属领域的普通技术人员应当理解:依然可以对本发明的具体实施方式进行修改或者等同替换,而未脱离本发明精神和范围的任何修改或者等同替换,其均应涵盖在本发明的权利要求保护范围之内。
Claims (10)
1.一种单舵轮AGV车自动校准的方法,其特征是,包括以下步骤:
建立单舵轮AGV车的运动模型;
按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
获取激光器运行路线数据;
计算激光器与AGV车体运动中心的偏差;
根据计算的偏差值对单舵轮AGV车进行校准。
2.根据权利要求1所述的单舵轮AGV车自动校准的方法,其特征是,所述建立单舵轮AGV车的运动模型,具体为:
将单舵轮AGV车视为由一个舵轮和两个固定从动轮的运动模型,AGV车的运动可视为围绕一个圆心的圆周运动,该圆心是两个固定从动轮轮所在直线与舵轮方向垂线的交点。
3.根据权利要求1或2所述的单舵轮AGV车自动校准的方法,其特征是,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
4.根据权利要求1所述的单舵轮AGV车自动校准的方法,其特征是,所述设定的路线为8字形路线。
5.根据权利要求1所述的单舵轮AGV车自动校准的方法,其特征是,所述激光器运行路线数据为(x,y,a),其中,(x,y)为激光器的定位坐标,a为激光器的运动角度。
6.根据权利要求1-5任意一项所述的单舵轮AGV车自动校准的方法,其特征是,所述计算激光器与AGV车体运动中心的偏差,具体为:通过最小二乘法计算激光器与AGV车体运动中心的最小误差偏移量。
7.一种单舵轮AGV车自动校准的装置,其特征是,包括:
模型建立模块,用于建立单舵轮AGV车的运动模型;
车体控制模块,用于按照运动模型控制AGV车走设定的路线,并获取其运动路线数据;
数据获取模块,用于获取激光器运行路线数据;
偏差计算模块,用于计算激光器与AGV车体运动中心的偏差;
校准模块,用于根据计算的偏差值对单舵轮AGV车进行校准。
8.根据权利要求7所述的单舵轮AGV车自动校准的装置,其特征是,所述运动模型为:
Delt_x=cos(dth_angle/2)*origin_s
Delt_y=sin(dth_angle/2)*origin_s
Delt_a=dth_angle
式中,(Delt_x,Delt_y)为AGV车体运动中心的坐标,Delt_a为AGV车体运动中心的运动角度;dth_angle为AGV车体的运动角度变化,dth_angle=run_length*sin(now_angle)/WheelBase,run_length为AGV车的行进距离,now_angle为AGV车舵轮角度,WheelBase为AGV车的轴距;origin_s为AGV车体在开始运动的点和运动结束的点间的距离,origin_s=abs(2*r*sin(delt_angle/2)),r为AGV车运动圆心的半径,r=WheelBase/tan(now_angle);delt_angle为AGV车体的运动角度。
9.一种计算机设备,其特征是,包括处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当所述装置运行时,所述处理器与所述存储器之间通过总线通信,所述处理器执行所述机器可读指令,以执行时执行如权利要求1-6任一所述的单舵轮AGV车自动校准的方法的步骤。
10.一种存储介质,其特征是,该存储介质上存储有计算机程序,该计算机程序被处理器运行时执行如权利要求1-6任一所述的单舵轮AGV车自动校准的方法的步骤。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011431873.XA CN112558607A (zh) | 2020-12-07 | 2020-12-07 | 单舵轮agv车自动校准的方法、装置及设备 |
CN202110742464.XA CN113282092B (zh) | 2020-12-07 | 2021-06-30 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
PCT/CN2021/121156 WO2022121459A1 (zh) | 2020-12-07 | 2021-09-28 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011431873.XA CN112558607A (zh) | 2020-12-07 | 2020-12-07 | 单舵轮agv车自动校准的方法、装置及设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112558607A true CN112558607A (zh) | 2021-03-26 |
Family
ID=75059969
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011431873.XA Pending CN112558607A (zh) | 2020-12-07 | 2020-12-07 | 单舵轮agv车自动校准的方法、装置及设备 |
CN202110742464.XA Active CN113282092B (zh) | 2020-12-07 | 2021-06-30 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110742464.XA Active CN113282092B (zh) | 2020-12-07 | 2021-06-30 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Country Status (2)
Country | Link |
---|---|
CN (2) | CN112558607A (zh) |
WO (1) | WO2022121459A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113282081A (zh) * | 2021-04-28 | 2021-08-20 | 共享智能铸造产业创新中心有限公司 | 单舵轮agv的运动控制方法和控制装置 |
CN113282092A (zh) * | 2020-12-07 | 2021-08-20 | 兰剑智能科技股份有限公司 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115321434B (zh) * | 2022-08-05 | 2023-12-26 | 浙江华睿科技股份有限公司 | 一种叉车的转向控制方法及装置 |
CN115562262A (zh) * | 2022-09-28 | 2023-01-03 | 徐州徐工特种工程机械有限公司 | 一种agv的自动导航控制方法及装置 |
CN116061194B (zh) * | 2023-03-21 | 2023-07-04 | 上海仙工智能科技有限公司 | 移动机器人舵轮安装位置的标定方法及系统、存储介质 |
CN116642903A (zh) * | 2023-04-17 | 2023-08-25 | 国能锅炉压力容器检验有限公司 | 一种基于激光扫描现场获取连续金相组织的设备及方法 |
CN116674920B (zh) * | 2023-04-25 | 2024-01-23 | 中国铁建电气化局集团有限公司 | 一种智能化运输方法、装置、设备和存储介质 |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7228230B2 (en) * | 2004-11-12 | 2007-06-05 | Mitsubishi Denki Kabushiki Kaisha | System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation |
JP5208262B1 (ja) * | 2011-12-19 | 2013-06-12 | 株式会社レクサー・リサーチ | 経路計画立案システム |
CN105678783B (zh) * | 2016-01-25 | 2018-10-19 | 西安科技大学 | 折反射全景相机与激光雷达数据融合标定方法 |
CN107102641B (zh) * | 2017-05-18 | 2020-08-07 | 湖北工业大学 | 一种基于激光引导双轮差速agv的原地偏航旋转方法 |
GB201712097D0 (en) * | 2017-07-27 | 2017-09-13 | Robocoaster Ltd | Automated guided vehicle guidance system |
CN108345005B (zh) * | 2018-02-22 | 2020-02-07 | 重庆大学 | 巷道掘进机的实时连续自主定位定向系统及导航定位方法 |
CN109137829A (zh) * | 2018-08-29 | 2019-01-04 | 青岛港国际股份有限公司 | 自动化码头agv防撞保护方法和系统 |
CN111267113B (zh) * | 2018-12-05 | 2023-04-07 | 广州中国科学院先进技术研究所 | 一种获取打磨轨迹数据的方法和多机器人协同打磨系统 |
CN109676280B (zh) * | 2019-02-02 | 2021-03-19 | 宁波吉利汽车研究开发有限公司 | 车身制造通用化系统和车身制造通用化智能工厂系统 |
CN109916431B (zh) * | 2019-04-12 | 2021-01-29 | 成都天富若博特科技有限责任公司 | 一种针对四轮移动机器人的车轮编码器标定算法 |
CN110262517B (zh) * | 2019-07-18 | 2022-05-10 | 石家庄辰宙智能装备有限公司 | Agv系统的轨迹跟踪控制方法 |
CN110427033A (zh) * | 2019-08-12 | 2019-11-08 | 苏州寻迹智行机器人技术有限公司 | 一种基于二维码的激光导航agv高精度定位方法 |
CN110723484B (zh) * | 2019-09-26 | 2020-12-15 | 兰剑智能科技股份有限公司 | 穿梭车行走自动纠偏方法、装置、计算机设备及存储介质 |
CN111308884B (zh) * | 2019-10-18 | 2023-10-03 | 南京晨光集团有限责任公司 | 一种全向移动agv多舵轮协同控制方法 |
CN112925301B (zh) * | 2019-12-05 | 2024-05-17 | 杭州海康机器人股份有限公司 | 用于agv避险的控制方法和agv |
CN111624618A (zh) * | 2020-06-09 | 2020-09-04 | 安徽意欧斯物流机器人有限公司 | 融合激光slam和二维码导航的定位方法及搬运平台 |
CN112525125B (zh) * | 2020-12-07 | 2022-09-27 | 兰剑智能科技股份有限公司 | Agv车一致性校准的方法、装置及设备 |
CN112558607A (zh) * | 2020-12-07 | 2021-03-26 | 兰剑智能科技股份有限公司 | 单舵轮agv车自动校准的方法、装置及设备 |
CN112556576B (zh) * | 2020-12-07 | 2022-06-21 | 兰剑智能科技股份有限公司 | 双激光扫描仪校准方法、装置及设备 |
-
2020
- 2020-12-07 CN CN202011431873.XA patent/CN112558607A/zh active Pending
-
2021
- 2021-06-30 CN CN202110742464.XA patent/CN113282092B/zh active Active
- 2021-09-28 WO PCT/CN2021/121156 patent/WO2022121459A1/zh active Application Filing
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113282092A (zh) * | 2020-12-07 | 2021-08-20 | 兰剑智能科技股份有限公司 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
WO2022121459A1 (zh) * | 2020-12-07 | 2022-06-16 | 兰剑智能科技股份有限公司 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
CN113282081A (zh) * | 2021-04-28 | 2021-08-20 | 共享智能铸造产业创新中心有限公司 | 单舵轮agv的运动控制方法和控制装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113282092B (zh) | 2021-11-19 |
WO2022121459A1 (zh) | 2022-06-16 |
CN113282092A (zh) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112558607A (zh) | 单舵轮agv车自动校准的方法、装置及设备 | |
CN111231950B (zh) | 规划车辆变道路径的方法、装置、设备及可读存储介质 | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航系统 | |
CN106382934A (zh) | 一种高精度移动机器人定位系统和方法 | |
CN113602350B (zh) | 车辆前轮偏差角动态标定方法、装置、设备及存储介质 | |
JP2009093308A (ja) | ロボットシステム | |
JPH01214711A (ja) | ナビゲーション装置 | |
CN105987696A (zh) | 一种低成本车辆自动驾驶设计实现方法 | |
CN109656240A (zh) | 一种车辆路径跟踪控制装置、方法和车辆 | |
CN107443380B (zh) | 直角坐标机器人的控制方法和控制装置 | |
CN205121338U (zh) | 基于图像识别与无线网络的agv导航系统 | |
CN111415511A (zh) | 车辆监测和控制基础设施 | |
CN116972788B (zh) | 用于农业机械的曲线行驶精度检测方法及装置、设备 | |
CN103472844A (zh) | 基于电子标签自校正的移动平台定位系统 | |
KR20220017481A (ko) | 2d 궤적 플래너용 도로 모델 매니폴드 | |
CN111399504A (zh) | 基于双轮驱动的agv仿真方法、装置及计算机设备 | |
CN112665506B (zh) | 定位装置的安装偏差检测方法、装置、设备及存储介质 | |
CN112556576B (zh) | 双激光扫描仪校准方法、装置及设备 | |
JP5439552B2 (ja) | ロボットシステム | |
CN110083158B (zh) | 一种确定局部规划路径的方法和设备 | |
CN110647153A (zh) | 基于舵轮偏距的无人搬运车仿真方法、装置及计算机设备 | |
CN115993089B (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
CN112525125B (zh) | Agv车一致性校准的方法、装置及设备 | |
JPH09325029A (ja) | 地磁気センサの補正装置 | |
CN215494708U (zh) | 一种智能地坪划线机器人 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210326 |