CN106950949A - 一种车辆沿边导航的七光电开关弧形阵列与方法 - Google Patents
一种车辆沿边导航的七光电开关弧形阵列与方法 Download PDFInfo
- Publication number
- CN106950949A CN106950949A CN201710090376.XA CN201710090376A CN106950949A CN 106950949 A CN106950949 A CN 106950949A CN 201710090376 A CN201710090376 A CN 201710090376A CN 106950949 A CN106950949 A CN 106950949A
- Authority
- CN
- China
- Prior art keywords
- curb
- optoelectronic switch
- vehicle
- raised
- sinking
- 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
Links
- 230000005693 optoelectronics Effects 0.000 title claims abstract description 156
- 238000003491 array Methods 0.000 title claims abstract description 42
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000001960 triggered effect Effects 0.000 claims abstract description 39
- 230000033228 biological regulation Effects 0.000 claims abstract description 9
- 238000001514 detection method Methods 0.000 claims description 22
- 230000004888 barrier function Effects 0.000 claims description 3
- 230000002262 irrigation Effects 0.000 claims description 3
- 238000003973 irrigation Methods 0.000 claims description 3
- 239000000203 mixture Substances 0.000 claims description 3
- 239000003550 marker Substances 0.000 claims 2
- 230000005622 photoelectricity Effects 0.000 claims 2
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 3
- 238000010276 construction Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 6
- 230000005611 electricity Effects 0.000 description 2
- 238000002604 ultrasonography Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种车辆沿边导航的七光电开关弧形阵列与方法,涉及自动导航技术领域。阵列由七个相同的光电开关按圆弧均匀布置构成。当路沿处于设定的理想目标带内时,车辆处于理想位姿而不需调节;当路沿跨出理想目标带时,根据由信号触发数Nd和触发中心序号Nf判定的七光电开关弧形阵列的高低电平状态自动选择相应导航轨迹曲线和确定导航轨迹的参数,通过调控使车辆回到理想目标带内,从而实现车辆的沿边导航控制。通过沿车辆侧面弧形布置的七个光电开关的高低电平变化,实现对车辆相对路沿的位姿准确检测和沿边导航,并适用于凸起路沿的防碰撞和下沉路沿的防跌落自动沿边导航,结构简单、控制简便且适应性强,具有良好的实用性。
Description
技术领域
本发明涉及自动导航领域,特别涉及一种车辆沿边导航的七光电开关弧形阵列与方法。
背景技术
利用边沿特征进行导航在很多领域具有重要的价值和意义。现有沿边导航技术主要基于 图像处理或距离感知来实现:
(1)通过机器视觉、红外、深度等获取环境的图像信息,进而提取道路边沿以进行车辆 导航,其价格昂贵、受光影响大、算法复杂难以满足车辆行进的实时性要求;
(2)扫地机器人等设备具备简单的机械、红外光电或超声的距离或碰撞感知,但仅能实 现边沿的防碰撞或防跌落控制,难以精确地确定自身与边沿的相对位置和姿态,因而难以实 现准确地沿边快速行进控制,同时其应用场合有限;
(3)通过在车辆沿边一侧安装一个超声或红外光电传感器对墙体进行测距,从而实现沿 边行走,但无法实现对车身长度方向的倾斜状态的感知判断,无法避免车头或车尾越过边界, 因而不能保证安全可靠和平顺快速的沿边行进(周慧等,基于单超声波传感器的移动机器人 沿边导航.声学技术,2014,33(S2):243-246;查峰等,移动机器鼠沿墙导航策略与算法研 究.计算机工程,2012,38(6):172-174);
(4)AS-R移动机器人在侧前方弧形布置多个距离传感器、Khepera移动机器人在前方弧 形布置多个距离传感器对墙体进行测距,进而通过多个距离信号的模糊逻辑融合等来实现沿 边行走,但其计算量大、和墙体间的角度稳定度不足(袁宇龙等,基于模糊逻辑的移动机器 人沿墙行为精准控制.世界科技研究与发展,2013,35(6):704-708;徐明亮等,移动机器人 模糊Q-学习沿墙导航,电机与控制学报,2010,14(6):83-88.)
(5)通过在车辆侧面平行安装若干个光电开关实现沿边行进,但只能通过不同光电开关 的高低电平制定判断规则来了解车身偏离边沿的大致情况,而无法获得车身相对于边沿的具 体位置和姿态,因而沿边导航的精度难以保证、运行轨平滑性差(杜利超等,大棚喷雾作业 机器人的行为控制与路径规划.广东农业科学,2011,38(1):185-188)。
发明内容
本发明的目的在于提供一种车辆沿边导航的七光电开关弧形阵列与方法,以实现车辆的 单侧快速沿边自动行进,提高沿边导航的精度。
为了解决以上技术问题,本发明采用的具体技术方案如下:
一种车辆沿边导航的七光电开关弧形阵列,其特征在于:由七个相同的光电开关(1)按圆 弧均匀布置构成,每一光电开关(1)沿圆弧的圆心线方向朝向外;
所述七光电开关弧形阵列(4)安装在车辆(3)靠路沿(2)的一侧,所述七光电开关弧形阵列(4) 的弧顶朝向路沿(2),所述七光电开关弧形阵列(4)的中心线与车辆(3)的纵向中心线方向垂直;
所述路沿(2)包括凸起路沿(7)和下沉路沿(8)两类,其中凸起路沿(7)是指道路侧边具有竖 起的墙壁等障碍物,下沉路沿(8)是指道路侧边具有沟渠等下沉的空间。
如果所述路沿(2)为凸起路沿(7),则
当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0不超过凸起路沿(7)的高度H1时,各光电开关(1)水平朝向凸起路沿(7);
当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0超过凸起路沿(7)的高度H1时, 各光电开关(1)按同一水平倾角ψ朝向凸起路沿(7)
e为车辆(3)行驶过程中与路沿(2)的安全距离。
如果所述路沿(2)为下沉路沿(8),则沿边导航的七光电开关弧形阵列(4)中各个光电开关(1) 按同一水平倾角ψ朝向下沉路沿(8)
S为光电开关(1)的量程。
所述沿边的位姿检测过程为:按从车辆(3)头部到尾部的顺序,由第2个和第6个光电开关 (1)的检测点连线、第3个和第5个光电开关(1)的检测点连线之间构成理想目标带(9);当路沿(2) 处于理想目标带(9)内时,车辆(3)处于理想位姿而不需调节;当路沿(2)跨出理想目标带(9)时, 将导致光电开关(1)的高、低电平状态发生变化,根据各光电开关(1)的高低电平状态判断车辆 (3)的位姿并做相应调节。
所述光电开关(1)为当对象处于检测范围内相应地输出一个设定的低电平或高电平信号 的传感器件,其中PNP型的光电开关(1)在没信号触发时输出低电平,而当对象在量程范围S 内时被触发输出高电平;NPN型的光电开关(1)在没信号触发时输出高电平,而当对象在量程 范围S内时则被触发输出低电平。
一种车辆沿边导航方法,其特征在于采用了所述的七光电开关弧形阵列:
车辆(3)的位姿检测通过信号触发数Nd和触发中心序号Nf来实现,Nd越大表明车辆(3) 距离路沿(2)越近,Nf越大表明车辆(3)的头部越偏离路沿(2);
当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路沿(7)而被触发的光 电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内未检测到下沉路沿(8) 而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
当路沿(2)为凸起路沿(7)情况时,Nf为量程范围S内检测到凸起路沿(7)而被触发的的光 电开关(1)的序号的平均值;当路沿(2)为下沉路沿(8)情况时,Nf为量程范围S内未检测到下 沉路沿(8)而未被触发的的光电开关(1)的序号的平均值;1≤Nf≤7。
以路沿(2)位于理想目标带(9)的正中为车辆(3)的绝对理想位姿,七光电开关弧形阵列(4) 所检测出的车辆(3)的位置偏差⊿D为
(R+S’)[cos(Ndθ/12)-cos(θ/4)]<⊿D<(R+S’){cos[(Nd-1)θ/12]-cos(θ/4)}(3)
R为七光电开关弧形阵列(4)中各光电开关(1)分布圆弧的半径;θ为七光电开关弧形阵列 (4)中各光电开关(1)分布圆弧段的对应圆心角;
S’为光电开关(1)的量程S在水平方向上的投影长度,如路沿(2)为凸起路沿(7),当由车辆 (3)的离地间隙所决定的光电开关(1)离地高度H0不超过凸起路沿(7)的高度H1时,S’=S;如路 沿(2)为凸起路沿(7),当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0超过凸起路沿 (7)的高度H1时,S’=Scosψ;如路沿(2)为下沉路沿(8),S’=Scosψ;Ψ为所述光电开关(1)的水 平倾角;
Nd为信号触发数,当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路 沿(7)而被触发的光电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内 未检测到下沉路沿(8)而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
以路沿(2)位于理想目标带(9)的正中为车辆(3)的绝对理想位姿,七光电开关弧形阵列(4) 所检测出的车辆(3)的姿态偏差⊿β为
(7-2Nf)θ/12<⊿β<(9-2Nf)θ/12 (4)
θ为七光电开关弧形阵列(4)中各光电开关(1)分布圆弧段的对应圆心角;Nf为触发中心序 号,当路沿(2)为凸起路沿(7)情况时,Nf为量程范围S内检测到凸起路沿(7)而被触发的的光 电开关(1)的序号的平均值;当路沿(2)为下沉路沿(8)情况时,Nf为量程范围S内未检测到下 沉路沿(8)而未被触发的的光电开关(1)的序号的平均值;1≤Nf≤7。
所述沿边导航的过程为:在基于七光电开关弧形阵列(4)的沿边导航过程中,根据各个光 电开关(1)的高低电平状态信号进行信号触发数Nd和触发中心序号Nf计算,进而根据信号触发 数Nd和触发中心序号Nf的数值自动进行状态类别的判断并自动选择相应导航轨迹曲线,并根 据由公式(3)和公式(4)计算出的车辆(3)具体位置和姿态偏差确定导航轨迹的参数,通过 调控使车辆(3)回到理想目标带(9)内,从而使车辆(3)行驶过程中与路沿(2)的位姿始终保持在 稳定范围内,实现车辆(3)的沿边导航控制;
Nd为信号触发数,当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路 沿(7)而被触发的光电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内 未检测到下沉路沿(8)而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
Nf为量程范围S内检测到凸起路沿(7)而被触发的的光电开关(1)的序号的平均值;当路沿(2) 为下沉路沿(8)情况时,Nf为量程范围S内未检测到下沉路沿(8)而未被触发的的光电开关(1) 的序号的平均值;1≤Nf≤7。
本发明具有有益效果。本发明利用由七个相同的光电开关按圆弧均匀布置构成的七光电 开关弧形阵列进行导航:当路沿处于设定的理想目标带内时,车辆处于理想位姿而不需调节; 当路沿跨出理想目标带时,根据由信号触发数Nd和触发中心序号Nf判定的七光电开关弧形 阵列的高低电平状态自动选择相应导航轨迹曲线和确定导航轨迹的参数,通过调控使车辆回 到理想目标带内,从而实现车辆的沿边导航控制。通过沿车辆侧面弧形布置的七个光电开关 的高低电平变化,实现对车辆相对路沿的位姿准确检测和沿边导航,适用于凸起路沿的防碰 撞和下沉路沿的防跌落自动沿边导航,结构简单、控制简便且适应性强,具有良好的实用性。
附图说明
图1为本发明车辆沿边导航的七光电开关弧形阵列结构示意图。
图2为本发明凸起路沿的车辆沿边行进示意图。
图3为本发明下沉路沿的车辆沿边行进示意图。
图4为本发明凸起路沿沿边导航的光电开关朝向示意图。
图5为本发明下沉路沿沿边导航的光电开关朝向示意图。
图6为本发明车辆位姿的理想目标带示意图。
图7为本发明七光电开关弧形阵列的车辆沿边位姿检测原理示意图。
图中1.光电开关,2.路沿,3.车辆,4.七光电开关弧形阵列,5.器件圆弧,6.检测圆弧, 7.凸起路沿,8.下沉路沿,9.理想目标带。
具体实施方式
下面结合附图,对本发明的技术方案做进一步详细说明。
如图1所示,车辆沿边导航的七光电开关弧形阵列4由七个相同的光电开关1按半径为R的 器件圆弧5均匀布置构成,所述的光电开关1为当对象处于检测范围内相应地输出一个设定的 低电平或高电平信号的传感器件,触发光电开关1的高、低电平信号切换的距离阈值S为光电 开关1的量程。其中PNP型的光电开关1在没信号触发时输出低电平,而当对象在量程范围S内 时被触发输出高电平;NPN型的光电开关1在没信号触发时输出高电平,而当对象在量程范围 S内时则被触发输出低电平。
每一光电开关1沿器件圆弧5的圆心线方向朝向外。该车辆沿边导航的七光电开关弧形 阵列4安装在车辆3的沿边一侧,七光电开关弧形阵列4的弧顶朝向路沿2一侧的车辆3侧 面,七光电开关弧形阵列4的中心线与车辆3中心线方向垂直。从车辆3头部到尾部定义七 个光电开关1的顺序,车辆3头部到尾部的七个光电开关1分别标记为A1~A7。
如图2和图3所示,车辆沿边行进的路沿2包括凸起路沿7和下沉路沿8两类,其中凸起路沿 7是指道路侧边具有竖起的墙壁等障碍物,下沉路沿8是指道路侧边具有沟渠等下沉的空间。
如图4和图1所示,如路沿2为凸起路沿7:
(1)当由车辆3的离地间隙所决定的光电开关1离地高度H0不超过凸起路沿7的高度 H1时,各光电开关1水平朝向凸起路沿7;由各光电开关1的量程S导致标记为A1’~A7’的各检测点所分布的检测圆弧6的半径为R+S’=R+S;其中S’为每一光电开关1与其对应检测点的水平方向距离,即量程S在水平方向上的投影长度。
(2)当由车辆3的离地间隙所决定的光电开关1离地高度H0超过凸起路沿7的高度H1时,各光电开关1按同一水平倾角ψ朝向凸起路沿7
其中e为车辆3行驶中与路沿2的安全距离。
由各光电开关1的量程S和水平倾角ψ导致各检测点A1’~A7’所分布的检测圆弧6的半 径为R+S’=R+Scosψ。
如图5和图1所示,当路沿2为下沉路沿8时,沿边导航的七光电开关弧形阵列4中各个光电开关1按同一水平倾角ψ朝向下沉路沿8
由各光电开关1的量程S和水平倾角ψ导致各检测点A1’~A7’所分布的检测圆弧6的半 径为R+S’=R+Scosψ。
如图6所示,基于七光电开关弧形阵列4的车辆3的沿边位姿检测与导航原理为:
由标记为A2’和A6’的两检测点连线、标记为A3’和A5’的两检测点连线之间构成理想目标 带9,当路沿2处于理想目标带9内时,车辆3处于理想位姿而不需调节。当路沿2跨出理想目标 带9时,将导致光电开关1的高、低电平状态发生变化,根据各光电开关1的高低电平状态,可 以判断车辆3的位姿。
当路沿2为凸起路沿7时,车辆3的位姿检测通过信号触发数Nd和触发中心序号Nf来实现, 其中Nd为在量程范围S内检测到凸起路沿7而被触发的光电开关1的数量,0≤Nd≤7且为正整数, 即如图7侵入凸起路沿7的部分检测圆弧6中检测点的个数,Nd越大表明车辆3距离凸起路沿7 越近;Nf为量程范围S内检测到凸起路沿7而被触发的的光电开关1的序号的平均值,1≤Nf≤7, 即如图7侵入凸起路沿7的部分检测圆弧6的中心弧顶位置序号,Nf越大表明车辆3的头部越偏 离凸起路沿7。
当路沿2为下沉路沿8时,车辆3的位姿检测通过信号触发数Nd和触发中心序号Nf来实现, 其中Nd为在量程范围S内未检测到下沉路沿8而未被触发的光电开关1的数量,0≤Nd≤7且为正 整数,即如图7侵入下沉路沿8的部分检测圆弧6中检测点的个数,Nd越大表明车辆3距离下沉 路沿8越近;Nf为量程范围S内未检测到下沉路沿8而未被触发的的光电开关1的序号的平均值, 1≤Nf≤7,即如图7侵入下沉路沿8的部分检测圆弧6的中心弧顶位置序号,Nf越大表明车辆3的 头部越偏离下沉路沿8。
根据理想目标带9的设定,由Nd可以进行车辆3位置状态的判断:
(1)当Nd=0时,车辆3已经远离路沿2,处于导航失效的不可控状态;
(2)当1≤Nd<3时,车辆3离路沿2过远;
(3)当Nd=3时,车辆3与路沿2处于理想距离;
(4)当3<Nd<5时,车辆3离路沿2过近;
(5)当Nd≥5时,车辆3已经越过或撞击路沿2,处于导航失效的不可控状态。
以路沿2位于理想目标带9的正中为车辆3的绝对理想位姿,则七光电开关弧形阵列4所检 测出的车辆3的位置偏差⊿D为
(R+S’)[cos(Ndθ/12)-cos(θ/4)]<⊿D<(R+S’){cos[(Nd-1)θ/12]-cos(θ/4)} (3)
根据理想目标带9的设定,由Nf可以进行车辆3姿态状态的判断:
(1)当3<Nf<4时,车辆3的头部偏向路沿2;
(2)当Nf=4时,车辆3与路沿2处于理想姿态;
(3)当4<Nf<5时,车辆3的头部偏离路沿2;
(4)当Nf≤3或Nf≥5时,车辆3相对路沿2已经严重倾斜,处于导航失效的不可控状态。
以路沿2位于理想目标带9的正中为车辆3的绝对理想位姿,则七光电开关弧形阵列4所检 测出的车辆3的姿态偏差⊿β为
(7-2Nf)θ/12<⊿β<(9-2Nf)θ/12 (4)
在基于七光电开关弧形阵列4的沿边导航过程中,根据各个光电开关1的高低电平状态信 号进行信号触发数Nd和触发中心序号Nf计算,进而根据信号触发数Nd和触发中心序号Nf的数值 自动进行表1所示的9类状态的判断并自动选择相应导航轨迹曲线,并根据由公式(3)和公式 (4)计算出的车辆3具体位置和姿态偏差确定导航轨迹的参数,通过调控使车辆3回到理想目 标带9内,从而使车辆3行驶过程中与路沿2的位姿始终保持在稳定范围内,实现车辆3的沿边 导航控制。
表1:本发明光电开关信号与车辆位姿状态关系表.
七光电开关弧形阵列4的布置关键参数为器件圆弧5的半径R和圆心角θ,半径R和圆心角θ 由位姿的检测精度要求和光电开关1的检测响应时间所共同决定。
由式(3),七光电开关弧形阵列4的位置检测误差为
2(R+S’)sin[(2Nd-1)θ/24]sin(θ/24)<[D] (5)
其中[D]为车辆3沿边导航中对七光电开关弧形阵列4的位置检测误差要求。当在表1所示 有效调控范围内,Nd为最大值5时
2(R+S’)sin(3θ/8)sin(θ/24)<[D] (6)
由式(4),七光电开关弧形阵列4的的姿态检测误差为
θ/6<[β] (7)
其中[β]为车辆3沿边导航中对七光电开关弧形阵列4的姿态检测误差要求。
同时,为保证车辆3行进过程中,为保证各光电开关1的高低电平信号变化能够有效反 映车辆3对路沿2的位姿变化,要求
ω0T≤θ/6 (8)
其中ω0为车辆3沿边行进中可能出现的最大偏转角速度,T为光电开关1的检测响应时间。
首先可由式(7)和式(8)确定七光电开关弧形阵列4的器件圆弧5的圆心角
6ω0T≤θ<6[β] (9)
进而由式(6)和式(9)确定七光电开关弧形阵列4的器件圆弧5的半径R。
Claims (9)
1.一种车辆沿边导航的七光电开关弧形阵列,其特征在于:由七个相同的光电开关(1)按圆弧均匀布置构成,每一光电开关(1)沿圆弧的圆心线方向朝向外;
所述七光电开关弧形阵列(4)安装在车辆(3)靠路沿(2)的一侧,所述七光电开关弧形阵列(4)的弧顶朝向路沿(2),所述七光电开关弧形阵列(4)的中心线与车辆(3)的纵向中心线方向垂直;
所述路沿(2)包括凸起路沿(7)和下沉路沿(8)两类,其中凸起路沿(7)是指道路侧边具有竖起的墙壁等障碍物,下沉路沿(8)是指道路侧边具有沟渠等下沉的空间。
2.根据权利要求1所述的一种车辆沿边导航的七光电开关弧形阵列,其特征在于:当所述路沿(2)为凸起路沿(7),则
当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0不超过凸起路沿(7)的高度H1时,各光电开关(1)水平朝向凸起路沿(7);
当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0超过凸起路沿(7)的高度H1时,各光电开关(1)按同一水平倾角ψ朝向凸起路沿(7)
e为车辆(3)行驶过程中与路沿(2)的安全距离。
3.根据权利要求1所述的一种车辆沿边导航的七光电开关弧形阵列,其特征在于:当所述路沿(2)为下沉路沿(8),则沿边导航的七光电开关弧形阵列(4)中各个光电开关(1)按同一水平倾角ψ朝向下沉路沿(8)
S为光电开关(1)的量程。
4.根据权利要求1所述的一种车辆沿边导航的七光电开关弧形阵列与方法,其特征在于:所述沿边的位姿检测过程为:按从车辆(3)头部到尾部的顺序,由第2个和第6个光电开关(1)的检测点连线、第3个和第5个光电开关(1)的检测点连线之间构成理想目标带(9);当路沿(2)处于理想目标带(9)内时,车辆(3)处于理想位姿而不需调节;当路沿(2)跨出理想目标带(9)时,将导致光电开关(1)的高、低电平状态发生变化,根据各光电开关(1)的高低电平状态判断车辆(3)的位姿并做相应调节。
5.根据权利要求1所述的一种车辆沿边导航的七光电开关弧形阵列,其特征在于:所述光电开关(1)为当对象处于检测范围内相应地输出一个设定的低电平或高电平信号的传感器件,其中PNP型的光电开关(1)在没信号触发时输出低电平,而当对象在量程范围S内时被触发输出高电平;NPN型的光电开关(1)在没信号触发时输出高电平,而当对象在量程范围S内时则被触发输出低电平。
6.一种车辆沿边导航方法,其特征在于采用了权利要求1所述的七光电开关弧形阵列:
车辆(3)的位姿检测通过信号触发数Nd和触发中心序号Nf来实现,Nd越大表明车辆(3)距离路沿(2)越近,Nf越大表明车辆(3)的头部越偏离路沿(2);
当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路沿(7)而被触发的光电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内未检测到下沉路沿(8)而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
当路沿(2)为凸起路沿(7)情况时,Nf为量程范围S内检测到凸起路沿(7)而被触发的的光电开关(1)的序号的平均值;当路沿(2)为下沉路沿(8)情况时,Nf为量程范围S内未检测到下沉路沿(8)而未被触发的的光电开关(1)的序号的平均值;1≤Nf≤7。
7.根据权利要求6所述的一种车辆沿边导航方法,其特征在于:以路沿(2)位于理想目标带(9)的正中为车辆(3)的绝对理想位姿,七光电开关弧形阵列(4)所检测出的车辆(3)的位置偏差⊿D为
(R+S’)[cos(Ndθ/12)-cos(θ/4)]<⊿D<(R+S’){cos[(Nd-1)θ/12]-cos(θ/4)} (3)
R为七光电开关弧形阵列(4)中各光电开关(1)分布圆弧的半径;θ为七光电开关弧形阵列(4)中各光电开关(1)分布圆弧段的对应圆心角;
S’为光电开关(1)的量程S在水平方向上的投影长度,如路沿(2)为凸起路沿(7),当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0不超过凸起路沿(7)的高度H1时,S’=S;如路沿(2)为凸起路沿(7),当由车辆(3)的离地间隙所决定的光电开关(1)离地高度H0超过凸起路沿(7)的高度H1时,S’=Scosψ;如路沿(2)为下沉路沿(8),S’=Scosψ;Ψ为所述光电开关(1)的水平倾角;
Nd为信号触发数,当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路沿(7)而被触发的光电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内未检测到下沉路沿(8)而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
8.根据权利要求6所述的一种车辆沿边导航方法,其特征在于:以路沿(2)位于理想目标带(9)的正中为车辆(3)的绝对理想位姿,七光电开关弧形阵列(4)所检测出的车辆(3)的姿态偏差⊿β为
(7-2Nf)θ/12<⊿β<(9-2Nf)θ/12 (4)
θ为七光电开关弧形阵列(4)中各光电开关(1)分布圆弧段的对应圆心角;Nf为触发中心序号,当路沿(2)为凸起路沿(7)情况时,Nf为量程范围S内检测到凸起路沿(7)而被触发的的光电开关(1)的序号的平均值;当路沿(2)为下沉路沿(8)情况时,Nf为量程范围S内未检测到下沉路沿(8)而未被触发的的光电开关(1)的序号的平均值;1≤Nf≤7。
9.根据权利要求6所述的一种车辆沿边导航方法,其特征在于所述沿边导航的过程为:在基于七光电开关弧形阵列(4)的沿边导航过程中,根据各个光电开关(1)的高低电平状态信号进行信号触发数Nd和触发中心序号Nf计算,进而根据信号触发数Nd和触发中心序号Nf的数值自动进行状态类别的判断并自动选择相应导航轨迹曲线,并根据由公式(3)和公式(4)计算出的车辆(3)具体位置和姿态偏差确定导航轨迹的参数,通过调控使车辆(3)回到理想目标带(9)内,从而使车辆(3)行驶过程中与路沿(2)的位姿始终保持在稳定范围内,实现车辆(3)的沿边导航控制;
Nd为信号触发数,当路沿(2)为凸起路沿(7)情况时,Nd为在量程范围S内检测到凸起路沿(7)而被触发的光电开关(1)的数量;当路沿(2)为下沉路沿(8)情况时,Nd为在量程范围S内未检测到下沉路沿(8)而未被触发的光电开关(1)的数量;0≤Nd≤7且为正整数。
Nf为量程范围S内检测到凸起路沿(7)而被触发的的光电开关(1)的序号的平均值;当路沿(2)为下沉路沿(8)情况时,Nf为量程范围S内未检测到下沉路沿(8)而未被触发的的光电开关(1)的序号的平均值;1≤Nf≤7。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710090376.XA CN106950949B (zh) | 2017-02-20 | 2017-02-20 | 一种车辆沿边导航的七光电开关弧形阵列与方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710090376.XA CN106950949B (zh) | 2017-02-20 | 2017-02-20 | 一种车辆沿边导航的七光电开关弧形阵列与方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106950949A true CN106950949A (zh) | 2017-07-14 |
CN106950949B CN106950949B (zh) | 2021-04-13 |
Family
ID=59466478
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710090376.XA Active CN106950949B (zh) | 2017-02-20 | 2017-02-20 | 一种车辆沿边导航的七光电开关弧形阵列与方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106950949B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110989591A (zh) * | 2019-12-02 | 2020-04-10 | 长沙中联重科环境产业有限公司 | 基于路沿识别进行辅助作业控制的环卫机器人 |
CN111170238A (zh) * | 2019-12-31 | 2020-05-19 | 中联重科股份有限公司 | 用于高空作业平台的控制系统、控制方法及高空作业平台 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101855571A (zh) * | 2007-11-07 | 2010-10-06 | 罗伯特·博世有限公司 | 车辆的用于死角的监视装置以及方法 |
CN103415782A (zh) * | 2011-03-11 | 2013-11-27 | 法雷奥开关和传感器有限责任公司 | 停车辅助系统、具有其的机动车辆和检测停车位的方法 |
WO2016087679A1 (de) * | 2014-12-05 | 2016-06-09 | Astyx Gmbh | Radarsensor, radarsensor-system sowie verfahren zur bestimmung der position eines objekts mit horizontaler und vertikaler digitaler strahlformung zur vermessung von punkt- und flächenförmig reflektierenden objekten |
US20160334504A1 (en) * | 2015-05-12 | 2016-11-17 | Maxlinear, Inc. | Scalable Architecture for an Automotive Radar System |
WO2016193333A1 (de) * | 2015-06-03 | 2016-12-08 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum klassifizieren eines länglich ausgedehnten stationären objektes in einem seitlichen umgebungsbereich eines kraftfahrzeugs, fahrerassistenzsystem sowie kraftfahrzeug |
-
2017
- 2017-02-20 CN CN201710090376.XA patent/CN106950949B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101855571A (zh) * | 2007-11-07 | 2010-10-06 | 罗伯特·博世有限公司 | 车辆的用于死角的监视装置以及方法 |
CN103415782A (zh) * | 2011-03-11 | 2013-11-27 | 法雷奥开关和传感器有限责任公司 | 停车辅助系统、具有其的机动车辆和检测停车位的方法 |
WO2016087679A1 (de) * | 2014-12-05 | 2016-06-09 | Astyx Gmbh | Radarsensor, radarsensor-system sowie verfahren zur bestimmung der position eines objekts mit horizontaler und vertikaler digitaler strahlformung zur vermessung von punkt- und flächenförmig reflektierenden objekten |
US20160334504A1 (en) * | 2015-05-12 | 2016-11-17 | Maxlinear, Inc. | Scalable Architecture for an Automotive Radar System |
WO2016193333A1 (de) * | 2015-06-03 | 2016-12-08 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum klassifizieren eines länglich ausgedehnten stationären objektes in einem seitlichen umgebungsbereich eines kraftfahrzeugs, fahrerassistenzsystem sowie kraftfahrzeug |
Non-Patent Citations (1)
Title |
---|
徐明亮 等: "移动机器人模糊Q-学习沿墙导航", 《电机与控制学报》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110989591A (zh) * | 2019-12-02 | 2020-04-10 | 长沙中联重科环境产业有限公司 | 基于路沿识别进行辅助作业控制的环卫机器人 |
CN111170238A (zh) * | 2019-12-31 | 2020-05-19 | 中联重科股份有限公司 | 用于高空作业平台的控制系统、控制方法及高空作业平台 |
CN111170238B (zh) * | 2019-12-31 | 2021-10-29 | 湖南中联重科智能高空作业机械有限公司 | 用于高空作业平台的控制系统、控制方法及高空作业平台 |
Also Published As
Publication number | Publication date |
---|---|
CN106950949B (zh) | 2021-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11543832B2 (en) | Method and apparatus for controlling an autonomous vehicle | |
CN207636768U (zh) | 一种智能车辆的感知系统及车辆 | |
CN105109484B (zh) | 目标障碍物体确定方法及装置 | |
CN103158703B (zh) | 一种平行泊车的控制方法 | |
CN107636546A (zh) | 自主移动系统 | |
CN110239535A (zh) | 一种基于多传感器融合的弯道主动避撞控制方法 | |
CN107543726B (zh) | 一种无人车驾驶控制系统操控精度的测试方法及装置 | |
CN105739495B (zh) | 行车路径规划方法、装置和自动转向系统 | |
CN105539574B (zh) | 汽车后轮转向电控液压系统及其控制方法 | |
CN110307850A (zh) | 航迹推算定位方法及自动泊车系统 | |
CN106598055A (zh) | 一种智能车局部路径规划方法及其装置、车辆 | |
CN107139917A (zh) | 一种基于混杂理论的无人驾驶汽车横向控制系统和方法 | |
CN106696961A (zh) | 高速公路自动驾驶上下匝道控制系统及方法 | |
CN103256939B (zh) | 智能车辆利用变粒度路权雷达图进行信息融合的方法 | |
CN105518759A (zh) | 用于核查机动车的错误方向行驶的方法以及控制和检测装置 | |
CN103335658A (zh) | 一种基于弧线路径生成的自主车辆避障方法 | |
CN105928531A (zh) | 一种适用于无人驾驶汽车的行进路线精准生成方法 | |
CN110884502A (zh) | 自动驾驶路径规划质量测评方法、装置和系统 | |
CN109789873A (zh) | 车辆控制装置 | |
CN104460665A (zh) | 基于道路曲率地图的磁导航无人车及其地图的建立方法 | |
CN109823393A (zh) | 一种智能驾驶车辆轨迹跟踪控制方法 | |
CN108919802A (zh) | 无人驾驶的车辆行驶和装置 | |
CN104897168A (zh) | 基于道路危险评估的智能车路径搜索方法及系统 | |
CN109471432A (zh) | 一种自主导航农用车最短避障路径规划方法 | |
CN108045435A (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 |