CN111880538B - 一种agv激光导航线路标定中弯道调整方法 - Google Patents

一种agv激光导航线路标定中弯道调整方法 Download PDF

Info

Publication number
CN111880538B
CN111880538B CN202010736646.1A CN202010736646A CN111880538B CN 111880538 B CN111880538 B CN 111880538B CN 202010736646 A CN202010736646 A CN 202010736646A CN 111880538 B CN111880538 B CN 111880538B
Authority
CN
China
Prior art keywords
angle
offset
radius
agv
curve
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
Application number
CN202010736646.1A
Other languages
English (en)
Other versions
CN111880538A (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.)
Hunan Chizhong Robotics Co ltd
Original Assignee
Hunan Cizon Robotics 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 Hunan Cizon Robotics Co ltd filed Critical Hunan Cizon Robotics Co ltd
Priority to CN202010736646.1A priority Critical patent/CN111880538B/zh
Publication of CN111880538A publication Critical patent/CN111880538A/zh
Application granted granted Critical
Publication of CN111880538B publication Critical patent/CN111880538B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • 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/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 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process

Abstract

本发明公开了一种AGV激光导航线路标定中弯道调整方法，包括以下步骤：步骤一，确定弯道处AGV转弯角度及转弯半径；步骤二，AGV横向偏移后的半径补偿计算；步骤三，AGV角度偏移后的半径补偿计算；最后，根据步骤三补偿计算后的半径实时调整AGV的舵轮角度，完成弯道行进。本发明提供的方法可有效补偿计算AGV转弯时的半径，对AGV线路标定起到指导作用，能有效提高AGV的线路的精度。

Description

一种AGV激光导航线路标定中弯道调整方法
技术领域
本发明涉及AGV线路标定技术领域，具体涉及一种对AGV激光导航线路标定中弯道调整方法。
背景技术
激光导航系统是伴随激光技术不断成熟而发展起来的一种新兴导航应用技术，适用于视线不良情况下的运行导航、野外勘测定向等工作，将它作为民用或军用导航手段是十分可取的。激光船舶导航系统仍处于起步阶段，系统的整合仍需进一步加强，但可以预见，随着激光导航技术的不断丰富和完善，必将会引起导航技术研究的新一轮高潮。目前激光导引AGV多采用激光传感仪器，并将激光传感仪器返回的激光信号对AGV小车引导，对AGV小车激光导航的指引需要预先规划导航路径，AGV小车根据摄像机对周围环境进行实时探测，并根据探测到的现场信息实时规划导航路径，定位之后便是激光线路的处理，目前市场上采用的激光线路设定基本采用调度规划线路，容易导致线路设定以及工位对接操作特别麻烦，并且需要专业的人员进行操作，尤其在线路的标定中，弯道如产生较大误差，进而影响AGV小车线路的精度。而且，由于目前各种项目现场的工位对接的空间都比较小，而舵轮AGV的转弯半径比较大，原地打舵半径虽小但效率不高、动态打舵出弯后需要较长的直线纠偏距离。
因此有必要提供一种AGV激光导航线路标定中弯道调整方法来解决上述问题。
发明内容
本发明提供一种AGV激光导航线路标定中弯道调整方法，针对已设定好的激光导航线路进行弯道补偿，解决现有技术中AGV(如AGV叉车)边后退边转弯时弯道如未及时调整容易发生偏差影响工位操作精度，以及现有技术中需要停下来打舵影响工位操作效率的等问题。
为了达到上述目的，本发明所采用的技术方案是：一种AGV激光导航线路标定中弯道调整方法，包括以下步骤：步骤一，确定弯道处AGV转弯角度及转弯半径；步骤二，AGV横向偏移后的半径补偿计算；步骤三，AGV角度偏移后的半径补偿计算；最后，根据步骤三补偿计算后的半径实时调整AGV的舵轮角度，完成弯道行进。
进一步的，所述步骤一详细过程为：记录开始转向起始点位置P1、弯道起始点位置P2、弯道结束点位置P3以及转向完成终点位置P4，各位置点的坐标分别记录为(X1,Y2)、(X2,Y2)、(X3,Y3)、(X4,Y4)，线段P1P2与P3P4均与弯道所在圆相切，切点分别为P2、P3，延长P1P2与P3P4相交于K点，求出转弯角度β和转弯半径R。
进一步的，因为入弯之前AGV的姿态并非与所走的直线重合，会存在横向偏差和角度偏差，所述步骤二的详细过程为：用公式一计算横向偏移对应的半径补偿：
其中，R为设定的转弯半径，单位毫米；R1横向偏移补偿结束后的半径，单位毫米；β为设定的转弯角度，单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；X为横向偏移量(车体后轮中心点的偏移量)，横向偏移量X带符号，车体右偏为负，车体左偏为正，单位毫米。
进一步的，所述步骤三的详细过程为用步骤2补偿计算后的半径带入到角度偏移半径补偿公式2.1、公式2.3：
角度偏移包括内偏、外偏，内偏时的角度偏移补偿半径采用下述公式2.1：
内偏转弯前需向前直线行走一段距离，该距离长度记为D，D采用如下公式计算：
外偏时的角度偏移补偿半径采用下述公式2.3：
其中，R1横向偏移补偿结束后的半径，单位毫米；β为设定转弯角度，单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；R2横向、角度偏移补偿后半径，单位：毫米；α为角度偏移量(单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；
进一步的，所述步骤四的详细过程为：根据计算出的R2,再根据车体轴距计算出的舵轮角度，开始打舵(AGV保持行走状态)，然后至打舵结束后依据x(动态前进横向偏移量积分值),y(动态前进纵向偏移量积分值),w(动态打舵完成时的车体角度偏移量)计算出最终转弯半径Re，采用公式3进行补偿计算:
按照上步骤打完舵轮之后重新计算出的转弯半径R3，再次根据AGV轴距计算出舵轮角度，再进行转弯。
进一步的，确定最终半径R3之后，还包括舵轮角度动态微调的步骤，具体为：
R3确定同时，以车头(前进)或车尾(后退)的坐标以及车体的角度(角度采用激光传感器实时传输)和R3确定圆心坐标。然后根据车头或车位的实时坐标距离圆心的距离减去R3可以实时计算出AGV车头或车尾到转弯曲线的偏移量。再根据偏移量对舵轮角度微调，进一步提高转弯精度。
待AGV车体变化的角度接近β(转弯角度)-w(动态打舵完成时的车体角度偏移量)位置，再回舵，使打舵车体的变化角度与回舵车体变化角度形成对称,即入弯打舵车体变化了多少度，转弯结束后实际转过的角度跟β还差w，开始回舵，弯道补偿结束。
本发明的有益效果：
本发明采用上述技术方案，操作简单，减小弯道标定的误差，能保证AGV出弯之后AGV的姿态非常标准，从而保证AGV能够准确无误地行走。
附图说明
为了更清楚地说明本发明实施方式或现有技术中的技术方案以及本发明的有益效果，下面将对实施方式或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施方式，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图示出的结构获得其他的结构。
图1为实施例AGV标定的弯道坐标系示意图。
图2为实施例中AGV入弯前横向偏转坐标系示意图。
图3为实施例中AGV确定最终半径R3之后舵轮角度动态微调的坐标系示意图。
图4为实施例中AGV弯道补偿后的坐标系示意图。
具体实施方式
本发明的具体实施例：
本实施例的一种AGV激光导航线路标定中弯道调整方法，包括以下步骤：步骤一，确定弯道处AGV转弯角度及转弯半径；步骤二，AGV横向偏移后的半径补偿计算；步骤三，AGV角度偏移后的半径补偿计算；最后，根据步骤三补偿计算后的半径实时调整AGV的舵轮角度，完成弯道行进。
参见图1，本实施例AGV弯道标定中补偿计算的具体过程如下：记录开始转向起始点位置P1、弯道起始点位置P2、弯道结束点位置P3以及转向完成终点位置P4，各位置点的坐标分别记录为(X1,Y2)、(X2,Y2)、(X3,Y3)、(X4,Y4)，线段P1P2与P3P4均与弯道所在圆相切，切点分别为P2、P3，延长P1P2与P3P4相交于K点，求出转弯角度∠GKP3转弯半径R。根据几何关系确定转弯角度∠GKP3和转弯半径R，具体确定的过程为：∠GKP3＝P1P2直线方位角-P3P4直线方位角；根据两段直线相交能求出交点坐标K，再根据P2便求出KP2的距离；
R＝tan((180-∠GKP3)/2)*KP2。
参见图2，因为入弯之前AGV的姿态并非与所走的直线重合，会存在横向偏差和角度偏差，图中入弯前的横向偏差(T1P2,T2P2)、角度偏差(∠T1M1P2和∠T2M2P2)、内偏(状态②)、外偏(状态①)，AGV横向偏移后的半径补偿计算详细过程为：用公式一计算横向偏移对应的半径补偿：
其中，R为设定的转弯半径，单位毫米；R1横向偏移补偿结束后的半径，单位毫米；β为设定的转弯角度(即为图中的∠GKP3)，单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；X为横向偏移量(车体后轮中心点的偏移量)，横向偏移量X带符号，车体右偏为负，车体左偏为正，单位毫米。
用步骤2补偿计算后的半径带入到角度偏移半径补偿公式2.1、公式2.3：
角度偏移包括内偏、外偏，内偏时的角度偏移补偿半径采用下述公式2.1：
内偏转弯前需向前直线行走一段距离，该距离长度记为D，D采用如下公式计算：
外偏时的角度偏移补偿半径采用下述公式2.3：
其中，R1横向偏移补偿结束后的半径，单位毫米；β为设定的转弯角度，单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；R2横向、角度偏移补偿后半径，单位：毫米；w为角度偏移量(单位：角度或弧度，取值角度范围0°～360°，弧度范围(0～3.141593)；
根据计算出的R2,再根据车体尺寸计算出的舵轮角度，开始打舵(AGV保持行走状态)，然后至打舵结束后依据x(动态前进横向偏移量积分值),y(动态前进纵向偏移量积分值),w(动态打舵完成时的车体角度偏移量)计算出最终转弯半径Re，采用公式3进行补偿计算:
按照上步骤打完舵轮之后重新计算出的转弯半径R3，再次根据AGV轴距计算出舵轮角度，再转弯。
参见图3、图4，确定最终半径R3之后，还包括舵轮角度动态微调的步骤。
R3确定同时，以车头(前进)或车尾(后退)的坐标以及车体的角度(激光传感器实时传输)和R3确定圆心坐标。然后根据车头或车位的实时坐标距离圆心的距离减去R3可以实时计算出AGV车头或车尾到转弯曲线的偏移量。再根据偏移量对舵轮角度微调，进一步提高转弯精度。待AGV车体变化的角度接近β-w后，再回舵，使打舵车体的变化角度与回舵车体变化角度形成对称,弯道补偿结束。
采用本发明方法可有效补偿计算AGV转弯时的半径对线路标定中起到指导作用，有效提高AGV的线路的精度，特别是对于叉车式AGV后退转弯叉取货物的时候，本次发明能保证出弯之后AGV的姿态就非常的标准(前后左右偏差均在1cm之内，角度偏差0.5度之内)，可立即进行叉取作业。
以上仅为本发明的优选实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (2)

1.一种AGV激光导航线路标定中弯道调整方法，其特征在于，包括以下步骤：步骤一，确定弯道处AGV转弯角度及转弯半径；步骤二，AGV横向偏移后的半径补偿计算；步骤三，AGV角度偏移后的半径补偿计算；最后，根据步骤三补偿计算后的半径实时调整AGV的舵轮角度，完成弯道行进；
所述步骤一详细过程为：记录开始转向起始点位置P1、弯道起始点位置P2、弯道结束点位置P3以及转向完成终点位置P4，各位置点的坐标分别记录为X1、Y1，X2、Y2，X3、Y3，X4、Y4，线段P1P2与P3P4均与弯道所在圆相切，切点分别为P2、P3，延长P1P2与P3P4相交于K点，根据几何关系计算转弯角度β和转弯半径R；
所述步骤二的详细过程为：用公式1计算横向偏移对应的半径补偿：
其中，R为设定的转弯半径，单位毫米；R1横向偏移补偿结束后的半径，单位毫米；β为设定转弯角度，单位：角度或弧度，取值角度范围0°～360°，弧度范围0～3.141593；X为横向偏移量，车体后轮中心点的偏移量，横向偏移量X带符号，车体右偏为负，车体左偏为正，单位毫米；
所述步骤三的详细过程为用步骤2补偿计算后的半径带入到角度偏移半径补偿公式2.1、公式2.3：
角度偏移包括内偏、外偏，内偏时的角度偏移补偿半径采用下述公式2.1：
内偏转弯前需向前直线行走一段距离，该距离长度记为D，D采用如下公式2.2计算：
外偏时的角度偏移补偿半径采用下述公式2.3：
其中，R1横向偏移补偿结束后的半径，单位毫米；β为设定转弯角度，单位：角度或弧度，取值角度范围0°～360°，弧度范围0～3.141593；R2横向、角度偏移补偿后半径，单位：毫米；α为角度偏移量，单位：角度或弧度，取值角度范围0°～360°，弧度范围0～3.141593；
步骤四的详细过程为：根据计算出的R2,再根据车体尺寸计算出的舵轮角度，开始打舵，然后至打舵结束后依据动态前进横向偏移量积分值x、动态前进纵向偏移量积分值y、动态打舵完成时的车体角度偏移量w计算出最终转弯半径R3，采用公式3进行补偿计算:
按照上步骤打完舵轮之后重新计算出的转弯半径R3，再次根据AGV车体尺寸计算出舵轮角度，再转弯。
2.根据权利要求1所述的AGV激光导航线路标定中弯道调整方法，其特征在于，计算出R3后还包括对AGV舵轮角度动态微调的过程：R3确定同时，以车头或车尾的坐标以及车体的角度和R3先确定圆心坐标，然后根据车头或车位的实时坐标距离圆心的距离减去R3实时计算出AGV车头或车尾到转弯曲线的偏移量，根据偏移量对舵轮角度进行动态微调。
CN202010736646.1A 2020-07-28 2020-07-28 一种agv激光导航线路标定中弯道调整方法 Active CN111880538B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010736646.1A CN111880538B (zh) 2020-07-28 2020-07-28 一种agv激光导航线路标定中弯道调整方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010736646.1A CN111880538B (zh) 2020-07-28 2020-07-28 一种agv激光导航线路标定中弯道调整方法

Publications (2)

Publication Number Publication Date
CN111880538A CN111880538A (zh) 2020-11-03
CN111880538B true CN111880538B (zh) 2024-01-26

Family

ID=73200848

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010736646.1A Active CN111880538B (zh) 2020-07-28 2020-07-28 一种agv激光导航线路标定中弯道调整方法

Country Status (1)

Country Link
CN (1) CN111880538B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113219973B (zh) * 2021-05-08 2022-06-24 浙江工业大学 一种移动机器人的局部路径控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011031364A (ja) * 2009-08-05 2011-02-17 Denso Wave Inc ロボットのアーム連結装置
CN102483336A (zh) * 2009-09-09 2012-05-30 斯图加特大学 旋转角度传感器中测量道偏心的光学补偿装置及方法
CN106113035A (zh) * 2016-06-16 2016-11-16 华中科技大学 一种六自由度工业机器人末端工具坐标系标定装置及方法
CN109144078A (zh) * 2018-11-13 2019-01-04 楚天智能机器人（长沙）有限公司 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统
CN109375624A (zh) * 2018-11-12 2019-02-22 楚天智能机器人（长沙）有限公司 一种双舵轮agv圆弧路径生成方法、装置及介质
CN110103998A (zh) * 2019-05-16 2019-08-09 湖南驰众机器人有限公司 非对称四舵轮agv转向及平移运动的控制方法
CN111044073A (zh) * 2019-11-26 2020-04-21 北京卫星制造厂有限公司 基于双目激光高精度agv位置感知方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011031364A (ja) * 2009-08-05 2011-02-17 Denso Wave Inc ロボットのアーム連結装置
CN102483336A (zh) * 2009-09-09 2012-05-30 斯图加特大学 旋转角度传感器中测量道偏心的光学补偿装置及方法
CN106113035A (zh) * 2016-06-16 2016-11-16 华中科技大学 一种六自由度工业机器人末端工具坐标系标定装置及方法
CN109375624A (zh) * 2018-11-12 2019-02-22 楚天智能机器人（长沙）有限公司 一种双舵轮agv圆弧路径生成方法、装置及介质
CN109144078A (zh) * 2018-11-13 2019-01-04 楚天智能机器人（长沙）有限公司 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统
CN110103998A (zh) * 2019-05-16 2019-08-09 湖南驰众机器人有限公司 非对称四舵轮agv转向及平移运动的控制方法
CN111044073A (zh) * 2019-11-26 2020-04-21 北京卫星制造厂有限公司 基于双目激光高精度agv位置感知方法

Also Published As

Publication number Publication date
CN111880538A (zh) 2020-11-03

Similar Documents

Publication Publication Date Title
US20200356097A1 (en) Apparatus and method for controlling a vehicle
US11180189B2 (en) Automated reverse implement parking
CN107544520B (zh) 一种用于四轮载具自动驾驶的控制方法
US11167792B2 (en) Single-mode implement steering
CN116457259A (zh) 车辆驾驶控制方法、装置、车辆及存储介质
US20050269145A1 (en) Steering assistance method and device for a motor vehicle
CN110316249B (zh) 横向控制方法及装置
WO2016172729A1 (en) System, apparatus, and method for controlling a vehicle
US20140236412A1 (en) Apparatus and method for automatically parking vehicle
CN110320917B (zh) 无人车弯道循迹控制方法
CN112212887B (zh) 一种基于阿克曼转向模型的自动泊车定位参数标定方法
CN111880538B (zh) 一种agv激光导航线路标定中弯道调整方法
US20170144704A1 (en) Method for guiding an off-road vehicle along a curved path
CN112537297B (zh) 车道保持方法、系统及车辆
CN113311845B (zh) 基于路径曲率的纯跟踪控制误差补偿方法及装置
EP3863909A1 (en) Automated reverse implement parking
AU676790B2 (en) Apparatus for determining position of moving body
JP6535561B2 (ja) 車両の走行制御装置
CN112078570A (zh) 一种基于阿克曼转向模型的汽车定位方法
CN114701488A (zh) 基于横纵向解耦的自动泊车路径跟踪方法
CN114625113A (zh) 一种agv舵轮自动标定方法、控制系统及存储介质
JPH03189805A (ja) 車両の自動操舵方法及びその自動操舵装置
CN115328135B (zh) 划线机器人校准及划线方法、装置、电子设备及划线机器人
JP2002039784A (ja) 移動体の位置計測方法及び計測装置
CN114018246B (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
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: No.8, Zhixin Road, robot industry base, Yuhua District, Changsha City, Hunan Province 410000

Patentee after: Hunan Chizhong Robotics Co.,Ltd.

Address before: No.8, Zhixin Road, robot industry base, Yuhua District, Changsha City, Hunan Province 410000

Patentee before: HUNAN CIZON ROBOTICS CO.,LTD.