CN112731922A - 基于室内定位的无人机辅助智能车驾驶方法与*** - Google Patents
基于室内定位的无人机辅助智能车驾驶方法与*** Download PDFInfo
- Publication number
- CN112731922A CN112731922A CN202011470627.5A CN202011470627A CN112731922A CN 112731922 A CN112731922 A CN 112731922A CN 202011470627 A CN202011470627 A CN 202011470627A CN 112731922 A CN112731922 A CN 112731922A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- intelligent vehicle
- vehicle unit
- intelligent
- 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
- 238000000034 method Methods 0.000 title claims description 22
- 238000005259 measurement Methods 0.000 claims abstract description 9
- 238000012545 processing Methods 0.000 claims description 12
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 7
- 230000005540 biological transmission Effects 0.000 claims description 6
- 230000003137 locomotive effect Effects 0.000 claims description 6
- 238000003708 edge detection Methods 0.000 claims description 5
- 238000013528 artificial neural network Methods 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 claims description 4
- 238000007781 pre-processing Methods 0.000 claims description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000005457 optimization Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- SAZUGELZHZOXHB-UHFFFAOYSA-N acecarbromal Chemical compound CCC(Br)(CC)C(=O)NC(=O)NC(C)=O SAZUGELZHZOXHB-UHFFFAOYSA-N 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000013078 crystal Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000003016 pheromone Substances 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
-
- 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
- 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
-
- 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
- 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, 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
一种基于室内定位的无人机辅助智能车驾驶***;包括智能车单元、无人机单元、PC端、UWB基站和UWB定位标签;智能车单元具有电驱和方向控制功能,并配有信号接收装置,通过接收PC端发来的指令完成指定的循迹路线;无人机单元通过搭载的摄像头模块对智能车周围环境进行图像采集,对采集图像进行预处理后发送给PC端,采集到的图像中均带有预先设置于场地内的人工标记;同时,无人机单元根据PC端下发的控制指令调整飞行姿态;UWB定位标签设置于智能车单元和无人机单元上,不断发送UWB定位脉冲;UWB基站分别测量UWB定位脉冲并将测量结果反馈给PC端;本发明将有效提升定位精度,实现无人机与智能车之间无人工控制的协同驾驶***。
Description
技术领域
本发明涉及无人机控制技术、智能车控制技术、与UWB定位***的交叉领域,具体涉及一种基于室内定位的无人机辅助智能车驾驶方法与***。
背景技术
现有技术中,为了能充分发挥无人机与无人车各自的功能,以更好地实现智能交通中的无人车自主行驶能力,提出了无人机与无人智能车协同行驶的方案。
但是,传统的无人机辅助智能车驾驶***,大多依赖于车载传感器,在传感范围和灵活性上具有很大的局限性。例如,专利201810059695.9提出基于图像识别的无人机与智能车协同导航方法,该方法中默认已知小车的实时位置,并没有考虑智能车的定位问题,不具有实用性;在任涛等的期刊论文《无人机与智能车协同导航***的设计》中,考虑无人机通过摄像头拍摄目标区域位置,这种方案的局限在于无人机在远距离非视距的情况下无法通过图像定位到目标区域;专利201910511710.3提出一种无人机与智能车组自主协同运输***及方法,该方法中考虑的定位是通过GPS定位,无法适用于无GPS信号的场景。
综上所述,现有技术中的无人机辅助智能车驾驶***仍然需要依赖传感器和GPS定位,而在信号条件较差、无法使用GPS定位的场地,则无法实现无人机辅助智能车驾驶的目的。
发明内容
发明目的:针对上述现有技术的缺陷,本发明提出一种基于室内定位的无人机辅助智能车驾驶方法与***,能够应用于堆场或仓库等无法使用GPS的场合,未来可运用于辅助车辆驾驶、车位自动泊车等领域。
技术方案:为实现上述目的,本发明提出以下技术方案:基于室内定位的无人机辅助智能车驾驶***,包括智能车单元、无人机单元、PC端、UWB基站和UWB定位标签;
智能车单元具有电驱和方向控制功能,并配有信号接收装置,通过接收PC端发来的指令完成指定的循迹路线;
无人机单元通过搭载的摄像头模块对智能车周围环境进行图像采集,对采集图像进行预处理后发送给PC端,采集到的图像中均带有预先设置于场地内的人工标记;同时,无人机单元根据PC端下发的控制指令调整飞行姿态;
UWB定位标签设置于智能车单元和无人机单元上,不断发送UWB定位脉冲;
UWB基站有三个,三个UWB基站分别测量UWB定位脉冲并将测量结果反馈给PC端;
PC端根据接收到的测量结果采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位,然后根据初步定位结果生成无人机控制指令,控制无人机单元飞行在智能车单元的正上方;之后,根据无人机发送的图像和预先加载的场地栅格地图进行智能车精确定位和障碍物识别,根据精确定位结果控制无人机单元始终飞行在智能车单元的正上方,根据障碍物识别结果和预先设定好的目的地坐标对智能车的行驶路线进行规划。
进一步的,所述UWB基站内置有stm32微处理器,其信号发射装置与接收装置集成为一体。
进一步的,所述无人机单元配置有摄像头、图像处理模块、WiFi模块、信号接收装置、飞行控制模块和嵌入式主控模块;其中,
摄像头位于无人机下方,以固定的频率采集无人机下方区域图像;图像处理模块用于接收摄像头发来的信息,并对图像进行预处理。
飞行控制模块控制无人机的飞行姿态,并将无人机的飞行状态信息传输给嵌入式主控模块;
嵌入式主控模块用于驱动摄像头模块与图像处理模块工作,将处理完的数据通过WiFi模块发送给PC端作进一步处理,同时控制信号接收装置接收由PC端传来的飞行指令,驱动无人机以相应姿态飞行。
WiFi模块用以实现无人机与PC端之间的信息传输。
进一步的,所述PC端上设有Wifi模块、路径规划模块、机车协同模块;其中,
Wifi模块用以实现PC端与无人机、智能车与UWB基站之间的信息传输;
路径规划模块基于由无人机端传输的数据,用神经网络的方式对实时路况进行判断,并规划出智能车的实时运行路线,这些路线指令将通过wifi模块传回给无人机与智能车;
机车协同模块基于由无人机端传输的数据,实时监测无人机与智能车的体态位置信息,若出现误差超过所设阈值情况,立刻发送指令给无人机调整无人机姿态。
本发明还提出一种基于所述***实现的基于室内定位的无人机辅助智能车驾驶方法,包括以下步骤:
(1)构建场地的栅格地图,在栅格地图中设置人工地标;
(2)在场地中设置UWB基站,并在栅格地图中标出UWB基站的坐标;
(3)将经过步骤(2)处理后的栅格地图加载到PC端;
(4)PC端与UWB基站以及UWB标签构成UWB定位***,采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位;
(5)PC端根据无人机单元和智能车单元的初步定位结果生成无人机单元控制指令,使无人机飞行至智能车单元的正上方,并控制无人机的飞行高度始终在高度H;
(6)当PC端检测到无人机单元与智能车单元的位置差小于预设的阈值,则控制无人机单元开始采集图像;
(7)PC端接收无人机单元上传的图像数据,对图像中智能车单元进行边缘检测以提取智能车单元的轮廓和中心坐标,然后根据栅格地图中智能车中心位置与人工地标的相对位置计算出智能车单元的精确位置坐标;对图像中障碍物进行识别,确定障碍物的轮廓和坐标;
(8)PC端根据智能车单元的精确位置坐标对无人机单元的位置进行微调,使得无人机单元始终飞行在智能车单元正上方;PC端根据障碍物的轮廓和坐标以及预先设定好的目的地坐标对智能车单元的行驶路线进行规划,并控制智能车单元按照规划的路线行驶。
进一步的,当PC端在图像中未检测到智能车单元时,控制无人机单元以当前所在位置为中心点,作半径为1m范围的环绕飞行;若环绕飞行时间达到预设的时间阈值,则无人机返回起始点,PC端重新执行步骤(4)。
进一步的,所述步骤(8)中,采用改进的蚁群算法来进行路径规划。
本发明所实现的功能有二,一是通过UWB定位***与摄像头采集图像实现无人机对目标智能车的自动追踪,二是通过无人机上所装摄像头对智能车前路况进行拍摄并对地面障碍物进行识别,引导智能车避开障碍物并到达指定目的地。PC端会随时监视无人机单元与智能车单元的工作状态,并通过神经网络的方式为智能车的行驶做出引导;智能车单元根据接收到的PC端指令,智能调整自身的行进路线,并配有超声波自主避障功能。本发明将有效提升定位精度,实现无人机与智能车之间无人工控制的协同驾驶***。
有益效果:与现有技术相比,本发明有效地结合了无人机与无人车各自所具备的优势:
一方面,无人机利用自己的高机动性与宽阔视野,为无人车(尤其是无路边单元时的应用)提供其工作周边环境的相应信息,二者实现资源互通,使无人机周围位置的环境变为已知环境,达到更精确的车辆导航。另一方面,利用智能车与无人机之间的优势协同,可以更快速更高效地合作完成原先任务,从过去一个个体执行任务转变为两个智能***合作完成,大大提高了任务执行的可靠性和稳定性。在堆场或仓库等无法使用GPS定位的场合通过无人机的指引精确导航。
附图说明
图1为本发明的***结构图:
图2无人机找寻智能车流程图:
图3无人机引导智能车避障流程图。
具体实施方式
下面结合附图对本发明作更进一步的说明。
实施例1:
图1为本实施例提出的基于室内定位的无人机辅助智能车驾驶***的结构图,包括智能车单元、无人机单元、PC端、UWB基站和UWB定位标签;其中,
智能车单元具有电驱和方向控制功能,并配有信号接收装置,通过接收PC端发来的指令完成指定的循迹路线;
无人机单元通过搭载的摄像头模块对智能车周围环境进行图像采集,对采集图像进行预处理后发送给PC端,采集到的图像中均带有预先设置于场地内的人工标记;同时,无人机单元根据PC端下发的控制指令调整飞行姿态;
UWB定位标签设置于智能车单元和无人机单元上,不断发送UWB定位脉冲;
UWB基站有三个,三个UWB基站分别测量UWB定位脉冲并将测量结果反馈给PC端;
PC端根据接收到的测量结果采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位,然后根据初步定位结果生成无人机控制指令,控制无人机单元飞行在智能车单元的正上方;之后,根据无人机发送的图像和预先加载的场地栅格地图进行智能车精确定位和障碍物识别,根据精确定位结果控制无人机单元始终飞行在智能车单元的正上方,根据障碍物识别结果和预先设定好的目的地坐标对智能车的行驶路线进行规划。
具体的,所述UWB基站内置有stm32微处理器,其信号发射装置与接收装置集成为一体。所述无人机单元配置有摄像头、图像处理模块、WiFi模块、信号接收装置、飞行控制模块和嵌入式主控模块;其中,摄像头位于无人机下方,以固定的频率采集无人机下方区域图像;图像处理模块用于接收摄像头发来的信息,并对图像进行预处理。飞行控制模块控制无人机的飞行姿态,并将无人机的飞行状态信息传输给嵌入式主控模块;嵌入式主控模块用于驱动摄像头模块与图像处理模块工作,将处理完的数据通过WiFi模块发送给PC端作进一步处理,同时控制信号接收装置接收由PC端传来的飞行指令,驱动无人机以相应姿态飞行。WiFi模块用以实现无人机与PC端之间的信息传输。所述PC端上设有Wifi模块、路径规划模块、机车协同模块;其中,Wifi模块用以实现PC端与无人机、智能车与UWB基站之间的信息传输;路径规划模块基于由无人机端传输的数据,用神经网络的方式对实时路况进行判断,并规划出智能车的实时运行路线,这些路线指令将通过wifi模块传回给无人机与智能车;机车协同模块基于由无人机端传输的数据,实时监测无人机与智能车的体态位置信息,若出现误差超过所设阈值情况,立刻发送指令给无人机调整无人机姿态。
实施例2:
基于实施例1提出的基于室内定位的无人机辅助智能车驾驶***,本实施例提出基于室内定位的无人机辅助智能车驾驶方法,该方法整体上分为两个流程,第一个是无人机找寻智能车流程,第二个是无人机引导智能车避障流程。
无人机找寻智能车流程如图2所示,包括以下步骤:
(1)构建场地的栅格地图,在栅格地图中设置人工地标;
(2)在场地中设置UWB基站,并在栅格地图中标出UWB基站的坐标;
(3)将经过步骤(2)处理后的栅格地图加载到PC端;
(4)PC端与UWB基站以及UWB标签构成UWB定位***,采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位;
所述TOF算法:DWM1000超宽带测距采用的是TWR双向测距方法,其需要设备间能够保证双向通信,通过UWB信号收发时间戳计算UWB信号的往返时间,再将时间乘上信号传播的速度从而获得两个设备之间的距离。具体地,这里采用单边双向测距法(SS-TWR),先由设备A发起测距请求的信息,设备B接收到由A发出的测距请求信息并将信息处理的时间延迟Treply返回,设备A收到响应消息后再计算出消息的往返时延Tround,那么信息的在A,B两点间飞行的时间即可由计算得出:Tprop=0.5·(Tround-Treply)。
因此A,B两点间的距离为:D=vt=c·Tprop
如果假定设备A,B的晶振频率偏移分别为eA和eB,则有:
T′round=(1+eA)·Tround
T′reply=(1+eB)·Treply
将T′prop=0.5·(T′round-T′reply)带入,
同时保证:Tprop=0.5·(Tround-Treply),有:
标签通过与三个位置确定的基站分别进行TWR获得相应的测量距离Dk,得到以下方程组:
将方程转化为线性化方程AX=B
其中:
通过最小二乘法即可解得:X=(ATA)-1ATB,从而求解出标签的位置坐标X。
(5)PC端根据无人机单元和智能车单元的初步定位结果生成无人机单元控制指令,使无人机飞行至智能车单元的正上方,并控制无人机的飞行高度始终在高度H;
智能车体的中心指的是无人机对智能车的图像进行边缘检测计算后得出的智能车中心位置坐标;通过三个基站三点定位法确定智能车的平面坐标后还要再通过采集智能车的图像进行边缘检测计算智能车的中心位置坐标,因为通过三个基站三点定位法确定智能车的平面坐标不够精确,存在很大的误差,只能粗略计算智能车位置,无人机飞行到智能车的大致位置后再通过图像识别建立道路与障碍物的场地模型并精确计算出智能车位置。
(6)当PC端在图像中未检测到智能车单元时,控制无人机单元以当前所在位置为中心点,作半径为1m范围的环绕飞行;若环绕飞行时间达到预设的时间阈值,则无人机返回起始点,PC端重新执行步骤(4)。
(7)不断更新智能车体坐标,直至连续三次智能车体返回值误差小于预设阈值;
(8)确定智能车体坐标后,***进入稳定状态,无人机主控模块通过Wifi模块返回给PC端信号,示意可执行之后操作。
无人机引导智能车避障流程如图3所示,具体步骤如下:
1)人为输入智能车的运行目的地至PC端;
2)PC端将目的地信息通过Wifi模块同时传输给智能车单元与无人机单元;
3)智能车主控模块通过接收到的信息控制智能车电机使智能车进入运行状态/无人机主控模块通过接收到的信息控制无人机飞控模块使无人机进入飞行状态;
4)无人机摄像头模块以特定频率采集图像,并对图像进行灰度处理与边缘检测,以识别出智能车的位置与智能车周围障碍物的位置信息;
5)无人机主控模块通过Wifi模块将障碍物信息发送给PC端;
6)无人机主控模块通过图像处理模块判断智能车与无人机之间相对位置,若出现偏差,则发送指令给无人机飞控模块调整无人机飞行姿态;
7)PC端接收到有无人机发送来的障碍物信息,并通过算法计算智能车实时的避障运行轨迹;
8)PC端通过WIFI模块将运行指令发送给智能车单元和无人机单元;
9)智能车主控模块通过接收到的信息控制智能车电机改变智能车的运行状态/无人机主控模块通过接收到的信息控制无人机飞控模块改变无人机的飞行姿态;
具体的,以上避障操作4)中所述的图像处理方法:首先将图像转化为二值化图像,利用颜色特征检测算法和基于霍夫变换的图形检测方法识别出障碍物的轮廓,计算出地面网格的数量、所占地面网格大小以及位置坐标;
具体的,以上避障操作7)中所述避障方法:从无人机端接收到的信息有:障碍物距离智能车距离d,障碍物中心点坐标,障碍物最长长度l与宽度w。假设智能车行驶速度恒定为v,则智能车需偏转的角度为θ=arctan(l/d)+c,在行驶w*cosθ距离后,再将智能车行驶方向调整为原先行驶方向。
智能车的位置准确计算后,到目标地导航,采用基于蚁群算法的智能车路径规划。智能车路径规划,依据某个或某些优化原则(如最小能量消耗,最短行走路线,最短行走时间等),在其工作空间中找到一条从起始状态到目标状态的能避开障碍物的最优路径。智能车路径规划问题可以建模为一个有约束的优化问题,都要完成路径规划、定位和避障等任务。
算法理论采用蚁群算法提出了精英蚁群模型(EAS)和改进的转移概率模型,应用全局搜索与局部搜索策略,来进行深度搜索。利用给出的最大-最小蚂蚁***(MAX-MINAS),所谓最大-最小即是为信息素设定上限与下限,设定上限避免搜索陷入局部最优,设定下限鼓励深度搜索。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (7)
1.基于室内定位的无人机辅助智能车驾驶***,其特征在于,包括智能车单元、无人机单元、PC端、UWB基站和UWB定位标签;
智能车单元具有电驱和方向控制功能,并配有信号接收装置,通过接收PC端发来的指令完成指定的循迹路线;
无人机单元通过搭载的摄像头模块对智能车周围环境进行图像采集,对采集图像进行预处理后发送给PC端,采集到的图像中均带有预先设置于场地内的人工标记;同时,无人机单元根据PC端下发的控制指令调整飞行姿态;
UWB定位标签设置于智能车单元和无人机单元上,不断发送UWB定位脉冲;
UWB基站有三个,三个UWB基站分别测量UWB定位脉冲并将测量结果反馈给PC端;
PC端根据接收到的测量结果采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位,然后根据初步定位结果生成无人机控制指令,控制无人机单元飞行在智能车单元的正上方;之后,根据无人机发送的图像和预先加载的场地栅格地图进行智能车精确定位和障碍物识别,根据精确定位结果控制无人机单元始终飞行在智能车单元的正上方,根据障碍物识别结果和预先设定好的目的地坐标对智能车的行驶路线进行规划。
2.根据权利要求1所述的基于室内定位的无人机辅助智能车驾驶***,其特征在于,所述UWB基站内置有stm32微处理器,其信号发射装置与接收装置集成为一体。
3.根据权利要求1所述的基于室内定位的无人机辅助智能车驾驶***,其特征在于,所述无人机单元配置有摄像头、图像处理模块、WIFI模块、信号接收装置、飞行控制模块和嵌入式主控模块;其中,
摄像头位于无人机下方,以固定的频率采集无人机下方区域图像;图像处理模块用于接收摄像头发来的信息,并对图像进行预处理;
飞行控制模块控制无人机的飞行姿态,并将无人机的飞行状态信息传输给嵌入式主控模块;
嵌入式主控模块用于驱动摄像头模块与图像处理模块工作,将处理完的数据通过WiFi模块发送给PC端作进一步处理,同时控制信号接收装置接收由PC端传来的飞行指令,驱动无人机以相应姿态飞行;
WiFi模块用以实现无人机与PC端之间的信息传输。
4.根据权利要求1所述的基于室内定位的无人机辅助智能车驾驶***,其特征在于,所述PC端上设有Wifi模块、路径规划模块、机车协同模块;其中,
Wifi模块用以实现PC端与无人机、智能车与UWB基站之间的信息传输;
路径规划模块基于由无人机端传输的数据,用神经网络的方式对实时路况进行判断,并规划出智能车的实时运行路线,这些路线指令将通过WIFI模块传回给无人机与智能车;
机车协同模块基于由无人机端传输的数据,实时监测无人机与智能车的体态位置信息,若出现误差超过所设阈值情况,立刻发送指令给无人机调整无人机姿态。
5.基于权利要求1-4任意一项所述***实现的基于室内定位的无人机辅助智能车驾驶方法,其特征在于,包括以下步骤:
(1)构建场地的栅格地图,在栅格地图中设置人工地标;
(2)在场地中设置UWB基站,并在栅格地图中标出UWB基站的坐标;
(3)将经过步骤(2)处理后的栅格地图加载到PC端;
(4)PC端与UWB基站以及UWB标签构成UWB定位***,采用TOF算法估算UWB定位标签的位置,实现无人机单元和智能车单元的初步定位;
(5)PC端根据无人机单元和智能车单元的初步定位结果生成无人机单元控制指令,使无人机飞行至智能车单元的正上方,并控制无人机的飞行高度始终在高度H;
(6)当PC端检测到无人机单元与智能车单元的位置差小于预设的阈值,则控制无人机单元开始采集图像;
(7)PC端接收无人机单元上传的图像数据,对图像中智能车单元进行边缘检测以提取智能车单元的轮廓和中心坐标,然后根据栅格地图中智能车中心位置与人工地标的相对位置计算出智能车单元的精确位置坐标;对图像中障碍物进行识别,确定障碍物的轮廓和坐标;
(8)PC端根据智能车单元的精确位置坐标对无人机单元的位置进行微调,使得无人机单元始终飞行在智能车单元正上方;PC端根据障碍物的轮廓和坐标以及预先设定好的目的地坐标对智能车单元的行驶路线进行规划,并控制智能车单元按照规划的路线行驶。
6.根据权利要求5所述的基于室内定位的无人机辅助智能车驾驶方法,其特征在于,当PC端在图像中未检测到智能车单元时,控制无人机单元以当前所在位置为中心点,作半径为1m范围的环绕飞行;若环绕飞行时间达到预设的时间阈值,则无人机返回起始点,PC端重新执行步骤(4)。
7.根据权利要求6所述的基于室内定位的无人机辅助智能车驾驶方法,其特征在于,所述步骤(8)中,采用改进的蚁群算法来进行路径规划。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011470627.5A CN112731922A (zh) | 2020-12-14 | 2020-12-14 | 基于室内定位的无人机辅助智能车驾驶方法与*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011470627.5A CN112731922A (zh) | 2020-12-14 | 2020-12-14 | 基于室内定位的无人机辅助智能车驾驶方法与*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112731922A true CN112731922A (zh) | 2021-04-30 |
Family
ID=75599873
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011470627.5A Pending CN112731922A (zh) | 2020-12-14 | 2020-12-14 | 基于室内定位的无人机辅助智能车驾驶方法与*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112731922A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113463718A (zh) * | 2021-06-30 | 2021-10-01 | 广西柳工机械股份有限公司 | 装载机防撞控制***与控制方法 |
CN113463719A (zh) * | 2021-06-30 | 2021-10-01 | 广西柳工机械股份有限公司 | 装载机自主作业控制***和方法 |
CN113703459A (zh) * | 2021-08-31 | 2021-11-26 | 疯壳(深圳)科技有限公司 | 一种模拟室内无人驾驶*** |
CN113790668A (zh) * | 2021-07-26 | 2021-12-14 | 广东工业大学 | 一种基于多旋翼无人机的智能货物测量*** |
CN114489112A (zh) * | 2021-12-13 | 2022-05-13 | 深圳先进技术研究院 | 一种智能车-无人机的协同感知***及方法 |
CN116315182A (zh) * | 2023-04-03 | 2023-06-23 | 广州小鹏汽车科技有限公司 | 电池管理***以及电池包 |
CN116520877A (zh) * | 2023-04-12 | 2023-08-01 | 华中科技大学 | 一种四旋翼无人机狭窄管道内自主定位及控制方法 |
CN117849708A (zh) * | 2024-03-07 | 2024-04-09 | 奥鼎智通(北京)科技有限公司 | 一种基于多传感器建图的超宽带定位方法及*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8063825B1 (en) * | 2009-05-07 | 2011-11-22 | Chun Yang | Cooperative position location via wireless data link using broadcast digital transmissions |
CN104699102A (zh) * | 2015-02-06 | 2015-06-10 | 东北大学 | 一种无人机与智能车协同导航与侦查监控***及方法 |
CN106932925A (zh) * | 2017-05-03 | 2017-07-07 | 南京大学 | 一种基于混沌信号的偏置控制装置及方法 |
CN107566065A (zh) * | 2017-08-25 | 2018-01-09 | 中山大学深圳研究院 | 基于uwb的tof定位方法 |
CN107664756A (zh) * | 2017-10-30 | 2018-02-06 | 成都九壹通智能科技股份有限公司 | 一种基于uwb定位技术的目标追踪*** |
CN110162103A (zh) * | 2019-06-13 | 2019-08-23 | 河南宙合网络科技有限公司 | 一种无人机与智能车组自主协同运输***及方法 |
-
2020
- 2020-12-14 CN CN202011470627.5A patent/CN112731922A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8063825B1 (en) * | 2009-05-07 | 2011-11-22 | Chun Yang | Cooperative position location via wireless data link using broadcast digital transmissions |
CN104699102A (zh) * | 2015-02-06 | 2015-06-10 | 东北大学 | 一种无人机与智能车协同导航与侦查监控***及方法 |
CN106932925A (zh) * | 2017-05-03 | 2017-07-07 | 南京大学 | 一种基于混沌信号的偏置控制装置及方法 |
CN107566065A (zh) * | 2017-08-25 | 2018-01-09 | 中山大学深圳研究院 | 基于uwb的tof定位方法 |
CN107664756A (zh) * | 2017-10-30 | 2018-02-06 | 成都九壹通智能科技股份有限公司 | 一种基于uwb定位技术的目标追踪*** |
CN110162103A (zh) * | 2019-06-13 | 2019-08-23 | 河南宙合网络科技有限公司 | 一种无人机与智能车组自主协同运输***及方法 |
Non-Patent Citations (2)
Title |
---|
李金鹏,张国恒: "四旋翼自主追踪智能车的***设计", 《电子技术与软件工程》 * |
王秋生,等: "基于无人机航拍图像的车道线检测方法综述", 《无人***技术》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113463718A (zh) * | 2021-06-30 | 2021-10-01 | 广西柳工机械股份有限公司 | 装载机防撞控制***与控制方法 |
CN113463719A (zh) * | 2021-06-30 | 2021-10-01 | 广西柳工机械股份有限公司 | 装载机自主作业控制***和方法 |
CN113790668A (zh) * | 2021-07-26 | 2021-12-14 | 广东工业大学 | 一种基于多旋翼无人机的智能货物测量*** |
CN113790668B (zh) * | 2021-07-26 | 2023-06-06 | 广东工业大学 | 一种基于多旋翼无人机的智能货物测量*** |
CN113703459A (zh) * | 2021-08-31 | 2021-11-26 | 疯壳(深圳)科技有限公司 | 一种模拟室内无人驾驶*** |
CN114489112A (zh) * | 2021-12-13 | 2022-05-13 | 深圳先进技术研究院 | 一种智能车-无人机的协同感知***及方法 |
WO2023109589A1 (zh) * | 2021-12-13 | 2023-06-22 | 深圳先进技术研究院 | 一种智能车-无人机的协同感知***及方法 |
CN116315182A (zh) * | 2023-04-03 | 2023-06-23 | 广州小鹏汽车科技有限公司 | 电池管理***以及电池包 |
CN116520877A (zh) * | 2023-04-12 | 2023-08-01 | 华中科技大学 | 一种四旋翼无人机狭窄管道内自主定位及控制方法 |
CN116520877B (zh) * | 2023-04-12 | 2024-04-26 | 华中科技大学 | 一种四旋翼无人机狭窄管道内自主定位及控制方法 |
CN117849708A (zh) * | 2024-03-07 | 2024-04-09 | 奥鼎智通(北京)科技有限公司 | 一种基于多传感器建图的超宽带定位方法及*** |
CN117849708B (zh) * | 2024-03-07 | 2024-05-17 | 奥鼎智通(北京)科技有限公司 | 一种基于多传感器建图的超宽带定位方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112731922A (zh) | 基于室内定位的无人机辅助智能车驾驶方法与*** | |
CN109164809B (zh) | 一种车辆编队自主跟随控制***及方法 | |
CN106774335B (zh) | 基于多目视觉和惯导的导引装置、地标布局及导引方法 | |
AU2017365026B2 (en) | Methods for autonomously navigating across uncontrolled and controlled intersections | |
Cosgun et al. | Towards full automated drive in urban environments: A demonstration in gomentum station, california | |
CN112558608B (zh) | 一种基于无人机辅助的车机协同控制及路径优化方法 | |
CN108628324B (zh) | 基于矢量地图的无人车导航方法、装置、设备及存储介质 | |
US11321950B2 (en) | Apparatus and method for detecting lane information, and computer-readable recording medium storing computer program programmed to execute same method | |
CN214151498U (zh) | 一种车辆控制***及车辆 | |
CN108490941A (zh) | 应用于道路清扫车的自动驾驶***及其控制方法、装置 | |
CN110466502A (zh) | 一种代客泊车方法和装置 | |
CN110174108B (zh) | 一种仿人的基于拓扑地图的agv自主定位导航方法 | |
US11417018B2 (en) | Device and method for calibrating camera for vehicle | |
CN109765909B (zh) | V2x***应用在港口的方法 | |
CN105955257A (zh) | 基于固定路线的公交车自动驾驶***及其驾驶方法 | |
RU2691679C1 (ru) | Способ создания трека пути движения для автономного движения подвижного объекта и способ осуществления автономного движения подвижного объекта по треку пути движения | |
CN113791621B (zh) | 一种自动驾驶牵引车与飞机对接方法及*** | |
CN113791619B (zh) | 一种机场自动驾驶牵引车调度导航***及方法 | |
US20230213946A1 (en) | Vehicle Navigation Positioning Method and Apparatus, and Base Station, System and Readable Storage Medium | |
CN112462762B (zh) | 一种基于路侧二维码单元的机器人室外自主移动***及其方法 | |
US11754415B2 (en) | Sensor localization from external source data | |
CN211741929U (zh) | 一种基于视觉导航的自动行走机器人 | |
CN114754780A (zh) | 车道线规划方法及相关装置 | |
CN109709944A (zh) | 一种自动驾驶公交车的进站方法及其进站路径的生成方法 | |
CN112611374A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210430 |