CN105550676A - 基于线性ccd的物流运载车线迹跟踪方法 - Google Patents

基于线性ccd的物流运载车线迹跟踪方法 Download PDF

Info

Publication number
CN105550676A
CN105550676A CN201610073968.6A CN201610073968A CN105550676A CN 105550676 A CN105550676 A CN 105550676A CN 201610073968 A CN201610073968 A CN 201610073968A CN 105550676 A CN105550676 A CN 105550676A
Authority
CN
China
Prior art keywords
ccd
guide wire
tracking
dolly
trace
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
Application number
CN201610073968.6A
Other languages
English (en)
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.)
Tianjin Letu Software Technology Co Ltd
Original Assignee
Tianjin Letu Software 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 Tianjin Letu Software Technology Co Ltd filed Critical Tianjin Letu Software Technology Co Ltd
Priority to CN201610073968.6A priority Critical patent/CN105550676A/zh
Publication of CN105550676A publication Critical patent/CN105550676A/zh
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
    • G06Q10/00—Administration; Management
    • G06Q10/08—Logistics, e.g. warehousing, loading or distribution; Inventory or stock management

Landscapes

  • Engineering & Computer Science (AREA)
  • Business, Economics & Management (AREA)
  • Economics (AREA)
  • General Physics & Mathematics (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Entrepreneurship & Innovation (AREA)
  • Development Economics (AREA)
  • Multimedia (AREA)
  • Human Resources & Organizations (AREA)
  • Marketing (AREA)
  • Operations Research (AREA)
  • Quality & Reliability (AREA)
  • Strategic Management (AREA)
  • Tourism & Hospitality (AREA)
  • General Business, Economics & Management (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开一种基于线性CCD的物流运载车线迹跟踪方法。选用了线性CCD摄像头检测迹线信息，检测信息经过放大、滤波、A／D转换后送入单片机处理。信息处理中，建立了跟踪***的PID模型，通过历史经验累积得到物流运载车偏离迹线的方向和偏离程度，然后通过模糊自适应算法调整电机的转向速度和转向方向跟踪迹线。在设计中，由于采用深度累积历史迹线偏离方向与偏离程度的学***稳沿着迹线中心前进，从而完成物流运载车线迹跟踪。该线迹跟踪方法使得AGV控制的操作简化，同时保证其平稳性和精确性。

Description

基于线性CCD的物流运载车线迹跟踪方法
技术领域
本发明涉及自动导航物流运载车领域，特别是涉及一种基于线性CCD的物流运载车线迹跟踪方法。
背景技术
AGV（AutomatedGuidedVehicle）即自动导航物流运载车，是指装备有电磁或光学等自动导引装备，能够沿着规定路径行驶，具有安全保护以及各种移栽功能的运输车。而现有的AGV光电导航控制方式，大多数采用单排红外光电传感器阵列、面阵CCD或多组线性CCD组合使用，从而达到AGV沿着较为固定材质的导引轨道运行，且对于处理器也有一定的性能要求。
随着AGV自动导航物流运载车的技术快速发展，市场竞争日趋激烈，如何在保证产品质量稳定可靠的前提下，尽量缩减成本成为厂商所要重点考虑因素。
发明内容
本发明的目的在于提供一种步骤简单合理的基于线性CCD的物流运载车线迹跟踪方法。该方法选用了线性CCD摄像头检测迹线信息，检测信息经过放大、滤波、A／D转换后送入单片机处理。信息处理中，建立了跟踪***的PID模型，通过历史经验累积得到物流运载车偏离迹线的方向和偏离程度，然后通过模糊自适应算法调整电机的转向速度和转向方向跟踪迹线。在设计中，由于采用深度累积历史迹线偏离方向与偏离程度的学***稳沿着迹线中心前进，从而完成物流运载车线迹跟踪。
为实现上述目的，本发明通过以下技术方案来实现：
AGV物流运载车采用线性CCD横向检测导引线位置信息，依据线性CCD读取回来的数据信息计算分析当前物流运载车的行驶状态，在不同情况下采用不同的PID参数调整物流运载车电机驱动，从而物流运载车平稳循迹；
该物流运载车线迹跟踪方法包括以下步骤：
步骤1，线性CCD定时20ms周期扫描路面信息，经放大、滤波、A/D转换后传回CCD上128个像素点各像素值；步骤2，计算128个像素点的平均像素值；步骤3，根据步骤2中计算得到平均阈值，依据经验公式估算导引线边缘与***环境的像素跳变值；步骤4，在获取的128个像素值内寻找导引线左右边线位置，从而计算导引线中心位置；步骤5，将当前得到导引线中心位置与实际车体中心线转换到CCD像素上的位置比较，得到偏差，引入偏差到PID算法，该PID算法累积前十次偏离程度及趋势构成一定经验深度，从而更为准确的提供当前的偏离程度和偏离趋势；步骤6，将当前的偏差和偏离趋势引入到模糊算法中，经由模糊算法计算修正当前PID参数，进而得算出当前应调整差速值，车载控制器调整两驱动电机之间差速，执行纠偏过程。
与现有技术相比，本方法采用单一线性CCD识别引导路径，可采用胶带、反光带等低成本材料铺设，工作量大为简化，变更线路容易，算法简单可靠，采用模糊自适应调整PID参数，保证了AGV物流运载车稳定循迹。
附图说明
图1是本发明提供的一种AGV物流运载车循迹控制流程图。
具体实施方式
下面结合附图，对本发明的具体实施方式进行详细描述，但应当理解本发明的保护范围并不局限具体实施方式的限制。
除非另有其他明确表示，否则在整个说明书和权利要求书中，术语“包括”或其变换如“包含”或“包括有”等等将被理解为包括所陈述的元件或组成部分，而并未排除其它元件或其它组成部分。
如图1所示，根据本发明具体实施方式的基于线性CCD的物流运载车线迹跟踪方法包括以下步骤：
一种基于线性CCD的物流运载车线迹跟踪方法，其特征在于：该物流运载车采用线性CCD横向检测导引线位置信息，依据线性CCD读取回来的数据信息计算分析当前物流运载车的行驶状态，在不同情况下采用不同的PID参数调整物流运载车电机驱动，以期物流运载车平稳行驶：
该物流运载车线迹跟踪方法包括以下步骤：
步骤1，线性CCD定时20ms周期扫描路面信息，经放大、滤波、A/D转换后传回CCD上128个像素点各像素值；
步骤2，基于步骤1，计算128个像素点的平均像素值，若当前平均值大于设定像素值上限或小于像素值下限，估计当前物流运载车行驶脱轨，跳到步骤3；若当前平均值在设定范围内，跳到步骤4；
步骤3，基于步骤2，统计连续到达本步骤次数，若次数达到设定次数，则物流运载车停止，判定物流运载车脱轨；若未达到次数，则返回步骤1；
步骤4，根据步骤2中计算得到平均阈值，依据经验公式估算导引线边缘与***环境的像素跳变值；
步骤5，基于步骤4，在获取的128个像素值内寻找导引线左右边线位置，从而计算导引线中心位置，其中依据实际导引线线宽转换成在CCD中占据的像素点数，以此消非引导线干扰；若计算出当前有多个(一般2~3个）导引线中心位置，则说明当前处于分叉口，则依据路标或车载控制器要求的分叉方向，保留对应的导引线中心位置（如要求左分叉，则相对应导引线中心位置偏左的保留）；
步骤6，基于步骤5，将当前得到导引线中心位置与实际车体中心线转换到CCD像素上的位置比较，得到偏差，若无偏差或者在微小偏差范围内，则判断物流运载车当前应继续直行，返回步骤1；否则引入偏差到PID算法，该PID算法累积前十次偏离程度及趋势构成一定经验深度，从而更为准确的提供当前的偏离程度和偏离趋势；
步骤7，基于步骤6，将当前的偏差和偏离趋势引入到模糊算法中，经由模糊算法计算修正当前PID参数，进而得算出当前应调整差速值，车载控制器调整两驱动电机之间差速，执行纠偏过程。
综上，该基于线性CCD的物流运载车线迹跟踪方法采用线性CCD横向检测导引线位置信息，依据线性CCD读取回来的数据信息计算分析当前物流运载车的行驶状态，在不同情况下采用不同的PID参数调整物流运载车电机驱动，简化了传感器使用和线路铺设的同时保证了物流运载车平稳跟踪导引路径。

Claims (3)

1.一种基于线性CCD的小车线迹跟踪方法，其特征在于：该小车采用线性CCD横向检测导引线位置信息，依据线性CCD读取回来的数据信息计算分析当前小车的行驶状态，在不同情况下采用不同的PID参数调整小车电机驱动，从而小车平稳循迹：
该小车线迹跟踪方法包括以下步骤：
步骤1，线性CCD定时20ms周期扫描路面信息，经放大、滤波、A/D转换后传回CCD上128个像素点
各像素值；
步骤2，基于步骤1，计算128个像素点的平均像素值，若当前平均值大于设定像素值上限或小于像素值下限，估计当前小车行驶脱轨，跳到步骤3；若当前平均值在设定范围内，跳到步骤4；
步骤3，基于步骤2，统计连续到达本步骤次数，若次数达到设定次数，则小车停止，判定小车脱轨；若未达到次数，则返回步骤1；
步骤4，根据步骤2中计算得到平均阈值，依据经验公式估算导引线边缘与***环境的像素跳变值；
步骤5，基于步骤4，在获取的128个像素值内寻找导引线左右边线位置，从而计算导引线中心位置，其中依据实际导引线线宽转换成在CCD中占据的像素点数，以此消非引导线干扰；若计算出当前有多个导引线中心位置，则说明当前处于分叉口，则依据路标或车载控制器要求的分叉方向，保留对应的导引线中心位置；
步骤6，基于步骤5，将当前得到导引线中心位置与实际车体中心线转换到CCD像素上的位置比较，得到偏差，若无偏差或者在微小偏差范围内，则判断小车当前应继续直行，返回步骤1；否则引入偏差到PID算法，该PID算法累积前十次偏离程度及趋势构成一定经验深度，从而更为准确的提供当前的偏离程度和偏离趋势；
步骤7，基于步骤6，将当前的偏差和偏离趋势引入到模糊算法中，经由模糊算法计算修正当前PID参数，进而得算出当前应调整差速值，车载控制器调整两驱动电机之间差速，执行纠偏过程。
2.根据权利要求1所述一种基于线性CCD的小车线迹跟踪方法，其特征在于：线性CCD垂直于地面扫描，CCD传感器线性方向与导引线垂直，即与小车宽度方向一致。
3.根据权利要求1所述一种基于线性CCD的小车线迹跟踪方法，其特征在于：所述偏差，为导引线中心位置与实际车体中心反映到CCD图像的中心位置像素点数偏差。
CN201610073968.6A 2016-02-03 2016-02-03 基于线性ccd的物流运载车线迹跟踪方法 Pending CN105550676A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610073968.6A CN105550676A (zh) 2016-02-03 2016-02-03 基于线性ccd的物流运载车线迹跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610073968.6A CN105550676A (zh) 2016-02-03 2016-02-03 基于线性ccd的物流运载车线迹跟踪方法

Publications (1)

Publication Number Publication Date
CN105550676A true CN105550676A (zh) 2016-05-04

Family

ID=55829859

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610073968.6A Pending CN105550676A (zh) 2016-02-03 2016-02-03 基于线性ccd的物流运载车线迹跟踪方法

Country Status (1)

Country Link
CN (1) CN105550676A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109283931A (zh) * 2018-08-10 2019-01-29 中北大学 医疗病床运输车的线性ccd巡线***及巡线方法
CN110147042A (zh) * 2019-05-28 2019-08-20 金力 一种基于模糊控制结合pid控制的直立agv车体控制方法
CN110209162A (zh) * 2019-05-06 2019-09-06 珠海达明科技有限公司 一种基于阿克曼转向原理的四驱agv寻迹方法
CN112256009A (zh) * 2019-07-04 2021-01-22 深圳市越疆科技有限公司 寻线方法、装置、设备及可读存储介质

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1062919A (zh) * 1991-01-03 1992-07-22 山西太原钢铁公司 控制混合煤气热值压力稳定的方法
GB9815353D0 (en) * 1998-07-22 1998-09-16 Stout Kenneth J A portable temparature -controlled compartment for automated guided vehicles
CN101183265A (zh) * 2007-11-15 2008-05-21 浙江大学 基于射频识别标签和视觉的自动导引***及其方法
CN101603830A (zh) * 2009-06-23 2009-12-16 广州市井源机电设备有限公司 自动导航小车***及多任务控制方法
CN201494328U (zh) * 2009-06-23 2010-06-02 广州市井源机电设备有限公司 自动导航小车
CN102129221A (zh) * 2010-01-15 2011-07-20 丹纳赫西特传感工业控制（天津）有限公司 一种基于模糊控制的塑料挤出装置温度控制专用pid方法
CN102621985A (zh) * 2012-04-11 2012-08-01 中国农业大学 基于视觉和电磁的融合巡线导航控制***
CN102854878A (zh) * 2012-09-14 2013-01-02 苏州工业园区永动工业设备有限公司 红外光电导向agv装置及其控制方法
CN104635735A (zh) * 2014-12-03 2015-05-20 上海好创机电工程有限公司 一种新型agv视觉导航控制方法
CN104699104A (zh) * 2015-03-17 2015-06-10 武汉纺织大学 一种自适应agv视觉导航视线调整装置与线迹跟踪方法
CN105117892A (zh) * 2015-10-10 2015-12-02 广东轻工职业技术学院 一种自动化仓储管理方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1062919A (zh) * 1991-01-03 1992-07-22 山西太原钢铁公司 控制混合煤气热值压力稳定的方法
GB9815353D0 (en) * 1998-07-22 1998-09-16 Stout Kenneth J A portable temparature -controlled compartment for automated guided vehicles
CN101183265A (zh) * 2007-11-15 2008-05-21 浙江大学 基于射频识别标签和视觉的自动导引***及其方法
CN101603830A (zh) * 2009-06-23 2009-12-16 广州市井源机电设备有限公司 自动导航小车***及多任务控制方法
CN201494328U (zh) * 2009-06-23 2010-06-02 广州市井源机电设备有限公司 自动导航小车
CN102129221A (zh) * 2010-01-15 2011-07-20 丹纳赫西特传感工业控制（天津）有限公司 一种基于模糊控制的塑料挤出装置温度控制专用pid方法
CN102621985A (zh) * 2012-04-11 2012-08-01 中国农业大学 基于视觉和电磁的融合巡线导航控制***
CN102854878A (zh) * 2012-09-14 2013-01-02 苏州工业园区永动工业设备有限公司 红外光电导向agv装置及其控制方法
CN104635735A (zh) * 2014-12-03 2015-05-20 上海好创机电工程有限公司 一种新型agv视觉导航控制方法
CN104699104A (zh) * 2015-03-17 2015-06-10 武汉纺织大学 一种自适应agv视觉导航视线调整装置与线迹跟踪方法
CN105117892A (zh) * 2015-10-10 2015-12-02 广东轻工职业技术学院 一种自动化仓储管理方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
任柯燕 等: "基于模糊PID对AGV的纠偏控制", 《控制工程》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109283931A (zh) * 2018-08-10 2019-01-29 中北大学 医疗病床运输车的线性ccd巡线***及巡线方法
CN110209162A (zh) * 2019-05-06 2019-09-06 珠海达明科技有限公司 一种基于阿克曼转向原理的四驱agv寻迹方法
CN110147042A (zh) * 2019-05-28 2019-08-20 金力 一种基于模糊控制结合pid控制的直立agv车体控制方法
CN110147042B (zh) * 2019-05-28 2020-06-16 金力 一种基于模糊控制结合pid控制的直立agv车体控制方法
CN112256009A (zh) * 2019-07-04 2021-01-22 深圳市越疆科技有限公司 寻线方法、装置、设备及可读存储介质

Similar Documents

Publication Publication Date Title
US10696301B2 (en) Vehicle control device
EP3187953B1 (en) Autonomous working machine such as autonomous lawn mower
CN105550676A (zh) 基于线性ccd的物流运载车线迹跟踪方法
KR101926322B1 (ko) 차량 위치 추정 장치, 차량 위치 추정 방법
JP6497546B2 (ja) 走行制御装置
CN107065864A (zh) 磁条导航的单驱单向自动导引运输车纠偏控制***及方法
CN108052107A (zh) 一种融合磁条、磁钉和惯导的agv室内外复合导航***及方法
KR101758736B1 (ko) 감시 경계 로봇 시스템 및 경계 로봇 시스템에서 이동 로봇의 주행 방법
CN108955668A (zh) 一种融合二维码与色带的复合导航方法、装置及***
JP2017226270A (ja) 車両制御装置
KR101318560B1 (ko) 유도라인 추적 ａｇｖ의 유연한 주행 제어를 위한 영상 기반 유도라인 해석 방법
CN110502010A (zh) 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法
JP2008142841A (ja) 移動ロボット
CN104155975A (zh) 一种机器人的控制***及其控制方法
KR102062874B1 (ko) 무인 이송 장치
JP5461494B2 (ja) 自動走行車両及び自動走行車両の制御方法
JP2707546B2 (ja) 車両の操舵制御装置
Hong et al. Real-time mobile robot navigation based on stereo vision and low-cost GPS
JPH07296291A (ja) 車両用走行路検出装置
CN112526986B (zh) 跟垄作业方法和装置
KR20210054347A (ko) 영상 기반 경로 인식 및 조향각 산출 기술을 지원하는 자율 주행 농기계 장치 및 그 동작 방법
JP6690904B2 (ja) 自動走行車両
JP5024560B2 (ja) 移動体
JP7070905B2 (ja) 走行車両の走行制御装置
JP2009244965A (ja) 移動体

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into 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: 20160504