CN110082561A - 一种agv车体打滑的检测及其校正方法 - Google Patents
一种agv车体打滑的检测及其校正方法 Download PDFInfo
- Publication number
- CN110082561A CN110082561A CN201910339042.0A CN201910339042A CN110082561A CN 110082561 A CN110082561 A CN 110082561A CN 201910339042 A CN201910339042 A CN 201910339042A CN 110082561 A CN110082561 A CN 110082561A
- Authority
- CN
- China
- Prior art keywords
- imu
- trolley
- velocity information
- speed
- skids
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/64—Devices characterised by the determination of the time taken to traverse a fixed distance
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P7/00—Measuring speed by integrating acceleration
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及AGV小车领域,具体涉及一种AGV车体打滑的检测以及校正方法。通过里程计的速度信息对小车车体进行初次打滑检测,为了防止打滑误检测,结合IMU计算的速度信息进行第二次判断,通过IMU计算的速度和里程计的速度进行对比,完成小车打滑的检测过程,检测时间快,且通过多组数据进行验证,准确度高,通过IMU速度信息和里程计的速度信息对比来校正小车的位置计算结果,提高了小车运行地图的准确性,进而保证后续小车导航的准确性。
Description
技术领域
本发明涉及AGV小车领域,具体涉及一种AGV车体打滑的检测以及校正方法。
背景技术
当AGV小车在行驶的过程中,遇到地面有水或者车的轮子磨损比较严重的情况,或者在金属板上面行走时都会出现打滑的现象,但仍然会将轮子打滑转动的距离计算在内,影响小车的位置计算结果,一般通过驱动轮和从动轮的速度来判断车体是否打滑,但是需要在从动轮上再安装速度检测设备,使得成本增高,再者从动轮不可控,在判断车体打滑时会出现误判的情况,准确性不高。
发明内容
本发明要解决的技术问题是提供一种检测时间快,准确度高,可保证后续小车导航的准确性的AGV车体打滑的检测以及校正方法。
为了解决上述技术问题,本发明解决其技术问题所采用的技术方案是:
一种AGV车体打滑的检测,具体步骤包括:
S1:通过IMU读取转轮角度信息以及相应轴的加速度信息;
S2;对加速度信息进行处理,去除重力加速度在相应轴方向上的分量;通过里程计获得到速度信息;
S3:通过里程计连续获得t时刻、t+m时刻、t+2m时刻三个时刻的速度信息,同时对所述三个时刻的时间间隔m内的IMU读取的加速度信息进行积分处理,得到IMU速度信息;
S4:判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,是则判定小车转轮打滑,否则判定小车转轮不打滑,小车车体继续行驶。
优选的,所述转轮为驱动轮或从动轮。
优选的,在步骤S4中,连续判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,若里程计速度和IMU速度之间的差值连续三次大于预设位姿阈值,则认为小车已打滑。
优选的,步骤S4中,若判定小车转轮打滑,则IMU将IMU速度信息传送至小车的控制单元,小车上的控制单元进行报警。
优选的,所述预设位姿阈值为0.15m/s、0.2m/s或者0.25m/s。
优选的,在获取所述IMU速度信息之后,计算里程计速度和IMU速度之间的差值之前,判断所述IMU速度信息是否在内部寄存器对应输出的可靠性数值范围内,是则确定所述IMU速度信息读取的相对坐标信息可靠,保留所述IMU速度信息,用来检测小车车体打滑;否则确定IMU速度信息不可靠,删除所述IMU速度信息,不被用来进行检测。
本发明还包括一种AGV车体打滑的校正方法,所述校正方法是基于所述的一种AGV车体打滑的检测方法,具体步骤包括:当t时刻的里程计速度和IMU速度之间的差值小于预设位姿阈值,则使用t时刻内所述IMU速度信息更新地图坐标;当连续三个时刻的里程计速度和IMU速度之间的差值均大于预设位姿阈值,则IMU将t时刻的IMU速度信息传送至小车的控制单元,小车上的控制单元进行报警,同时使用t时刻内所述IMU速度信息更新地图坐标。
优选的,基于权6中所述IMU速度信息的可靠性判断条件下的矫正方法还包括,当确定所述IMU速度信息读取的相对坐标信息可靠时,使用所述矫正方法对地图坐标进行矫正;当确定所述IMU速度信息读取的相对坐标信息不可靠时,使用里程计速度信息更新地图坐标。
本发明的有益效果:
通过里程计的速度信息对小车车体进行初次打滑检测,为了防止打滑误检测,结合IMU计算的速度信息进行第二次判断,通过IMU计算的速度和里程计的速度进行对比,完成小车打滑的检测过程,检测时间快,且通过多组数据进行验证,准确度高,通过IMU速度信息和里程计的速度信息对比来校正小车的位置计算结果,提高了小车运行地图的准确性,进而保证后续小车导航的准确性
附图说明
图1是本发明的一种AGV车体打滑的检测结构示意图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明,以使本领域的技术人员可以更好地理解本发明并能予以实施,但所举实施例不作为对本发明的限定。
参照图1所示,一种AGV车体打滑的检测,具体步骤包括:
S1:通过IMU(惯性导航解算单元)读取转轮角度信息以及相应轴的加速度信息;
S2;对加速度信息进行处理,去除重力加速度在相应轴方向上的分量;通过里程计获得到速度信息;
S3:通过里程计连续获得t时刻、t+m时刻、t+2m时刻三个时刻的速度信息,同时对所述三个时刻的时间间隔m内的IMU读取的加速度信息进行积分处理,得到IMU速度信息;
S4:判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,是则判定小车转轮打滑,否则判定小车转轮不打滑,小车车体继续行驶。
通过里程计的速度信息对小车车体进行初次打滑检测,为了防止打滑误检测,结合IMU计算的速度信息进行第二次判断,通过IMU计算的速度和里程计的速度进行对比,完成小车打滑的检测过程,检测时间快,且通过多组数据进行验证,准确度高,通过IMU速度信息和里程计的速度信息对比来校正小车的位置计算结果,提高了小车运行地图的准确性,进而保证后续小车导航的准确性。
所述时间间隔m的数值为25ms-35ms,本实施例较优选的所述时间间隔m的数值为30ms。
连续采集30ms内的IMU速度信息和里程计的速度信息,避免小车运行中产生较大速度差值,影响小车的判断,极大地将算法的计算量,易于实现。
所述转轮为驱动轮或从动轮。
在步骤S4中,连续判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,若里程计速度和IMU速度之间的差值连续三次大于预设位姿阈值,则认为小车已打滑。
步骤S4中,若判定小车转轮打滑,则IMU将IMU速度信息传送至小车的控制单元(PLC单元),小车上的控制单元进行报警。
所述预设位姿阈值为0.15m/s、0.2m/s或者0.25m/s,本实施例较优选的所述预设位姿阈值为0.2m/s。
在获取所述IMU速度信息之后,计算里程计速度和IMU速度之间的差值之前,判断所述IMU速度信息是否在内部寄存器对应输出的可靠性数值范围内,是则确定所述IMU速度信息读取的相对坐标信息可靠,保留所述IMU速度信息,用来检测小车车体打滑;否则确定IMU速度信息不可靠,删除所述IMU速度信息,不被用来进行检测。
本发明还包括一种AGV车体打滑的校正方法,所述校正方法是基于所述的一种AGV车体打滑的检测方法,具体步骤包括:当t时刻的里程计速度和IMU速度之间的差值小于预设位姿阈值,则使用t时刻内所述IMU速度信息更新地图坐标;当连续三个时刻的里程计速度和IMU速度之间的差值均大于预设位姿阈值,则IMU将t时刻的IMU速度信息传送至小车的控制单元,小车上的控制单元进行报警,同时使用t时刻内所述IMU速度信息更新地图坐标。
基于权6中所述IMU速度信息的可靠性判断条件下的矫正方法还包括,当确定所述IMU速度信息读取的相对坐标信息可靠时,使用所述矫正方法对地图坐标进行矫正;当确定所述IMU速度信息读取的相对坐标信息不可靠时,使用里程计速度信息更新地图坐标。
本发明还包括一种地图坐标纠正方法,包括步骤:采用AGV车体打滑的校正方法判断小车车体是否发生打滑;当任意时刻判断所述小车车体发生打滑时,记录所述小车车体持续打滑的时间;根据所述小车车体持续打滑的时间对所述小车车体的地图坐标进行纠正。
本发明还包括一种地图坐标纠正装置,其特征在于,包括处理器、存储器以及存储在所述存储器中且被配置为由所述处理器执行的计算机程序,所述处理器执行所述计算机程序时实现地图坐标纠正方法。
本发明还包括一种计算机可读存储介质,其特征在于,所述计算机可读存储介质包括存储的计算机程序,其中,在所述计算机程序运行时控制所述计算机可读存储介质所在设备执行地图坐标纠正方法。
以上所述实施例仅是为充分说明本发明而所举的较佳的实施例,本发明的保护范围不限于此。本技术领域的技术人员在本发明基础上所作的等同替代或变换,均在本发明的保护范围之内。本发明的保护范围以权利要求书为准。
Claims (8)
1.一种AGV车体打滑的检测,其特征在于,具体步骤包括:
S1:通过IMU读取转轮角度信息以及相应轴的加速度信息;
S2;对加速度信息进行处理,去除重力加速度在相应轴方向上的分量;通过里程计获得到速度信息;
S3:通过里程计连续获得t时刻、t+m时刻、t+2m时刻三个时刻的速度信息,同时对所述三个时刻的时间间隔m内的IMU读取的加速度信息进行积分处理,得到IMU速度信息;
S4:判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,是则判定小车转轮打滑,否则判定小车转轮不打滑,小车车体继续行驶。
2.如权利要求1所述的AGV车体打滑的检测,其特征在于,所述转轮为驱动轮或从动轮。
3.如权利要求1所述的AGV车体打滑的检测,其特征在于,在步骤S4中,连续判断里程计速度和IMU速度之间的差值是否大于预设位姿阈值,若里程计速度和IMU速度之间的差值连续三次大于预设位姿阈值,则认为小车已打滑。
4.如权利要求1所述的AGV车体打滑的检测,其特征在于,步骤S4中,若判定小车转轮打滑,则IMU将IMU速度信息传送至小车的控制单元,小车上的控制单元进行报警。
5.如权利要求1所述的AGV车体打滑的检测,其特征在于,所述预设位姿阈值为0.15m/s、0.2m/s或者0.25m/s。
6.如权利要求1所述的AGV车体打滑的检测,其特征在于,在获取所述IMU速度信息之后,计算里程计速度和IMU速度之间的差值之前,判断所述IMU速度信息是否在内部寄存器对应输出的可靠性数值范围内,是则确定所述IMU速度信息读取的相对坐标信息可靠,保留所述IMU速度信息,用来检测小车车体打滑;否则确定IMU速度信息不可靠,删除所述IMU速度信息,不被用来进行检测。
7.一种AGV车体打滑的校正方法,其特征在于,所述校正方法是基于权1所述的一种AGV车体打滑的检测方法,具体步骤包括:当t时刻的里程计速度和IMU速度之间的差值小于预设位姿阈值,则使用t时刻内所述IMU速度信息更新地图坐标;当连续三个时刻的里程计速度和IMU速度之间的差值均大于预设位姿阈值,则IMU将t时刻的IMU速度信息传送至小车的控制单元,小车上的控制单元进行报警,同时使用t时刻内所述IMU速度信息更新地图坐标。
8.如权利要求7所述的AGV车体打滑的校正方法,其特征在于,基于权6中所述IMU速度信息的可靠性判断条件下的矫正方法还包括,当确定所述IMU速度信息读取的相对坐标信息可靠时,使用所述矫正方法对地图坐标进行矫正;当确定所述IMU速度信息读取的相对坐标信息不可靠时,使用里程计速度信息更新地图坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910339042.0A CN110082561A (zh) | 2019-04-25 | 2019-04-25 | 一种agv车体打滑的检测及其校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910339042.0A CN110082561A (zh) | 2019-04-25 | 2019-04-25 | 一种agv车体打滑的检测及其校正方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110082561A true CN110082561A (zh) | 2019-08-02 |
Family
ID=67416757
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910339042.0A Pending CN110082561A (zh) | 2019-04-25 | 2019-04-25 | 一种agv车体打滑的检测及其校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110082561A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107289929A (zh) * | 2017-08-08 | 2017-10-24 | 珠海市微半导体有限公司 | 一种机器人碰到障碍物的检测方法和***及芯片 |
CN110514863A (zh) * | 2019-09-23 | 2019-11-29 | 北京智行者科技有限公司 | 一种用于无人车车轮打滑的判别及补偿方法 |
CN111597850A (zh) * | 2020-05-14 | 2020-08-28 | 上海快仓智能科技有限公司 | 车辆信息处理方法、装置及计算机可读存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN206056965U (zh) * | 2016-08-26 | 2017-03-29 | 龙岩学院 | 一种轮式机器人打滑检测装置 |
CN107289929A (zh) * | 2017-08-08 | 2017-10-24 | 珠海市微半导体有限公司 | 一种机器人碰到障碍物的检测方法和***及芯片 |
CN107643186A (zh) * | 2017-09-15 | 2018-01-30 | 深圳市杉川机器人有限公司 | 机器打滑检测的方法、装置及*** |
CN108790668A (zh) * | 2018-07-23 | 2018-11-13 | 浙江大学滨海产业技术研究院 | 一种agv小车防滑***及防滑调节方法 |
-
2019
- 2019-04-25 CN CN201910339042.0A patent/CN110082561A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN206056965U (zh) * | 2016-08-26 | 2017-03-29 | 龙岩学院 | 一种轮式机器人打滑检测装置 |
CN107289929A (zh) * | 2017-08-08 | 2017-10-24 | 珠海市微半导体有限公司 | 一种机器人碰到障碍物的检测方法和***及芯片 |
CN107643186A (zh) * | 2017-09-15 | 2018-01-30 | 深圳市杉川机器人有限公司 | 机器打滑检测的方法、装置及*** |
CN108790668A (zh) * | 2018-07-23 | 2018-11-13 | 浙江大学滨海产业技术研究院 | 一种agv小车防滑***及防滑调节方法 |
Non-Patent Citations (2)
Title |
---|
张波: "6.3.1.1 惯性导航技术", 《空面导弹***设计》 * |
王保防 等: "纵向打滑状态下的轮式移动机器人编队控制", 《电子学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107289929A (zh) * | 2017-08-08 | 2017-10-24 | 珠海市微半导体有限公司 | 一种机器人碰到障碍物的检测方法和***及芯片 |
CN110514863A (zh) * | 2019-09-23 | 2019-11-29 | 北京智行者科技有限公司 | 一种用于无人车车轮打滑的判别及补偿方法 |
CN111597850A (zh) * | 2020-05-14 | 2020-08-28 | 上海快仓智能科技有限公司 | 车辆信息处理方法、装置及计算机可读存储介质 |
CN111597850B (zh) * | 2020-05-14 | 2023-09-08 | 上海快仓智能科技有限公司 | 车辆信息处理方法、装置及计算机可读存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110031019B (zh) | 一种用于自动驾驶车辆的打滑检测处理方法 | |
CN110082561A (zh) | 一种agv车体打滑的检测及其校正方法 | |
Zhao et al. | Design of a nonlinear observer for vehicle velocity estimation and experiments | |
CN103270543B (zh) | 驾驶辅助装置 | |
CN109186610B (zh) | 一种auv地形匹配导航的鲁棒bslam方法 | |
US11383727B2 (en) | Vehicle operation based on vehicular measurement data processing | |
CN109606378A (zh) | 面向非高斯噪声环境的车辆行驶状态估计方法 | |
CN104990563B (zh) | 车辆行驶里程计算方法 | |
Lian et al. | Cornering stiffness and sideslip angle estimation based on simplified lateral dynamic models for four-in-wheel-motor-driven electric vehicles with lateral tire force information | |
Iagnemma et al. | Classification-based wheel slip detection and detector fusion for mobile robots on outdoor terrain | |
CN106643749A (zh) | 一种基于智能手机的危险驾驶行为检测方法 | |
Zhang et al. | Lidar-IMU and wheel odometer based autonomous vehicle localization system | |
JP5668701B2 (ja) | 車両質量推定装置 | |
CN106979780A (zh) | 一种无人车实时姿态测量方法 | |
CN108304594B (zh) | 一种基于速度与陀螺仪数据的汽车驾驶稳定性的判定方法 | |
CN110341714B (zh) | 一种同时估计车辆质心侧偏角和扰动的方法 | |
CN108715166A (zh) | 基于深度学习的车辆稳定性指标估计方法 | |
CN111114551B (zh) | 一种车辆坡道坡度识别方法和装置 | |
CN109883394A (zh) | 一种汽车用道路坡度实时估计方法 | |
WO2024037130A1 (zh) | 质心速度确定方法以及装置 | |
Reina et al. | Odometry correction using visual slip angle estimation for planetary exploration rovers | |
CN103391871B (zh) | 用于确定车辆的倾斜位置的方法和装置 | |
CN114413791A (zh) | 一种舵轮式叉车舵轮零偏角的检测方法、***及装置 | |
US11731596B2 (en) | Method for the traction control of a single-track motor vehicle taking the slip angle of the rear wheel into consideration | |
JP6279446B2 (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190802 |