CN104503451A - 一种基于视觉和超声传感的可避障自动导航方法及自动导航车 - Google Patents

一种基于视觉和超声传感的可避障自动导航方法及自动导航车 Download PDF

Info

Publication number
CN104503451A
CN104503451A CN201410709815.7A CN201410709815A CN104503451A CN 104503451 A CN104503451 A CN 104503451A CN 201410709815 A CN201410709815 A CN 201410709815A CN 104503451 A CN104503451 A CN 104503451A
Authority
CN
China
Prior art keywords
barrier
navigation vehicle
navigation
sonac
turn
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
CN201410709815.7A
Other languages
English (en)
Other versions
CN104503451B (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.)
Guangdong Ruobo Intelligent Robot Co ltd
Original Assignee
South China Agricultural University
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 South China Agricultural University filed Critical South China Agricultural University
Priority to CN201410709815.7A priority Critical patent/CN104503451B/zh
Publication of CN104503451A publication Critical patent/CN104503451A/zh
Application granted granted Critical
Publication of CN104503451B publication Critical patent/CN104503451B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于视觉和超声传感的可避障自动导航方法及自动导航车。该自动导航车包括转向结构与驱动结构、SOC控制端、PC控制端、摄像头和九个以上的超声传感器;所述PC控制端负责图像处理和轨道跟踪的计算,所述SOC控制端负责超声避障动作,转向结构是依据阿克曼转向几何设计的梯形拉杆转向结构,驱动结构是利用差速器使两边车后轮以纯滚动的形式作不等距行驶,五个或以上的超声传感器安装在导航车的前方,另外有四个或以上的超声传感器安装在导航车的侧后方。该自动导航车能跟踪导轨和进行避障检测,而且机械结构简单,控制方便,具有较高的鲁棒性、准确性、实时性,简单实用,适合产业化推广。

Description

一种基于视觉和超声传感的可避障自动导航方法及自动导航车
技术领域
本发明涉及自动导航领域,特别涉及一种基于视觉和超声传感的可避障自动导航方法及自动导航车。
背景技术
自动导航车(Automatic Guided Vehicle,简称AGV),用于运载货物,能跟踪轨迹路线行驶,可以实现无人驾驶,与传统的运输方式相比具有更改路线成本低、运行噪声少、能源清洁等优点,在现代物流领域和工业领域都有着重要的地位。如今AGV向着一个高智能的方向发展:无人工干预、自主路径智能检测和导航、适应生产流程复杂多变,能运用到几乎所有搬运场合。传统的有线式视觉导航AGV是在路上铺设黑色或白色的条形导轨,但该导航方式很容易受到干扰且对环境要求高,在粉尘大,光线变化明显的环境下很容易产生误识别。同时,现有的视觉AGV设计一般只涉及视觉导航,涉及导航与避障的较少,或者避障的形式不可靠,然而避障环节可靠性反映AGV的智能程度且直接影响着运输过程中是否安全高效。此外,AGV的转向结构很多,传统的有单舵双驱式、双舵轮型、双轮差速转向驱动型、麦克纳姆轮等,这些机构适合不同的领域且有各自的缺陷,为了更好地控制AGV的转向,需要设计适合各种场合、转向平稳的转向机构。
发明内容
本发明的目的在于克服现有技术中存在的缺点,提供一种可以同时视觉导航与超声避障、具有较高鲁棒性、准确性、实时性的基于视觉和超声传感的可避障自动导航方法。
本发明的另一目的在于提供一种应用上述可避障自动导航方法、机械结构简单、控制方便的自动导航车。
本发明的目的通过下述技术方案实现:
一种基于视觉和超声传感的可避障自动导航方法,包括下述步骤:
(1)避障模块包括九个以上的超声传感器,分布在导航车的前方和侧后方,超声传感器用于采集车身周围的距离信息,以检测车身周围是否存在障碍物及其距离;开始导航时,首先采用导航车前方的超声传感器轮流采集障碍物的距离信息;然后对前方各个超声传感器收集的障碍物距离信息在单片机系统里进行模糊化,并根据模糊化信息来判断是否存在障碍物;
(2)如果存在障碍物,则停止视觉导航,并根据单片机系统得出的模糊化信息来判断障碍物的大概位置;然后使用障碍物模糊推理规则,控制导航车初步转向;同时,采用导航车侧后方的超声传感器测量障碍物的距离信息,当侧后方的超声传感器探测到有障碍物时,表明障碍物已经在导航车的侧后方,此时可以判断导航车已经越过障碍物;然后控制导航车进行回轨动作,回到视觉导航的轨道上;
(3)如果不存在障碍物,则继续由视觉模块来控制导航,即通过摄像头获取导航车前方的图像信息;通过自适应模糊(简称PID)控制,使导航车稳定地跟踪导轨。
步骤1中,所述模糊化,其步骤如下:设方向上的方向模糊子集为{左方(L),偏左方(LL),中间(M),偏右(LR),右(R)},距离上的距离模糊子集为{远(far),中(middle),近(close),死区(death)};其中,若前方超声传感器中最左边的超声传感器测出的障碍物距离最短,则理解为方向模糊子集中的左方,同理,若偏左方的超声传感器测出的障碍物距离最短,则理解为方向模糊子集中的偏左方,依次类推;其中,障碍物距离车头在区间[0cm,5cm)为距离模糊子集中的“死区”,障碍物距离车头在区间[5cm,35cm)为距离模糊子集中的“近”,障碍物距离车头产在区间[35cm,65cm)为距离模糊子集中的“中”;障碍物距离车头在区间[65cm,100cm)为距离模糊子集中的“远”;超出100cm可以认为忽略障碍物存在,即认为不存在障碍物;导航车前方的超声传感器以扇形放射式探测,当前方超声传感器探测出的障碍物距离大于100cm,则认为没有障碍物;当其中一个或多个前方超声传感器探测到的障碍物距离小于100cm,则认为有障碍物。
步骤2中,所述障碍物模糊推理规则是:(1)若障碍物在左方、远距离,则不作响应;(2)若障碍物在左方、中等距离,则偏右转,即导航车的前轮右偏转20°;(3)若障碍物在左方、近距离,则右转,即导航车的前轮右偏转40°;(4)若障碍物在偏左方、远距离,则偏右转,即导航车的前轮右偏转25°;(5)若障碍物在偏左方、中等距离,则右转,即导航车的前轮右偏转35°;(6)若障碍物在偏左方、近距离,则右转,即导航车的前轮右偏转45°;(7)若障碍物在偏右方、远距离,则偏左转,即导航车的前轮左偏转25°;(8)若障碍物在偏右方、中等距离,则左转,即导航车的前轮左偏转35°;(9)若障碍物在偏右方、近距离,则左转,即导航车的前轮左偏转45°;(10)若障碍物在右方、远距离,则不作响应;(11)若障碍物在右方、中等距离,则偏左转,即导航车的前轮左偏转20°;(12)若障碍物在右方、近距离,则左转,即导航车的前轮左偏转40°;(13)若障碍物距离在死区距离,则停车;(14)若障碍物在中间、远距离,则右转,即导航车的前轮右偏转30°;(15)若障碍物在中间,中等距离,则右转,即导航车的前轮右偏转45°;(16)若障碍物在中间,近距离、则停车。
步骤3中,所述自适应模糊控制是:首先通过对图像进行色调-饱和度-亮度色彩模型(HSV)与红-绿-蓝色彩模型(RGB)分割,加权叠加成新的灰度图;然后提取边缘点,并通过邻域对比度判断、梯度判断、标准差判断,过滤边缘点;再根据导航车前方距离,从上而下分割图像成N个图像片段,并使用霍夫变换探测各个图像片段中道路信息边缘点的直线,以形成道路信息;得出道路信息后,由于事先对摄像头进行了标定,求出了投影变换矩阵,因此通过投影变换矩阵求出图像上的道路信息点的实际三维位置;然后,以图像道路信息点集的拟合曲线与图像顶端的交点T以及△T联合决定PID的控制参数,以T与下方中点的连线与导航车朝向的夹角a作为输出反馈,组成自适应模糊PID控制系统。
在自适应模糊导航控制中,由于导航车的结构和数学模型已经确定,导航车朝向的夹角a与转向结构的时间关系确定,因此可以根据数学模型设计合适的PID参数的模糊推理规则,并用于MATLAB仿真验证;仿真验证后,根据上述的导航车数学模型和仿真得出的模糊PID参数进行控制系统的实物验证,控制转向结构的实时转向,让AGV始终沿着预先铺设的轨道进行视觉导航。
一种基于视觉导航和超声传感的自动导航车,采用上述可避障自动导航方法进行导航,包括导航车的转向结构与驱动结构、单片机系统(SOC)控制端、个人电脑(PC)控制端、摄像头和九个以上的超声传感器;所述PC控制端负责图像处理和轨道跟踪的计算,从摄像头中获取导航车前方的导轨图像,通过图像处理,分析计算,坐标换算,得出导航车前方的路径信息,建立行驶的数学模型,通过自适应模糊PID算法,控制导航车对导轨进行跟踪;所述SOC控制端负责超声避障动作,控制多个超声传感器对前方的障碍物位置进行检测,当出现障碍物时,可以检测到障碍物位置,并在导航车侧后方超声传感器的配合下,完成绕过障碍物的动作;所述导航车的转向结构与驱动结构,其中转向结构是依据阿克曼转向几何设计的梯形拉杆转向结构,使用U型杆带动梯形拉杆左右运动,从而改变车的转向圆心和转动半径,驱动结构是单电机驱动,利用差速器使两边车后轮以纯滚动的形式作不等距行驶,减少轮胎与地面的摩擦,使转向过程转弯更加平稳顺畅;所述超声传感器,其中五个或以上的超声传感器安装在导航车的前方,以弧形放射式探测导航车前方,另外有四个或以上的超声传感器安装在导航车的侧后方。
所述SOC控制端,用于控制所有的超声传感器;并且SOC控制端内嵌有模糊推断算法,在检测到障碍物位置后能规划导航车的避障轨迹,控制导航车绕过障碍物;没有障碍物情况下,SOC端能接收PC控制端发来的转向信息,转换成控制信号,控制导航车的转向。
所述PC控制端,是装有自主开发的AGV导航信息软件,是人与导航车人机交互的通道,集成图像处理与道路识别算法、转向计算算法、导航车参数设置、通讯模块及其设置、实时信息反馈显示这几个模块;其中,图像处理与道路识别算法,是分别使用HSV&RGB双颜色空间分割,对比度、邻域梯度、标准差过滤边沿点,区域分割和霍夫变换求出道路信息;转向计算算法,是根据导航车的运动数学模型,和自适应模糊PID控制器,计算转向的幅度;通讯模块会把转向计算的数据发送至SOC控制端,同时也会接收SOC控制端的避障模式下的数据;导航车的参数设置包括图像处理算法阈值的设置、PID调节器、转向计算阈值设置,AGV速度设置,可根据实际情况微调算法的参数以适应各种环境;实时信息反馈模块,能显示和记录AGV行走时的实时数据,包括图像处理数据、转向数据、移动速度数据、通讯数据。
所述摄像头安装在车身顶部的前方中间,光轴45度朝向地面。
所述超声传感器的数量优选9个,其中5个以放射式探测方式并排放置于导航车的车身正前方,2个安装在车身两侧的后方,探测方向分别垂直于车身两侧部,2个分别安装在车身左右两侧的后方,探测方向为与车身两侧成45度向后。
所述U型杆是采用数字舵机或带编码器的直流减速电机带动。
所述转向结构的转向过程如下:SOC控制端发送控制信号到数字舵机或者带编码器的直流减速电机,数字舵机或直流减速电机根据控制信号带动U型杆,然后U型杆旋转并拉动拉杆左右运动,使得导航车的两个前轮发生转向;SOC控制端根据转弯需求,发送控制信号到导航车后轮的驱动电机,驱动电机经过减速箱,加大驱动力度,同时,经过差速器使导航车的两后轮以不等距行驶,转向平稳。
导航车的自动导航过程如下:启动后,SOC控制端实时监控前方的障碍物信息,如果前方没有障碍物,则进入视觉导航模式,PC控制端通过摄像头实时获取图像,并进行图像处理和转向计算,通过串口把转向数据发送至SOC控制端,由SOC控制端来控制前轮转向;当前方出现障碍物时,进入避障模式,通过前方超声传感器的模糊推断,大致得出前方障碍物的具体位置,通过各个传感器的配合监控及SOC控制端的转向控制,绕开障碍物;同时,SOC控制端一直负责后轮的驱动控制。
本发明与现有技术相比具有如下优点和效果:
(1)本发明使用PC控制端与SOC控制端协同检测控制,能跟踪导轨和进行避障检测,而且机械结构简单,控制方便,具有较高的鲁棒性、准确性、实时性,简单实用,适合产业化推广。
(2)本发明依据阿克曼转向几何设计的转向结构,可以通过数学模型求出转动半径及转向圆心,易于精确控制。
附图说明
图1为基于视觉和超声传感的可避障自动导航控制流程图
图2为传感器位置图
图3为导航车转向驱动结构图
图4为导航车的控制流程图
图5为自适应模糊PID模糊表
图中:1、摄像头;2、侧后方的超声传感器;3、前方的超声传感器;4、U型杆;5、后轮驱动电机;6、齿轮减速器;7、差速器;8、梯形拉杆。
具体实施方式
下面结合实施例对本发明做进一步详细的描述,但本发明的实施方式不限于此。
实施例1
自动导航车,采用如图1所示的基于视觉和超声传感的可避障自动导航控制流程图进行自动导航,包括导航车的转向结构与驱动结构、单片机系统(SOC)控制端、个人电脑(PC)控制端、摄像头和超声传感器。
如图2所示,摄像头1为互补金属氧化物半导体(简称COMS)摄像头,安装在车身顶部的前方中间,光轴45度朝向地面;导航车有9个超声传感器,型号为HC-SR04,其中五个前方的超声传感器3以放射式探测方式并排放置于导航车的车身正前方,两个侧后方的超声传感器2安装在车身两侧的后方,探测方向分别垂直于车身两侧部,另外两个侧后方的超声传感器2分别安装在车身左右两侧的后方,探测方向为与车身两侧成45度向后。
PC控制端负责图像处理和轨道跟踪的计算,从摄像头中获取导航车前方的导轨图像,通过图像处理,分析计算,坐标换算,得出导航车前方的路径信息,建立行驶的数学模型,通过自适应模糊PID算法,控制导航车对导轨进行跟踪。
所述SOC控制端负责超声避障动作,控制多个超声传感器对前方的障碍物位置进行检测,当出现障碍物时,可以检测到障碍物位置,并在导航车侧后方超声传感器的配合下,完成绕过障碍物的动作,导航车的控制流程图如图4所示。
所述导航车的转向结构与驱动结构,如图3所示。转向结构是依据阿克曼转向几何设计的梯形拉杆转向结构,使用U型杆4带动梯形拉杆8左右运动,从而改变车的转向圆心和转动半径,U型杆4是采用数字舵机或带编码器的直流减速电机带动。所述转向结构的转向过程如下:SOC控制端发送控制信号到数字舵机或者带编码器的直流减速电机,数字舵机或直流减速电机根据控制信号带动U型杆4,然后U型杆4旋转并拉动梯形拉杆8左右运动,使得导航车的两个前轮发生转向;SOC控制端根据转弯需求,发送控制信号到导航车后轮的驱动电机,驱动电机经过齿轮减速箱6,加大驱动力度,同时,经过差速器7使导航车的两后轮以不等距行驶,转向平稳。驱动结构为减速电机传动到差速器7的输入轴,两轮的轴为了适应高承重,在轴上使用多个轴承,采用后轮驱动电机5驱动,利用差速器7使两边车后轮以纯滚动的形式作不等距行驶,减少轮胎与地面的摩擦,使转向过程转弯更加平稳顺畅;同时前轮通过梯形拉杆8来转向,梯形拉杆8的运动由U型杆4带动,U型杆4的运动由舵机或者带编码器减速直流电机带动,从而控制前轮的转向。
所述SOC控制端,是使用STM32F103VET6(单片机型号以cortex-M3为内核)作为处理核心,串口通讯使用rs232模块,电机控制使用脉冲宽度调变(PWM)控制,用于控制所有的超声传感器;并且SOC控制端内嵌有模糊推断算法,在检测到障碍物位置后能规划导航车的避障轨迹,控制导航车绕过障碍物;没有障碍物情况下,SOC端能接收PC控制端发来的转向信息,转换成控制信号,控制导航车的转向。
所述PC控制端,是装有自主开发的AGV导航信息软件,是人与导航车人机交互的通道,集成图像处理与道路识别算法、转向计算算法、导航车参数设置、通讯模块及其设置、实时信息反馈显示这几个模块;其中,图像处理与道路识别算法,是分别使用HSV&RGB双颜色空间分割,对比度、邻域梯度、标准差过滤边沿点,区域分割和霍夫变换求出道路信息;转向计算算法,是根据导航车的运动数学模型,和自适应模糊PID控制器,计算转向的幅度;通讯模块会把转向计算的数据发送至SOC控制端,同时也会接收SOC控制端的避障模式下的数据;导航车的参数设置包括图像处理算法阈值的设置、PID调节器、转向计算阈值设置,AGV速度设置,可根据实际情况微调算法的参数以适应各种环境;实时信息反馈模块,能显示和记录AGV行走时的实时数据,包括图像处理数据、转向数据、移动速度数据、通讯数据。
导航车的自动导航过程如下:首先在PC端打开AGV导航信息软件,根据场地来微调各种参数后启动导航车;启动后,车身前方超声传感器开始采集距离信息并模糊化,五个前方的超声传感器轮流测距,由于轮流测距的速度快,几乎可以认为是同时测距,通过比较五个前方的超声传感器测出的距离大小,障碍物可以认为是位于距离最小的超声传感器的朝向方向中;已预先建立小车运动的数学模型,通过对道路信息点进行初步处理,转变成自适应PID的输入数据,通过自适应模糊PID得出转向数据,所述自适应模糊PID的模糊表如图5所示;SOC控制端实时监控前方的障碍物信息,如果前方没有障碍物,则进入视觉导航模式,PC控制端通过摄像头实时获取图像,并进行图像处理和转向计算,通过串口把转向数据发送至SOC控制端,由SOC控制端来控制前轮转向;当前方出现障碍物时,进入避障模式,通过前方超声传感器的模糊推断,大致得出前方障碍物的具体位置,通过各个传感器的配合监控及SOC控制端的转向控制,绕开障碍物;同时,SOC控制端一直负责后轮的驱动控制。完成一次流程后,重新执行第一步,超声传感器采集距离信息并模糊化。

Claims (9)

1.一种基于视觉和超声传感的可避障自动导航方法,其特征在于包括下述步骤:
(1)避障模块包括九个以上的超声传感器,分布在导航车的前方和侧后方,超声传感器用于采集车身周围的距离信息,以检测车身周围是否存在障碍物及其距离;开始导航时,首先采用导航车前方的超声传感器轮流采集障碍物的距离信息;然后对前方各个超声传感器收集的障碍物距离信息在单片机系统里进行模糊化,并根据模糊化信息来判断是否存在障碍物;
(2)如果存在障碍物,则停止视觉导航,并根据单片机系统得出的模糊化信息来判断障碍物的大概位置;然后使用障碍物模糊推理规则,控制导航车初步转向;同时,采用导航车侧后方的超声传感器测量障碍物的距离信息,当侧后方的超声传感器探测到有障碍物时,表明障碍物已经在导航车的侧后方,此时可以判断导航车已经越过障碍物;然后控制导航车进行回轨动作,回到视觉导航的轨道上;
(3)如果不存在障碍物,则继续由视觉模块来控制导航,即通过摄像头获取导航车前方的图像信息;通过自适应模糊控制,使导航车稳定地跟踪导轨。
2.根据权利要求1所述的可避障自动导航方法,其特征在于:步骤1中,所述模糊化,其步骤如下:设方向上的方向模糊子集为{左方(L),偏左方(LL),中间(M),偏右(LR),右(R)},距离上的距离模糊子集为{远(far),中(middle),近(close),死区(death)};其中,若前方超声传感器中最左边的超声传感器测出的障碍物距离最短,则理解为方向模糊子集中的左方,同理,若偏左方的超声传感器测出的障碍物距离最短,则理解为方向模糊子集中的偏左方,依次类推;其中,障碍物距离车头在区间[0cm,5cm)为距离模糊子集中的“死区”,障碍物距离车头在区间[5cm,35cm)为距离模糊子集中的“近”,障碍物距离车头产在区间[35cm,65cm)为距离模糊子集中的“中”;障碍物距离车头在区间[65cm,100cm)为距离模糊子集中的“远”;超出100cm可以认为忽略障碍物存在,即认为不存在障碍物;导航车前方的超声传感器以扇形放射式探测,当前方超声传感器探测出的障碍物距离大于100cm,则认为没有障碍物;当其中一个或多个前方超声传感器探测到的障碍物距离小于100cm,则认为有障碍物。
3.根据权利要求1所述的可避障自动导航方法,其特征在于:步骤2中,所述障碍物模糊推理规则是:(1)若障碍物在左方、远距离,则不作响应;(2)若障碍物在左方、中等距离,则偏右转,即导航车的前轮右偏转20°;(3)若障碍物在左方、近距离,则右转,即导航车的前轮右偏转40°;(4)若障碍物在偏左方、远距离,则偏右转,即导航车的前轮右偏转25°;(5)若障碍物在偏左方、中等距离,则右转,即导航车的前轮右偏转35°;(6)若障碍物在偏左方、近距离,则右转,即导航车的前轮右偏转45°;(7)若障碍物在偏右方、远距离,则偏左转,即导航车的前轮左偏转25°;(8)若障碍物在偏右方、中等距离,则左转,即导航车的前轮左偏转35°;(9)若障碍物在偏右方、近距离,则左转,即导航车的前轮左偏转45°;(10)若障碍物在右方、远距离,则不作响应;(11)若障碍物在右方、中等距离,则偏左转,即导航车的前轮左偏转20°;(12)若障碍物在右方、近距离,则左转,即导航车的前轮左偏转40°;(13)若障碍物距离在死区距离,则停车;(14)若障碍物在中间、远距离,则右转,即导航车的前轮右偏转30°;(15)若障碍物在中间,中等距离,则右转,即导航车的前轮右偏转45°;(16)若障碍物在中间,近距离、则停车。
4.根据权利要求1所述的可避障自动导航方法,其特征在于:步骤3中,所述自适应模糊控制是:首先通过对图像进行色调-饱和度-亮度色彩模型与红-绿-蓝色彩模型分割,加权叠加成新的灰度图;然后提取边缘点,并通过邻域对比度判断、梯度判断、标准差判断,过滤边缘点;再根据导航车前方距离,从上而下分割图像成N个图像片段,并使用霍夫变换探测各个图像片段中道路信息边缘点的直线,以形成道路信息;得出道路信息后,由于事先对摄像头进行了标定,求出了投影变换矩阵,因此通过投影变换矩阵求出图像上的道路信息点的实际三维位置;然后,以图像道路信息点集的拟合曲线与图像顶端的交点T以及△T联合决定PID的控制参数,以T与下方中点的连线与导航车朝向的夹角a作为输出反馈,组成自适应模糊PID控制系统。
5.一种基于视觉导航和超声传感的自动导航车,其特征在于:包括导航车的转向结构与驱动结构、SOC控制端、PC控制端、摄像头和九个以上的超声传感器;所述PC控制端负责图像处理和轨道跟踪的计算,从摄像头中获取导航车前方的导轨图像,通过图像处理,分析计算,坐标换算,得出导航车前方的路径信息,建立行驶的数学模型,通过自适应模糊PID算法,控制导航车对导轨进行跟踪;所述SOC控制端负责超声避障动作,控制多个超声传感器对前方的障碍物位置进行检测,当出现障碍物时,可以检测到障碍物位置,并在导航车侧后方超声传感器的配合下,完成绕过障碍物的动作;所述导航车的转向结构与驱动结构,其中转向结构是依据阿克曼转向几何设计的梯形拉杆转向结构,使用U型杆带动梯形拉杆左右运动,从而改变车的转向圆心和转动半径,驱动结构是单电机驱动,利用差速器使两边车后轮以纯滚动的形式作不等距行驶,减少轮胎与地面的摩擦,使转向过程转弯更加平稳顺畅;所述超声传感器,其中五个或以上的超声传感器安装在导航车的前方,以弧形放射式探测导航车前方,另外有四个或以上的超声传感器安装在导航车的侧后方。
6.根据权利要求5所述的自动导航车,其特征在于:所述SOC控制端,用于控制所有的超声传感器;并且SOC控制端内嵌有模糊推断算法,在检测到障碍物位置后能规划导航车的避障轨迹,控制导航车绕过障碍物;没有障碍物情况下,SOC端能接收PC控制端发来的转向信息,转换成控制信号,控制导航车的转向。
7.根据权利要求5所述的自动导航车,其特征在于:所述PC控制端,是装有AGV导航信息软件,是人与导航车人机交互的通道,集成图像处理与道路识别算法、转向计算算法、导航车参数设置、通讯模块及其设置、实时信息反馈显示这几个模块;其中,图像处理与道路识别算法,是分别使用HSV&RGB双颜色空间分割,对比度、邻域梯度、标准差过滤边沿点,区域分割和霍夫变换求出道路信息;转向计算算法,是根据导航车的运动数学模型,和自适应模糊PID控制器,计算转向的幅度;通讯模块会把转向计算的数据发送至SOC控制端,同时也会接收SOC控制端的避障模式下的数据;导航车的参数设置包括图像处理算法阈值的设置、PID调节器、转向计算阈值设置,AGV速度设置,可根据实际情况微调算法的参数以适应各种环境;实时信息反馈模块,能显示和记录AGV行走时的实时数据,包括图像处理数据、转向数据、移动速度数据、通讯数据。
8.根据权利要求5所述的自动导航车,其特征在于:所述超声传感器的数量为9个,其中5个以放射式探测方式并排放置于导航车的车身正前方,2个安装在车身两侧的后方,探测方向分别垂直于车身两侧部,2个分别安装在车身左右两侧的后方,探测方向为与车身两侧成45度向后。
9.根据权利要求5所述的自动导航车,其特征在于:所述U型杆是采用数字舵机或带编码器的直流减速电机带动。
CN201410709815.7A 2014-11-27 2014-11-27 一种基于视觉和超声传感的可避障自动导航方法及自动导航车 Active CN104503451B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410709815.7A CN104503451B (zh) 2014-11-27 2014-11-27 一种基于视觉和超声传感的可避障自动导航方法及自动导航车

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410709815.7A CN104503451B (zh) 2014-11-27 2014-11-27 一种基于视觉和超声传感的可避障自动导航方法及自动导航车

Publications (2)

Publication Number Publication Date
CN104503451A true CN104503451A (zh) 2015-04-08
CN104503451B CN104503451B (zh) 2017-05-24

Family

ID=52944855

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410709815.7A Active CN104503451B (zh) 2014-11-27 2014-11-27 一种基于视觉和超声传感的可避障自动导航方法及自动导航车

Country Status (1)

Country Link
CN (1) CN104503451B (zh)

Cited By (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104898675A (zh) * 2015-06-05 2015-09-09 东华大学 一种机器人智能导航控制方法
CN105334856A (zh) * 2015-11-24 2016-02-17 大连楼兰科技股份有限公司 一种基于can网络总线的车转向系统控制设备
CN105425800A (zh) * 2015-12-07 2016-03-23 吉林大学 一种基于预瞄的无人全地形车的控制方法
CN105564231A (zh) * 2015-09-29 2016-05-11 洛阳博智自动控制技术有限公司 一种agv小车三向送料的控制方法
CN106249739A (zh) * 2016-08-26 2016-12-21 广州小瓦智能科技有限公司 一种高性能机器人防撞移动算法
CN106325285A (zh) * 2016-11-05 2017-01-11 杭州畅动智能科技有限公司 一种基于水下避障装置的控制方法
CN106444758A (zh) * 2016-09-27 2017-02-22 华南农业大学 一种基于机器视觉的道路识别与路径优选的agv运输车及其控制系统
CN107174457A (zh) * 2017-07-04 2017-09-19 沈阳建筑大学 一种全自动视觉引导护士车及其控制方法
CN107874229A (zh) * 2017-05-31 2018-04-06 华南理工大学 一种用于酱油发酵罐盐水匀料的自动装置
CN108279685A (zh) * 2018-03-21 2018-07-13 福建工程学院 一种基于视觉跟随的搬运小车及工作方法
CN108710364A (zh) * 2018-04-09 2018-10-26 济南大学 一种现代物流中自动导引避障机器人小车及其控制方法
CN109116853A (zh) * 2018-09-14 2019-01-01 广州供电局有限公司 基于工具车的自主导航系统及工具车
CN109318987A (zh) * 2018-11-01 2019-02-12 河南科技大学 一种车辆
CN109696169A (zh) * 2019-03-07 2019-04-30 齐鲁工业大学 基于agv小车的凹形障碍物避障导航方法及装置、agv小车
CN109920246A (zh) * 2019-02-22 2019-06-21 重庆邮电大学 一种基于v2x通信与双目视觉的协同局部路径规划方法
CN109947111A (zh) * 2019-04-04 2019-06-28 肖卫国 一种自动搬运小车移动控制方法、装置及自动搬运小车
CN111309008A (zh) * 2020-02-18 2020-06-19 南京师范大学 一种基于色彩识别的移动机器人导航方法
CN111436236A (zh) * 2020-04-30 2020-07-24 黑龙江省农业科学院耕作栽培研究所 一种基于导航系统的秸秆还田机械装置
CN112212887A (zh) * 2020-08-27 2021-01-12 武汉乐庭软件技术有限公司 一种基于阿克曼转向模型的自动泊车定位参数标定方法
CN112977668A (zh) * 2019-12-02 2021-06-18 上海宽带技术及应用工程研究中心 自动驾驶载人小车
CN113703448A (zh) * 2021-08-19 2021-11-26 深圳亿嘉和科技研发有限公司 一种基于超声波的阿克曼底盘避障控制方法
CN113777484A (zh) * 2021-11-11 2021-12-10 四川赛康智能科技股份有限公司 一种gis缺陷检测装置及方法
CN113928443A (zh) * 2020-06-25 2022-01-14 东北林业大学 基于视觉导航的农用agv运输车
CN114355358A (zh) * 2021-12-10 2022-04-15 厦门攸信信息技术有限公司 基于超声波测距的智能避障装置及其避障方法
TWI834764B (zh) * 2019-01-10 2024-03-11 日商大福股份有限公司 物品搬送裝置

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090228166A1 (en) * 2006-01-18 2009-09-10 I-Guide, Llc Robotic Vehicle Controller
CN101608924A (zh) * 2009-05-20 2009-12-23 电子科技大学 一种基于灰度估计和级联霍夫变换的车道线检测方法
CN202093392U (zh) * 2011-05-19 2011-12-28 苏州市职业大学 一种agv系统的硬件平台
CN102608998A (zh) * 2011-12-23 2012-07-25 南京航空航天大学 嵌入式系统的视觉导引agv系统及方法
CN102621986A (zh) * 2012-04-13 2012-08-01 西北农林科技大学 一种基于视觉和超声波的导航控制系统
EP2511782A2 (en) * 2011-04-12 2012-10-17 LG Electronics Inc. Robot cleaner, and remote monitoring system and method of the same
CN102789233A (zh) * 2012-06-12 2012-11-21 湖北三江航天红峰控制有限公司 基于视觉的组合导航机器人及导航方法
US20130096717A1 (en) * 2011-10-18 2013-04-18 Samsung Electronics Co., Ltd. Robot cleaner and method for controlling the same
CN103226354A (zh) * 2013-02-27 2013-07-31 广东工业大学 基于光电导航的无人驾驶道路识别系统
CN103955216A (zh) * 2014-04-22 2014-07-30 华南理工大学 一种自动导引车两级复合避障装置
CN104049634A (zh) * 2014-07-02 2014-09-17 燕山大学 基于Camshift算法的智能体模糊动态避障方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090228166A1 (en) * 2006-01-18 2009-09-10 I-Guide, Llc Robotic Vehicle Controller
CN101608924A (zh) * 2009-05-20 2009-12-23 电子科技大学 一种基于灰度估计和级联霍夫变换的车道线检测方法
EP2511782A2 (en) * 2011-04-12 2012-10-17 LG Electronics Inc. Robot cleaner, and remote monitoring system and method of the same
CN202093392U (zh) * 2011-05-19 2011-12-28 苏州市职业大学 一种agv系统的硬件平台
US20130096717A1 (en) * 2011-10-18 2013-04-18 Samsung Electronics Co., Ltd. Robot cleaner and method for controlling the same
CN102608998A (zh) * 2011-12-23 2012-07-25 南京航空航天大学 嵌入式系统的视觉导引agv系统及方法
CN102621986A (zh) * 2012-04-13 2012-08-01 西北农林科技大学 一种基于视觉和超声波的导航控制系统
CN102789233A (zh) * 2012-06-12 2012-11-21 湖北三江航天红峰控制有限公司 基于视觉的组合导航机器人及导航方法
CN103226354A (zh) * 2013-02-27 2013-07-31 广东工业大学 基于光电导航的无人驾驶道路识别系统
CN103955216A (zh) * 2014-04-22 2014-07-30 华南理工大学 一种自动导引车两级复合避障装置
CN104049634A (zh) * 2014-07-02 2014-09-17 燕山大学 基于Camshift算法的智能体模糊动态避障方法

Cited By (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104898675A (zh) * 2015-06-05 2015-09-09 东华大学 一种机器人智能导航控制方法
CN105564231A (zh) * 2015-09-29 2016-05-11 洛阳博智自动控制技术有限公司 一种agv小车三向送料的控制方法
CN105334856A (zh) * 2015-11-24 2016-02-17 大连楼兰科技股份有限公司 一种基于can网络总线的车转向系统控制设备
CN105425800A (zh) * 2015-12-07 2016-03-23 吉林大学 一种基于预瞄的无人全地形车的控制方法
CN106249739A (zh) * 2016-08-26 2016-12-21 广州小瓦智能科技有限公司 一种高性能机器人防撞移动算法
CN106444758A (zh) * 2016-09-27 2017-02-22 华南农业大学 一种基于机器视觉的道路识别与路径优选的agv运输车及其控制系统
CN106444758B (zh) * 2016-09-27 2019-07-23 华南农业大学 一种基于机器视觉的道路识别与路径优选的agv运输车
CN106325285A (zh) * 2016-11-05 2017-01-11 杭州畅动智能科技有限公司 一种基于水下避障装置的控制方法
CN107874229A (zh) * 2017-05-31 2018-04-06 华南理工大学 一种用于酱油发酵罐盐水匀料的自动装置
CN107174457A (zh) * 2017-07-04 2017-09-19 沈阳建筑大学 一种全自动视觉引导护士车及其控制方法
CN108279685A (zh) * 2018-03-21 2018-07-13 福建工程学院 一种基于视觉跟随的搬运小车及工作方法
CN108279685B (zh) * 2018-03-21 2024-01-16 福建工程学院 一种基于视觉跟随的搬运小车及工作方法
CN108710364A (zh) * 2018-04-09 2018-10-26 济南大学 一种现代物流中自动导引避障机器人小车及其控制方法
CN109116853A (zh) * 2018-09-14 2019-01-01 广州供电局有限公司 基于工具车的自主导航系统及工具车
CN109116853B (zh) * 2018-09-14 2023-10-24 广东电网有限责任公司广州供电局 基于工具车的自主导航系统及工具车
CN109318987A (zh) * 2018-11-01 2019-02-12 河南科技大学 一种车辆
TWI834764B (zh) * 2019-01-10 2024-03-11 日商大福股份有限公司 物品搬送裝置
CN109920246B (zh) * 2019-02-22 2022-02-11 重庆邮电大学 一种基于v2x通信与双目视觉的协同局部路径规划方法
CN109920246A (zh) * 2019-02-22 2019-06-21 重庆邮电大学 一种基于v2x通信与双目视觉的协同局部路径规划方法
CN109696169A (zh) * 2019-03-07 2019-04-30 齐鲁工业大学 基于agv小车的凹形障碍物避障导航方法及装置、agv小车
CN109947111A (zh) * 2019-04-04 2019-06-28 肖卫国 一种自动搬运小车移动控制方法、装置及自动搬运小车
CN112977668A (zh) * 2019-12-02 2021-06-18 上海宽带技术及应用工程研究中心 自动驾驶载人小车
CN111309008A (zh) * 2020-02-18 2020-06-19 南京师范大学 一种基于色彩识别的移动机器人导航方法
CN111436236A (zh) * 2020-04-30 2020-07-24 黑龙江省农业科学院耕作栽培研究所 一种基于导航系统的秸秆还田机械装置
CN113928443A (zh) * 2020-06-25 2022-01-14 东北林业大学 基于视觉导航的农用agv运输车
CN112212887A (zh) * 2020-08-27 2021-01-12 武汉乐庭软件技术有限公司 一种基于阿克曼转向模型的自动泊车定位参数标定方法
CN112212887B (zh) * 2020-08-27 2022-07-05 武汉乐庭软件技术有限公司 一种基于阿克曼转向模型的自动泊车定位参数标定方法
CN113703448A (zh) * 2021-08-19 2021-11-26 深圳亿嘉和科技研发有限公司 一种基于超声波的阿克曼底盘避障控制方法
CN113703448B (zh) * 2021-08-19 2024-06-21 深圳亿嘉和科技研发有限公司 一种基于超声波的阿克曼底盘避障控制方法
CN113777484B (zh) * 2021-11-11 2022-01-25 四川赛康智能科技股份有限公司 一种gis缺陷检测装置及方法
CN113777484A (zh) * 2021-11-11 2021-12-10 四川赛康智能科技股份有限公司 一种gis缺陷检测装置及方法
CN114355358A (zh) * 2021-12-10 2022-04-15 厦门攸信信息技术有限公司 基于超声波测距的智能避障装置及其避障方法

Also Published As

Publication number Publication date
CN104503451B (zh) 2017-05-24

Similar Documents

Publication Publication Date Title
CN104503451A (zh) 一种基于视觉和超声传感的可避障自动导航方法及自动导航车
CN102789233B (zh) 基于视觉的组合导航机器人及导航方法
CN109279543B (zh) 一种叉车式agv磁导轨跟踪控制系统及方法
CN108052107B (zh) 一种融合磁条、磁钉和惯导的agv室内外复合导航系统及方法
CN103661599B (zh) 一种车辆转弯轨迹预测系统和方法
CN201926927U (zh) 智能循迹小车
CN107963126B (zh) 一种多轴转向车辆大曲率自动驾驶转向控制方法
CN111399505B (zh) 一种基于神经网络的移动机器人避障方法
CN110361013B (zh) 一种用于车辆模型的路径规划系统及方法
CN102269995B (zh) 轮式移动机器人的变结构控制方法
CN107065864A (zh) 磁条导航的单驱单向自动导引运输车纠偏控制系统及方法
CN106200648B (zh) 具有路径记忆功能的智能运货小车
CN103383570A (zh) 一种可全向移动的自动导航小车
CN206657243U (zh) 磁条导航的单驱单向自动导引运输车纠偏控制系统
CN109606506A (zh) 一种对角驱动转向的控制方法
CN110103998B (zh) 非对称四舵轮agv转向及平移运动的控制方法
CN110794834A (zh) 一种基于后驱前转向的搬运汽车控制系统
CN201965486U (zh) 智能循迹小车
CN117707067A (zh) 一种智能agv小车
CN104914861A (zh) 一种双舵机四轮驱动全方位超声波探测的小车
CN205507541U (zh) 一种气味源搜索定位小车
CN105005299A (zh) 一种智能变速巡线避障小车
Cui et al. AGV research based on inertial navigation and vision fusion
CN207937872U (zh) 一种避障小车
CN205721371U (zh) 一种磁导航agv控制系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220628

Address after: 528251 603-2, floor 6, block a, Jingu Zhichuang industrial community, No. 2, Yong'an North Road, Dawei community, Guicheng Street, Nanhai District, Foshan City, Guangdong Province

Patentee after: GUANGDONG RUOBO INTELLIGENT ROBOT CO.,LTD.

Address before: 510642 No. five, 483 mountain road, Guangzhou, Guangdong, Tianhe District

Patentee before: SOUTH CHINA AGRICULTURAL University