CN113282092A - 计算agv叉车激光扫描仪安装位置偏差的方法及装置 - Google Patents

计算agv叉车激光扫描仪安装位置偏差的方法及装置 Download PDF

Info

Publication number
CN113282092A
CN113282092A CN202110742464.XA CN202110742464A CN113282092A CN 113282092 A CN113282092 A CN 113282092A CN 202110742464 A CN202110742464 A CN 202110742464A CN 113282092 A CN113282092 A CN 113282092A
Authority
CN
China
Prior art keywords
agv
laser scanner
data
wheel
calculating
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.)
Granted
Application number
CN202110742464.XA
Other languages
English (en)
Other versions
CN113282092B (zh
Inventor
万慧铭
徐光运
张小艺
刘鹏
张贻弓
沈长鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Lanjian Intelligent Technology Co ltd
Original Assignee
Lanjian Intelligent Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Lanjian Intelligent Technology Co ltd filed Critical Lanjian Intelligent Technology Co ltd
Publication of CN113282092A publication Critical patent/CN113282092A/zh
Priority to PCT/CN2021/121156 priority Critical patent/WO2022121459A1/zh
Application granted granted Critical
Publication of CN113282092B publication Critical patent/CN113282092B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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运动模型中进行计算，获取激光扫描仪的理论移动轨迹；将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。本发明避免了零件加工及装配误差对于确定激光扫描仪和车体运动中心偏差数据的影响。

Description

计算AGV叉车激光扫描仪安装位置偏差的方法及装置
技术领域
本发明涉及一种计算AGV叉车激光扫描仪安装位置偏差的方法及装置，属于AGV叉车控制技术领域。
背景技术
AGV(Automated Guided Vehicle)，也就是大家常说的"自动导引运输车"，它不仅能够沿规定的导引路径行驶，它是一种具有安全保护以及各种移载功能的运输车。
AGV属于轮式移动机器人(WMR――Wheeled Mobile Robot)的范畴，以轮式移动为特征，较之步行、爬行或其它非轮式的移动机器人具有行动快捷、工作效率高、结构简单、可控性强、安全性好等优势。与物料输送中常用的其他设备相比，AGV的活动区域无需铺设轨道、支座架等固定装置，不受场地、道路和空间的限制。因此，在自动化物流系统中，最能充分地体现其自动性和柔性，实现高效、经济、灵活的无人化生产。
为了实现对AGV的控制，当AGV激光器扫描仪与车体运动中心不在同一位置时，需要将激光扫描仪的定位点转移到车体运动中心的定位点，转移的过程中需要精准计算激光扫描仪定位点与车体运动中心之间的位置偏差。但是，目前常规计算方法为利用图纸参数直接计算，由于存在零件加工及装配误差，直接计算会导致最终的定位不准确，进而使AGV的控制出现问题。
发明内容
为了解决上述问题，本发明提出了一种计算AGV叉车激光扫描仪安装位置偏差的方法及装置。
本发明解决其技术问题采取的技术方案是：
第一方面，本发明实施例提供的一种计算AGV叉车激光扫描仪安装位置偏差的方法，包括以下步骤：
控制AGV叉车按照一曲线路线在待测试区域行走；
实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
作为本实施例一种可能的实现方式，所述控制AGV叉车按照一曲线路线在待测试区域行走，包括：
确定测试区域，打开AGV叉车的定位程序，使AGV在测试区域能够进行稳定的激光扫描仪定位；
控制AGV叉车在所述测试区域中按照一曲线路线行走。
作为本实施例一种可能的实现方式，所述将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量，包括：
将理论移动轨迹与实际实移动轨迹绘制在平面坐标系中；
计算当两个轨迹重合时激光扫描仪与车体运动中心的偏移量。
作为本实施例一种可能的实现方式，所述AGV运动模型包括：单舵轮式AGV 车的运动模型和差速驱动式AGV车的运动模型。
作为本实施例一种可能的实现方式，当AGV叉车为单舵轮式AGV车时，所述编码器数据为舵轮编码器数据，当AGV叉车为差速驱动式AGV车时，所述编码器数据为差速驱动式AGV车的两个主动轮的编码器数据。
作为本实施例一种可能的实现方式，所述AGV运动模型的参数包括：
通用校准参数：车轮轴距，激光扫描仪中心与车体运动中心的偏差；
差速车校准参数：车轮半径；
AGV车参数：AGV车在全局坐标系的位置，AGV车移动速度和转向速度；
差速车参数：车轮线速度，车轮速度与AGV车速度的转化矩阵；
单舵轮车参数：舵轮角度、运动半径、舵轮速度；
测量数据：AGV车在时间段k内的移动路径、激光扫描仪在时间段k内的移动路径，根据激光扫描仪数据预测的激光扫描仪移动路径，激光扫描仪的速度。
作为本实施例一种可能的实现方式，所述单舵轮式AGV车的运动模型为：
假设在两帧激光数据的周期内，车是按照图1的运动圆心做圆周运动，舵轮偏移角度是后一帧数据的舵轮角度；
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于单舵轮式AGV车，全局坐标q可以通过舵轮角度、舵轮速度和从动轮车轮间距算出：
Figure BDA0003141279420000031
其中，运动半径通过舵轮角度和车轮轴距计算得到，计算公式为：
Figure BDA0003141279420000032
其中，b为车轮轴距，θ为舵轮角度，r为运动半径。
作为本实施例一种可能的实现方式，所述差速驱动式AGV车的运动模型为：
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于差速驱动式AGV车，全局坐标q通过车轮线速度和车轮间距算出：
Figure BDA0003141279420000033
转化矩阵可以通过车轮速度的差值计算得到，计算公式为：
Figure BDA0003141279420000041
其中，b为车轮轴距，rR,rL为车轮半径，q为AGV车在全局坐标系的位置，wL,wR为车轮线速度，J为车轮速度与AGV车速度的转化矩阵；
通过上述公式可以根据编码器数据计算出在时间tk时AGV车的全局坐标qk。
作为本实施例一种可能的实现方式，所述计算激光扫描仪与车体运动中心的偏移量，包括：
AGV车在tk时的坐标为qk，在tk+1时的坐标为qk+1，当AGV车由qk到达qk+1时， AGV车运动中心的移动路径为rk，激光扫描仪的移动路径为sk；
AGV车在时间段[tk,tk+1]中的移动路径为rk，则根据AGV运动模型计算出 qk,qk+1，根据李代数的性质，得到如下公式：
Figure BDA0003141279420000042
根据激光扫描仪与AGV车的相对位置不变的原理，得到激光扫描仪的移动轨迹：
Figure BDA0003141279420000043
第二方面，本发明实施例提供的一种计算AGV叉车激光扫描仪安装位置偏差的装置，包括：
待测路径模块，用于控制AGV叉车按照一曲线路线在待测试区域行走；
数据记录模块，用于实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
移动轨迹计算模块，用于将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
偏移量计算模块，用于将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
第三方面，本发明实施例提供的一种计算机设备，包括处理器、存储器和总线，所述存储器存储有所述处理器可执行的机器可读指令，当所述计算机设备运行时，所述处理器与所述存储器之间通过总线通信，所述处理器执行所述机器可读指令，以执行时执行如上述任意计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
第四方面，本发明实施例提供的一种存储介质，该存储介质上存储有计算机程序，该计算机程序被处理器运行时执行如上述任意计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
本发明实施例的技术方案可以具有的有益效果如下：
本发明通过在测试区域运行AGV车，搜集激光扫描仪实时定位数据和车体运动中心的编码器数据，利将编码器数据代入运动模型，计算获得车体运动中心运行轨迹，再将激光扫描仪实时轨迹与编码器数据计算所得轨迹进行对比计算，可获得精准的偏差，避免了零件加工及装配误差对于确定激光扫描仪和车体运动中心偏差数据的影响。
附图说明：
图1是根据一示例性实施例示出的一种计算AGV叉车激光扫描仪安装位置偏差的方法的流程图；
图2是根据一示例性实施例示出的一种单舵轮式AGV车的运动模型示意图；
图3是根据一示例性实施例示出的一种差速驱动式AGV车的运动模型示意图；
图4是根据一示例性实施例示出的一种计算AGV叉车激光扫描仪安装位置偏差的装置的结构图；
图5是根据一示例性实施例示出的一种AGV车运动示意图；
图6是根据一示例性实施例示出的一种计算机设备的结构图。
具体实施方式
下面结合附图与实施例对本发明做进一步说明：
为能清楚说明本方案的技术特点，下面通过具体实施方式，并结合其附图，对本发明进行详细阐述。下文的公开提供了许多不同的实施例或例子用来实现本发明的不同结构。为了简化本发明的公开，下文中对特定例子的部件和设置进行描述。此外，本发明可以在不同例子中重复参考数字和/或字母。这种重复是为了简化和清楚的目的，其本身不指示所讨论各种实施例和/或设置之间的关系。应当注意，在附图中所图示的部件不一定按比例绘制。本发明省略了对公知组件和处理技术及工艺的描述以避免不必要地限制本发明。
图1是根据一示例性实施例示出的计算AGV叉车激光扫描仪安装位置偏差的方法的流程图。如图1所示，本发明实施例提供的一种计算AGV叉车激光扫描仪安装位置偏差的方法，包括以下步骤：
控制AGV叉车按照一曲线路线在待测试区域行走；
实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
作为本实施例一种可能的实现方式，所述控制AGV叉车按照一曲线路线在待测试区域行走，包括：
确定测试区域，打开AGV叉车的定位程序，使AGV在测试区域能够进行稳定的激光扫描仪定位；
控制AGV叉车在所述测试区域中按照一曲线路线行走。
作为本实施例一种可能的实现方式，所述将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量，包括：
将理论移动轨迹与实际实移动轨迹绘制在平面坐标系中；
计算当两个轨迹重合时激光扫描仪与车体运动中心的偏移量。
作为本实施例一种可能的实现方式，所述AGV运动模型包括：单舵轮式AGV 车的运动模型和差速驱动式AGV车的运动模型。
作为本实施例一种可能的实现方式，如图2和图3所示，当AGV叉车为单舵轮式AGV车时，所述编码器数据为舵轮编码器数据，当AGV叉车为差速驱动式AGV车时，所述编码器数据为差速驱动式AGV车的两个主动轮的编码器数据。
作为本实施例一种可能的实现方式，所述AGV运动模型的参数包括：
通用校准参数：车轮轴距，激光扫描仪中心与车体运动中心的偏差；
差速车校准参数：车轮半径；
AGV车参数：AGV车在全局坐标系的位置，AGV车移动速度和转向速度；
差速车参数：车轮线速度，车轮速度与AGV车速度的转化矩阵；
单舵轮车参数：舵轮角度、运动半径、舵轮速度；
测量数据：AGV车在时间段k内的移动路径、激光扫描仪在时间段k内的移动路径，根据激光扫描仪数据预测的激光扫描仪移动路径，激光扫描仪的速度。
作为本实施例一种可能的实现方式，所述单舵轮式AGV车的运动模型为：
假设在两帧激光数据的周期内，车是按照图1的运动圆心做圆周运动，舵轮偏移角度是后一帧数据的舵轮角度；
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于单舵轮式AGV车，全局坐标q可以通过舵轮角度、舵轮速度和从动轮车轮间距算出：
Figure BDA0003141279420000071
其中，运动半径通过舵轮角度和车轮轴距计算得到，计算公式为：
Figure BDA0003141279420000072
其中，b为车轮轴距，θ为舵轮角度，r为运动半径。
作为本实施例一种可能的实现方式，所述差速驱动式AGV车的运动模型为：
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于差速驱动式AGV车，全局坐标q通过车轮线速度和车轮间距算出：
Figure BDA0003141279420000081
转化矩阵可以通过车轮速度的差值计算得到，计算公式为：
Figure BDA0003141279420000082
其中，b为车轮轴距，rR,rL为车轮半径，q为AGV车在全局坐标系的位置，wL,wR为车轮线速度，J为车轮速度与AGV车速度的转化矩阵；
通过上述公式可以根据编码器数据计算出在时间tk时AGV车的全局坐标qk。
作为本实施例一种可能的实现方式，所述计算激光扫描仪与车体运动中心的偏移量，包括：
AGV车在tk时的坐标为qk，在tk+1时的坐标为qk+1，当AGV车由qk到达qk+1时， AGV车运动中心的移动路径为rk，激光扫描仪的移动路径为sk；
AGV车在时间段[tk,tk+1]中的移动路径为rk，则根据AGV运动模型计算出 qk,qk+1，根据李代数的性质，得到如下公式：
Figure BDA0003141279420000083
根据激光扫描仪与AGV车的相对位置不变的原理，得到激光扫描仪的移动轨迹：
Figure BDA0003141279420000084
其中，
Figure BDA0003141279420000085
为对特征欧式群se(2)的分组操作；
Figure BDA0003141279420000086
为是群的倒数，例如：
Figure BDA0003141279420000091
Figure BDA0003141279420000092
如图4所示，本发明实施例提供的一种计算AGV叉车激光扫描仪安装位置偏差的装置，包括：
待测路径模块，用于控制AGV叉车按照一曲线路线在待测试区域行走；
数据记录模块，用于实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
移动轨迹计算模块，用于将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
偏移量计算模块，用于将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
本实施例所述的装置进行计算AGV叉车2D激光扫描仪安装位置偏差的方法可适用于单舵轮式和差速驱动式AGV智能车，具体计算AGV车激光扫描仪安装位置与车体运动中心偏差的步骤如下：
步骤一：确定测试区域，打开AGV车的定位程序，使AGV在测试区域能够进行稳定的激光扫描仪定位；定位使采用定位程序还是激光扫描仪定位数据？
步骤二：开始记录实时的激光扫描仪定位数据和编码器数据；
步骤四：控制车在步骤一中的测试区域中运行一曲线路线，收集激光扫描仪定位数据和编码器数据；
步骤五：结束数据收集，开始进行数据计算。
步骤六：将收集到的编码器数据代入到建立好的AGV运动模型中计算，将其转换为激光扫描仪理论的移动轨迹。代入编码器数据，通过运动模型计算并得出激光扫描仪理论上的移动轨迹，将激光扫描仪定位获得上的现实移动轨迹与计算得出的理论上移动轨迹对比，获得偏差。
步骤七：此时在坐标系中有一个激光扫描仪定位数据形成的实际移动轨迹 (将激光扫描仪实时的定位数据标注在二维坐标系中，即可得到移动轨迹。)，一个编码器数据通过AGV运动模型计算转换得到的激光扫描仪移动轨迹，计算当两个轨迹重合时激光扫描仪与车体运动中心的偏移量。
上述提及的编码器数据在舵轮式AGV车中为舵轮编码器数据，在差速驱动式AGV车中为两个主动轮的编码器数据。
关于步骤六中所述的AGV运动模型：
通用校准参数：
b：车轮轴距
λ：激光扫描仪中心与车体运动中心的偏差
差速车校准参数：
rR,rL：车轮半径
AGV车参数：
q：AGV车在全局坐标系的位置
u,w：AGV车移动速度和转向速度
差速车参数：
wL,wR：车轮线速度
J:车轮速度与AGV车速度的转化矩阵
单舵轮车参数：
θ:舵轮角度
r:运动半径
w:舵轮速度
测量数据：
rk:AGV车在时间段k内的移动路径
sk：激光扫描仪在时间段k内的移动路径
Figure BDA0003141279420000111
根据激光扫描仪数据预测的激光扫描仪移动路径
v:激光扫描仪的速度
①单舵轮式AGV车的运动模型：
如图2所示，将AGV视为由一个舵轮和两个固定的从动轮的运动模型,车的运动可视为围绕一个圆心的圆周运动，这个圆心是量固定轮所在直线和舵轮方向垂线的交点。根据此运动模型，可以通过主动轮的运动距离和实时的偏转角度，计算AGV车体运动中心的移动轨迹。单舵轮AGV车的控制点一般位于两从动轮中心。
假设在两帧激光数据的周期内，车是按照图1的运动圆心做圆周运动，舵轮偏移角度是后一帧数据的舵轮角度，就可以根据舵轮的运动距离，计算两帧的数据间车的位置和角度变化。
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于单舵轮式AGV车，全局坐标q可以通过舵轮角度、舵轮速度和从动轮车轮间距算出：
Figure BDA0003141279420000112
其中，运动半径可以通过舵轮角度和车轮轴距计算得到，计算公式为：
Figure BDA0003141279420000113
注意，此处的计算需要区分车的运动模式。例如上方列出的是前进时的计算过程。如果是后退，θ需要乘以-1；如果θ的值特别小，可认为车时直线运行，如果车是原地旋转，那么r＝b。
AGV车在tk时的坐标为qk，在tk+1时的坐标为qk+1，λ：激光扫描仪中心与车体运动中心的偏差，当AGV车由qk到达qk+1时，AGV车运动中心的移动路径为rk，激光扫描仪的移动路径为sk。
如图5所示，AGV车在时间段[tk，tk+1]中的移动路径为rk，则根据运动模型计算出qk，qk+1，根据SE(2)李代数的性质，可以得到如下公式：
Figure BDA0003141279420000121
根据激光扫描仪与AGV车的相对位置不变的原理，我们可以得到：
Figure BDA0003141279420000122
Figure BDA0003141279420000123
Figure BDA0003141279420000124
is the group operation on SE(2)：
Figure BDA0003141279420000125
Figure BDA0003141279420000126
is the group inverse：
Figure BDA0003141279420000127
从而，我们通过公式1，2，3，4，将编码器数据转化计算得到了激光扫描仪的移动轨迹。
②差速驱动式AGV车的运动模型：
如图3所示，差速驱动是一个两轮驱动的系统，而且每个轮子都带有独立的执行机构，AGV车的运动矢量是两个驱动轮运动矢量的和。驱动轮一般位于底盘的两侧，且正对机器人前方，AGV车的控制点位于两轮中心位置，激光扫描仪安装在AGV车上。本发明设计以下参数：
设AGV车在全局坐标系的坐标q＝(qx，qy，qθ)，对于差速驱动式AGV车，全局坐标q可以通过车轮线速度和车轮间距算出：
Figure BDA0003141279420000128
其中，转化矩阵可以通过车轮速度的差值计算得到，计算公式为：
Figure BDA0003141279420000129
通过上述公式可以根据编码器数据计算出在时间tk时AGV车的全局坐标qk。
AGV车在tk时的坐标为qk，在tk+1时的坐标为qk+1，λ：激光扫描仪中心与车体运动中心的偏差，当AGV车由qk到达qk+1时，AGV车运动中心的移动路径为rk，激光扫描仪的移动路径为sk。
如图5所示，AGV车在时间段[tk,tk+1]中的移动路径为rk，则根据运动模型可以计算出qk,qk+1，根据SE(2)李代数的性质，可以得到如下公式：
Figure BDA0003141279420000131
根据激光扫描仪与AGV车的相对位置不变的原理，我们可以得到：
Figure BDA0003141279420000132
将编码器数据转化计算得到了激光扫描仪的移动轨迹。
(2)激光扫描仪的移动轨迹
AGV车在测试区域中运动，可实时得到激光扫描仪的实时定位数据，将这些定位数据标注在坐标系中即可获得激光扫描仪的移动轨迹。
(3)AGV移动路线
为获得激光扫描仪移动轨迹和编码器数据，AGV车在测试区域中按曲线轨迹移动即可；但为获得较好的偏差计算结果，可控制AGV车按8字形轨迹移动。
(4)偏差计算方法
①单舵轮式AGV车的偏差计算：
单舵轮式AGV车与差速驱动式AGV车的偏差计算方法基本相同，区别为单舵轮式AGV车的较准参数没有rR,rL，只有b车轮轴距。
②差速驱动式AGV车的偏差计算：
我们通过定位算法可以得到激光扫描仪的实时位置，即根据激光扫描仪数据可以得到激光扫描仪的移动轨迹
Figure BDA0003141279420000133
和sk之间的偏差就是待校准参数产生的误差，当误差最小，即
Figure BDA0003141279420000134
为0时，可得出激光扫描仪与车体运动中心之间的位置偏差λ，最终的误差方程为：
Figure BDA0003141279420000141
我们将整个AGV车运动过程分为n段，假设每一段AGV车都在进行匀速运动，计算每一段的偏差，并对所有误差求和得到最终误差。
使用ceres库优化误差方程，使得总误差最小，即得到预测参数的最优解。
图6是根据一示例性实施例示出的一种计算机设备的结构图。如图6所示，本发明实施例提供的一种计算机设备，包括处理器、存储器和总线，所述存储器存储有所述处理器可执行的机器可读指令，当所述计算机设备运行时，所述处理器与所述存储器之间通过总线通信，所述处理器执行所述机器可读指令，以执行时执行如上述任意计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
具体地，上述存储器和处理器能够为通用的存储器和处理器，这里不做具体限定，当处理器运行存储器存储的计算机程序时，能够执行上述计算AGV叉车激光扫描仪安装位置偏差的方法。
本领域技术人员可以理解，图6中示出的计算机设备的结构并不构成对计算机设备的限定，可以包括比图示更多或更少的部件，或者组合某些部件，或者拆分某些部件，或者不同的部件布置。
在一些实施例中，该计算机设备还可以包括触摸屏可用于显示图形用户界面(例如，应用程序的启动界面)和接收用户针对图形用户界面的操作(例如，针对应用程序的启动操作)。具体的触摸屏可包括显示面板和触控面板。其中显示面板可以采用LCD(LiquidCrystal Display，液晶显示器)、OLED(Organic Light-Emitting Diode,有机发光二极管)等形式来配置。触控面板可收集用户在其上或附近的接触或者非接触操作，并生成预先设定的操作指令，例如，用户使用手指、触笔等任何适合的物体或附件在触控面板上或在触控面板附近的操作。另外，触控面板可包括触摸检测装置和触摸控制器两个部分。其中，触摸检测装置检测用户的触摸方位、姿势，并检测触摸操作带来的信号，将信号传送给触摸控制器；触摸控制器从触摸检测装置上接收触摸信息，并将它转换成处理器能够处理的信息，再送给处理器，并能接收处理器发来的命令并加以执行。此外，可以采用电阻式、电容式、红外线以及表面声波等多种类型实现触控面板，也可以采用未来发展的任何技术实现触控面板。进一步的，触控面板可覆盖显示面板，用户可以根据显示面板显示的图形用户界面，在显示面板上覆盖的触控面板上或者附近进行操作，触控面板检测到在其上或附近的操作后，传送给处理器以确定用户输入，随后处理器响应于用户输入在显示面板上提供相应的视觉输出。另外，触控面板与显示面板可以作为两个独立的部件来实现也可以集成而来实现。
对应于上述应用程序的启动方法，本发明实施例还提供了一种存储介质，该存储介质上存储有计算机程序，该计算机程序被处理器运行时执行如上述任意计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
本申请实施例所提供的应用程序的启动装置可以为设备上的特定硬件或者安装于设备上的软件或固件等。本申请实施例所提供的装置，其实现原理及产生的技术效果和前述方法实施例相同，为简要描述，装置实施例部分未提及之处，可参考前述方法实施例中相应内容。所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，前述描述的系统、装置和单元的具体工作过程，均可以参考上述方法实施例中的对应过程，在此不再赘述。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、 CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
在本申请所提供的实施例中，应该理解到，所揭露装置和方法，可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，模块的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，又例如，多个模块或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口，装置或模块的间接耦合或通信连接，可以是电性，机械或其它的形式。
作为分离部件说明的模块可以是或者也可以不是物理上分开的，作为模块显示的部件可以是或者也可以不是物理模块，即可以位于一个地方，或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
另外，在本申请提供的实施例中的各功能模块可以集成在一个处理模块中，也可以是各个模块单独物理存在，也可以两个或两个以上模块集成在一个模块中。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/ 或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是：以上实施例仅用以说明本发明的技术方案而非对其限制，尽管参照上述实施例对本发明进行了详细的说明，所属领域的普通技术人员应当理解：依然可以对本发明的具体实施方式进行修改或者等同替换，而未脱离本发明精神和范围的任何修改或者等同替换，其均应涵盖在本发明的权利要求保护范围之内。

Claims (11)

1.一种计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，包括以下步骤：
控制AGV叉车按照一曲线路线在待测试区域行走；
实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
2.根据权利要求1所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述控制AGV叉车按照一曲线路线在待测试区域行走，包括：
确定测试区域，打开AGV叉车的定位程序；
控制AGV叉车在所述测试区域中按照一曲线路线行走。
3.根据权利要求1所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量，包括：
将理论移动轨迹与实际实移动轨迹绘制在平面坐标系中；
计算当两个轨迹重合时激光扫描仪与车体运动中心的偏移量。
4.根据权利要求1所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述AGV运动模型包括：单舵轮式AGV车的运动模型和差速驱动式AGV车的运动模型。
5.根据权利要求4所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，当AGV叉车为单舵轮式AGV车时，所述编码器数据为舵轮编码器数据，当AGV叉车为差速驱动式AGV车时，所述编码器数据为差速驱动式AGV车的两个主动轮的编码器数据。
6.根据权利要求4所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述AGV运动模型的参数包括：
通用校准参数：车轮轴距，激光扫描仪中心与车体运动中心的偏差；
差速车校准参数：车轮半径；
AGV车参数：AGV车在全局坐标系的位置，AGV车移动速度和转向速度；
差速车参数：车轮线速度，车轮速度与AGV车速度的转化矩阵；
单舵轮车参数：舵轮角度、运动半径、舵轮速度；
测量数据：AGV车在时间段k内的移动路径、激光扫描仪在时间段k内的移动路径，根据激光扫描仪数据预测的激光扫描仪移动路径，激光扫描仪的速度。
7.根据权利要求4所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述单舵轮式AGV车的运动模型为：
假设在两帧激光数据的周期内，车是按照图1的运动圆心做圆周运动，舵轮偏移角度是后一帧数据的舵轮角度；
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于单舵轮式AGV车，全局坐标q可以通过舵轮角度、舵轮速度和从动轮车轮间距算出：
Figure FDA0003141279410000021
其中，运动半径通过舵轮角度和车轮轴距计算得到，计算公式为：
Figure FDA0003141279410000022
其中，b为车轮轴距，θ为舵轮角度，r为运动半径。
8.根据权利要求4所述的计算AGV叉车激光扫描仪安装位置偏差的方法，其特征是，所述差速驱动式AGV车的运动模型为：
设AGV车在全局坐标系的坐标q＝(qx,qy,qθ)，对于差速驱动式AGV车，全局坐标q通过车轮线速度和车轮间距算出：
Figure FDA0003141279410000031
转化矩阵可以通过车轮速度的差值计算得到，计算公式为：
Figure FDA0003141279410000032
其中，b为车轮轴距，rR,rL为车轮半径，q为AGV车在全局坐标系的位置，wL,wR为车轮线速度，J为车轮速度与AGV车速度的转化矩阵；
通过上述公式可以根据编码器数据计算出在时间tk时AGV车的全局坐标qk。
9.一种计算AGV叉车激光扫描仪安装位置偏差的装置，其特征是，包括：
待测路径模块，用于控制AGV叉车按照一曲线路线在待测试区域行走；
数据记录模块，用于实时记录行走过程中AGV叉车的激光扫描仪定位数据和编码器数据；
移动轨迹计算模块，用于将所述编码器数据输入AGV运动模型中进行计算，获取激光扫描仪的理论移动轨迹；
偏移量计算模块，用于将所述理论移动轨迹与定位数据所记录的实际实移动轨迹进行对比，计算激光扫描仪与车体运动中心的偏移量。
10.一种计算机设备，其特征是，包括处理器、存储器和总线，所述存储器存储有所述处理器可执行的机器可读指令，当所述计算机设备运行时，所述处理器与所述存储器之间通过总线通信，所述处理器执行所述机器可读指令，以执行时执行如权利要求1-8任一所述的计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
11.一种存储介质，其特征是，该存储介质上存储有计算机程序，该计算机程序被处理器运行时执行如权利要求1-8任一所述的计算AGV叉车激光扫描仪安装位置偏差的方法的步骤。
CN202110742464.XA 2020-12-07 2021-06-30 计算agv叉车激光扫描仪安装位置偏差的方法及装置 Active CN113282092B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/121156 WO2022121459A1 (zh) 2020-12-07 2021-09-28 计算agv叉车激光扫描仪安装位置偏差的方法及装置

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202011431873X 2020-12-07
CN202011431873.XA CN112558607A (zh) 2020-12-07 2020-12-07 单舵轮agv车自动校准的方法、装置及设备

Publications (2)

Publication Number Publication Date
CN113282092A true CN113282092A (zh) 2021-08-20
CN113282092B CN113282092B (zh) 2021-11-19

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 Before (1)

Application Number Title Priority Date Filing Date
CN202011431873.XA Pending CN112558607A (zh) 2020-12-07 2020-12-07 单舵轮agv车自动校准的方法、装置及设备

Country Status (2)

Country Link
CN (2) CN112558607A (zh)
WO (1) WO2022121459A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022121459A1 (zh) * 2020-12-07 2022-06-16 兰剑智能科技股份有限公司 计算agv叉车激光扫描仪安装位置偏差的方法及装置

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113282081A (zh) * 2021-04-28 2021-08-20 共享智能铸造产业创新中心有限公司 单舵轮agv的运动控制方法和控制装置
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 中国铁建电气化局集团有限公司 一种智能化运输方法、装置、设备和存储介质

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7502688B2 (en) * 2004-11-12 2009-03-10 Mitsubishi Electric Corporation System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation
CN105678783A (zh) * 2016-01-25 2016-06-15 西安科技大学 折反射全景相机与激光雷达数据融合标定方法
CN108345005A (zh) * 2018-02-22 2018-07-31 重庆大学 巷道掘进机的实时连续自主定位定向系统及导航定位方法
CN109137829A (zh) * 2018-08-29 2019-01-04 青岛港国际股份有限公司 自动化码头agv防撞保护方法和系统
CN109676280A (zh) * 2019-02-02 2019-04-26 宁波吉利汽车研究开发有限公司 车身制造通用化系统和车身制造通用化智能工厂系统
CN110427033A (zh) * 2019-08-12 2019-11-08 苏州寻迹智行机器人技术有限公司 一种基于二维码的激光导航agv高精度定位方法
CN110723484A (zh) * 2019-09-26 2020-01-24 兰剑智能科技股份有限公司 穿梭车行走自动纠偏方法、装置、计算机设备及存储介质
CN111267113A (zh) * 2018-12-05 2020-06-12 广州中国科学院先进技术研究所 一种获取打磨轨迹数据的方法和多机器人协同打磨系统
CN112525125A (zh) * 2020-12-07 2021-03-19 兰剑智能科技股份有限公司 Agv车一致性校准的方法、装置及设备
CN112558607A (zh) * 2020-12-07 2021-03-26 兰剑智能科技股份有限公司 单舵轮agv车自动校准的方法、装置及设备
CN112556576A (zh) * 2020-12-07 2021-03-26 兰剑智能科技股份有限公司 双激光扫描仪校准方法、装置及设备
CN112925301A (zh) * 2019-12-05 2021-06-08 杭州海康机器人技术有限公司 用于agv避险的控制方法和agv

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5208262B1 (ja) * 2011-12-19 2013-06-12 株式会社レクサー・リサーチ 経路計画立案システム
CN107102641B (zh) * 2017-05-18 2020-08-07 湖北工业大学 一种基于激光引导双轮差速agv的原地偏航旋转方法
GB201712097D0 (en) * 2017-07-27 2017-09-13 Robocoaster Ltd Automated guided vehicle guidance system
CN109916431B (zh) * 2019-04-12 2021-01-29 成都天富若博特科技有限责任公司 一种针对四轮移动机器人的车轮编码器标定算法
CN110262517B (zh) * 2019-07-18 2022-05-10 石家庄辰宙智能装备有限公司 Agv系统的轨迹跟踪控制方法
CN111308884B (zh) * 2019-10-18 2023-10-03 南京晨光集团有限责任公司 一种全向移动agv多舵轮协同控制方法
CN111624618A (zh) * 2020-06-09 2020-09-04 安徽意欧斯物流机器人有限公司 融合激光slam和二维码导航的定位方法及搬运平台

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7502688B2 (en) * 2004-11-12 2009-03-10 Mitsubishi Electric Corporation System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation
CN105678783A (zh) * 2016-01-25 2016-06-15 西安科技大学 折反射全景相机与激光雷达数据融合标定方法
CN108345005A (zh) * 2018-02-22 2018-07-31 重庆大学 巷道掘进机的实时连续自主定位定向系统及导航定位方法
CN109137829A (zh) * 2018-08-29 2019-01-04 青岛港国际股份有限公司 自动化码头agv防撞保护方法和系统
CN111267113A (zh) * 2018-12-05 2020-06-12 广州中国科学院先进技术研究所 一种获取打磨轨迹数据的方法和多机器人协同打磨系统
CN109676280A (zh) * 2019-02-02 2019-04-26 宁波吉利汽车研究开发有限公司 车身制造通用化系统和车身制造通用化智能工厂系统
CN110427033A (zh) * 2019-08-12 2019-11-08 苏州寻迹智行机器人技术有限公司 一种基于二维码的激光导航agv高精度定位方法
CN110723484A (zh) * 2019-09-26 2020-01-24 兰剑智能科技股份有限公司 穿梭车行走自动纠偏方法、装置、计算机设备及存储介质
CN112925301A (zh) * 2019-12-05 2021-06-08 杭州海康机器人技术有限公司 用于agv避险的控制方法和agv
CN112525125A (zh) * 2020-12-07 2021-03-19 兰剑智能科技股份有限公司 Agv车一致性校准的方法、装置及设备
CN112558607A (zh) * 2020-12-07 2021-03-26 兰剑智能科技股份有限公司 单舵轮agv车自动校准的方法、装置及设备
CN112556576A (zh) * 2020-12-07 2021-03-26 兰剑智能科技股份有限公司 双激光扫描仪校准方法、装置及设备

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022121459A1 (zh) * 2020-12-07 2022-06-16 兰剑智能科技股份有限公司 计算agv叉车激光扫描仪安装位置偏差的方法及装置

Also Published As

Publication number Publication date
WO2022121459A1 (zh) 2022-06-16
CN113282092B (zh) 2021-11-19
CN112558607A (zh) 2021-03-26

Similar Documents

Publication Publication Date Title
CN113282092B (zh) 计算agv叉车激光扫描仪安装位置偏差的方法及装置
CN108592906B (zh) 基于二维码和惯性传感器的agv复合导航方法
CN106020200B (zh) 采用轮毂电机驱动的agv小车及路径规划方法
Seelinger et al. Automatic visual guidance of a forklift engaging a pallet
CN111610523B (zh) 一种轮式移动机器人的参数校正方法
CN110244718B (zh) 一种可自动避障的巡视智能小车
KR20210066791A (ko) 로봇식 장치의 타이트 턴을 위한 경로 계획을 최적화하는 시스템 및 방법
JPH0324605A (ja) 移動ロボットの走行制御方法
CN106843214A (zh) 一种基于自抗扰控制的磁带导引agv循迹控制方法
CN107063305B (zh) 用惯导、压力传感器修正下坡悬空后轮里程计误差的方法
CN105278533A (zh) 一种全向移动平台导航方法
CN109491390B (zh) 基于多传感器的无轨化全向移动机器人系统及其控制方法
CN106020197A (zh) 一种基于势能场的机器人路径跟踪算法
CN116026368B (zh) 移动机器人的参数联合标定方法及系统、设备、存储介质
Yu et al. Development of an omnidirectional automated guided vehicle with MY3 wheels
CN202166895U (zh) 变电站智能巡检机器人的激光导航系统
CN103472844A (zh) 基于电子标签自校正的移动平台定位系统
CN111596666A (zh) 一种基于agv运动预测的障碍物碰撞威胁的检测方法
CN107272693B (zh) 基于全向车与装配工位自动对接系统及方法
CN109375631A (zh) 一种实现高速磁导航识别的系统及方法
JP5439552B2 (ja) ロボットシステム
CN115993089B (zh) 基于pl-icp的在线四舵轮agv内外参标定方法
CN204129536U (zh) 一种船舶双曲率外板空间定位标记设备
CN112556576B (zh) 双激光扫描仪校准方法、装置及设备
JP2010262461A (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
GR01 Patent grant
GR01 Patent grant