CN110045727A - 一种园区无人车路径规划与控制方法 - Google Patents
一种园区无人车路径规划与控制方法 Download PDFInfo
- Publication number
- CN110045727A CN110045727A CN201811464445.XA CN201811464445A CN110045727A CN 110045727 A CN110045727 A CN 110045727A CN 201811464445 A CN201811464445 A CN 201811464445A CN 110045727 A CN110045727 A CN 110045727A
- Authority
- CN
- China
- Prior art keywords
- unmanned vehicle
- control method
- garden
- satellite navigation
- path
- 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
- 238000000034 method Methods 0.000 title claims abstract description 18
- 230000004888 barrier function Effects 0.000 claims abstract description 4
- 238000005516 engineering process Methods 0.000 claims description 9
- 238000002474 experimental method Methods 0.000 claims description 6
- 238000005192 partition Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000002485 combustion reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000002156 mixing Methods 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000000007 visual effect Effects 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 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
Abstract
一种园区无人车路径规划与控制方法，无人车首先通过卫星导航方式在工业园区、校园、旅游景点、港口码头等固定场所采集路径位置信息，由控制器建立规划主线路与建立路径跟踪算法，从而控制无人车沿之前规划路径运行，并实时通过TOF三维相机获取周边环境信息，用于检测行进过程中障碍物，以进行规避重新规划线路，有效提高无人车运行的稳定性。
Description
技术领域
本发明涉及智能移动技术领域，尤其涉及一种园区无人车路径规划与控制方法。
背景技术
无人车是一种具备自动驾驶功能的移动车辆，也可成为轮式移动机器人，是一种通过计算机系统实现无人驾驶的智能汽车。
随着科技的进步、智能技术的发展，无人车研究也获得快速发展，国外谷歌、国内百度等科技企业开发的无人驾驶汽车都在进行紧张的测试中，但都难以获得大范围实质性的使用。主要是由于道路环境比较复杂多变，而现有无人驾驶技术还不够成熟，无法达到稳定安全地在道路上运行。因此针对特定区域范围内开展无人车的设计研发，技术难度低，运行更加稳定可靠，能够更加快捷实现应用。
在工业园区、校园、旅游景点、港口码头等场所人员、货物流动比较频繁，传统的方式一般采用有人驾驶燃油车辆或者电动车辆进行转运，存在效率低，人力资源消耗大等，无人车的使用完美解决这些缺陷。
当前无人车主要依靠人工智能、视觉传感器、雷达测距、监控装置和卫星定位系统等协同合作，由计算机整合规划无人车的运行路径及控制无人车运行，该方式存在多传感器融合算法复杂，运算量大，实现难度大等特点。
发明内容
本发明所解决的技术问题在于提供一种园区无人车路径规划与控制方法，以解决上述背景技术中的缺点。
本发明所解决的技术问题采用以下技术方案来实现：
一种园区无人车路径规划与控制方法，具体步骤如下：
1)无人车上安装有用于采集周边环境信息的TOF三维传感器、控制器及用于采集路径位置信息的卫星导航接收机，且TOF三维传感器、卫星导航接收机分别与控制器连接；
2)根据无人车的具体工作性质及工作需求，控制器将其规划线路划分为多个直线段LN，并采集上述各直线段端点的精确位置信息Sn(Xn，Yn)，Xn为经度值，Yn为纬度值，直线段LN用首尾端点表示(Sn，Sn+1)，无人车规划路径主线路则为直线段Ln的集合；
3)建立无人车运动模型，通过卫星导航接收机获取前转向轮轴中心A1(XA1，YA1)、后轮轴中心A3(XA3，YA3)的坐标，且卫星导航接收机同时能够提供表示A3指向A1角度的无人车航向角度
4)控制器控制无人车沿规划线路运行，实时获得无人车与规划线路距离偏差及角度偏差，d1为无人车前轮轴中心A1与线段Ln的垂直距离偏差，d3为无人车后轮轴中心A3与线段Ln的垂直距离偏差，β为无人车前轮轴中心A1与线段Ln的角度偏差，θ为控制无人车前轮转向的角度，公式为：
θ＝a*β+b*d1+c*d3 (1)
公式(1)中，a、b、c为系数，通过实验获得，角度偏差β为无人车航向角与线段Ln对应角度γ的差值；
5)控制无人车前轮转向角度θ与无人车当前速度有关，无人车当前速度越大，前轮转向角度θ越小，最终控制转向角度θ′公式为：
θ′＝e*v2*θ+f (2)
其中e、f为系数，通过实验获得，v为无人车当前速度；
6)无人车根据公式(1)～(2)控制无人车按规划轨迹运行，在正常运行时需时刻检测周边环境是否有障碍物；
7)以无人车中心为坐标原点，建立无人车当前三维地图，TOF三维传感器扫描所得数据集合Dn为[Xn，Yn，Zn，δn]，其中δn为对应三维坐标(Xn，Yn，Zn)处灰度值；
8)控制器根据TOF三维传感器所得数据判断前方有无障碍物，若有，则计算获得障碍物尺寸，舍弃当前线路，并重新插入新路径与后续线路连接，保证规划线路连续。
在本发明中，卫星导航接收机为双天线式卫星导航接收机，包括前天线与后天线，前天线放置于前转向轮轴中心，后天线放置于后轮中心。
在本发明中，卫星导航接收机通过具有RTK技术的全球卫星导航获取通用基站差分信号。
在本发明中，卫星导航接收机通过北斗或GPS获取通用基站差分信号。
在本发明中，TOF三维传感器安装在无人车中心。
在本发明中，无人车的规划线路为环形线路，则主线路集合Ln的首尾端点坐标值相同，无人车的规划线路往返式路径，则在转向时将主线路集合Ln坐标调转即可。
有益效果：
1)本发明采用具有RTK载波相位差分技术的卫星导航获取精密位置信息用于采集路径位置信息，并以此为基础建立路径线路；
2)本发明中控制器将采集的路径位置信息归为规划线路集合，作为无人车行进主线路，从而确定规划线路；
3)本发明将卫星导航精密位置信息结合TOF三维传感器用于导航控制，即可实现室外精密位置导航，同时可用于实时避障判断，有效提高无人车运行的稳定性。
附图说明
图1为本发明的较佳实施例中的无人车运行模型示意图。
图2为本发明的较佳实施例中的无人车轨迹跟踪示意图。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解，下面结合具体图示，进一步阐述本发明。
参见图1～图2的一种园区无人车路径规划与控制方法，以在工业园区、校园、旅游景点、港口码头等室外固定场所开展通勤、客运、观光、物流转运等特定作业方式的无人车为例，具体步骤如下：
1)由具有RTK技术全球卫星导航、北斗或GPS的双天线式卫星导航接收机采集固定场所路径位置信息并通过经移动4G网络获取通用基站差分信号，如“千寻位置网络”提供的差分数据，使双天线式卫星导航接收机可在更广阔范围内接受差分信号，从而计算获得厘米级精度的位置信息；
2)根据无人车的具体工作性质及工作需求，将其规划线路划分为多个直线段LN，并采集上述各直线段端点的精确位置信息Sn(Xn，Yn)，Xn为经度值，Yn为纬度值，直线段LN用首尾端点表示(Sn，Sn+1)，无人车规划路径主线路则为直线段Ln的集合；
3)若规划线路为环形线路，则主线路集合Ln的首尾端点坐标值相同，若为往返式路径，则在转向时将主线路集合Ln坐标调转即可；
4)建立无人车运动模型，如图1所示，A1为前转向轮轴中心，A2为无人车中心，A3为后轮轴中心，前天线放置于前转向轮轴中心A1，后天线放置于后轮中心A3，用以获得两处精确位置坐标A1(XA1，YA1)、A3(XA3，YA3)，双天线式卫星导航接收机同时能够提供无人车航向角度表示A3指向A1的角度；
5)控制器控制无人车沿规划线路运行，实时获得无人车与规划线路距离偏差及角度偏差，如图2所示，d1为无人车前轮轴中心A1与线段Ln的垂直距离偏差，d3为无人车后轮轴中心A3与线段Ln的垂直距离偏差，β为无人车前轮轴中心A1与线段Ln的角度偏差，θ为控制无人车前轮转向的角度，公式为：
θ＝a*β+b*d1+c*d3 (1)
公式(1)中，a、b、c为系数，通过实验获得，角度偏差β为无人车航向角与线段Ln对应角度γ的差值；
6)控制无人车前轮转向角度θ与无人车当前速度有关，无人车当前速度越大，前轮转向角度θ越小，最终控制转向角度θ′公式为：
θ′＝e*v2*θ+f (2)
其中e、f为系数，通过实验获得，v为无人车当前速度；
7)无人车根据公式(1)～(2)控制无人车按规划轨迹运行，在正常运行时需时刻检测周边环境是否有障碍物，在无人车中心A2安装有TOF三维传感器用于采集周边环境信息；
8)以无人车中心为坐标原点，建立无人车当前三维地图，TOF三维传感器扫描所得数据集合Dn为[Xn，Yn，Zn，δn]，其中δn为对应三维坐标(Xn，Yn，Zn)处灰度值；
9)控制器根据TOF三维传感器所得数据判断前方有无障碍物，若有，则计算获得障碍物尺寸，舍弃当前线路，并重新插入新路径，与后续线路连接，保证规划线路连续。
以上显示和描述了本发明的基本原理和主要特征和本发明的优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是说明本发明的原理，在不脱离本发明精神和范围的前提下，本发明还会有各种变化和改进，这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (8)
1.一种园区无人车路径规划与控制方法，其特征在于，具体步骤如下：
1)无人车上安装有用于采集周边环境信息的TOF三维传感器、控制器及用于采集路径位置信息的卫星导航接收机，且TOF三维传感器、卫星导航接收机分别与控制器连接；
2)根据无人车的具体工作性质及工作需求，控制器将其规划线路划分为多个直线段LN，并采集上述各直线段端点的精确位置信息Sn(Xn，Yn)，Xn为经度值，Yn为纬度值，直线段LN用首尾端点表示(Sn，Sn+1)，无人车规划路径主线路则为直线段Ln的集合；
3)建立无人车运动模型，通过卫星导航接收机获取前转向轮轴中心A1(XA1，YA1)、后轮轴中心A3(XA3，YA3)的坐标，且卫星导航接收机同时能够提供表示A3指向A1角度的无人车航向角度
4)控制器控制无人车沿规划线路运行，实时获得无人车与规划线路距离偏差及角度偏差，d1为无人车前轮轴中心A1与线段Ln的垂直距离偏差，d3为无人车后轮轴中心A3与线段Ln的垂直距离偏差，β为无人车前轮轴中心A1与线段Ln的角度偏差，θ为控制无人车前轮转向的角度，公式为：
θ＝a*β+b*d1+c*d3 (1)
公式(1)中，a、b、c为系数，通过实验获得，角度偏差β为无人车航向角与线段Ln对应角度γ的差值；
5)控制无人车前轮转向角度θ与无人车当前速度有关，无人车当前速度越大，前轮转向角度θ越小，最终控制转向角度θ′公式为：
θ′＝e*v2*θ+f (2)
其中e、f为系数，通过实验获得，v为无人车当前速度；
6)无人车根据公式(1)～(2)控制无人车按规划轨迹运行，在正常运行时需时刻检测周边环境是否有障碍物；
7)以无人车中心为坐标原点，建立无人车当前三维地图，TOF三维传感器扫描所得数据集合Dn为[Xn，Yn，Zn，δn]，其中δn为对应三维坐标(Xn，Yn，Zn)处灰度值；
8)控制器根据TOF三维传感器所得数据判断前方有无障碍物，若有，则计算获得障碍物尺寸，舍弃当前线路，并重新插入新路径与后续线路连接，保证规划线路连续。
2.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，卫星导航接收机为双天线式卫星导航接收机，包括前天线与后天线。
3.根据权利要求2所述的一种园区无人车路径规划与控制方法，其特征在于，前天线放置于前转向轮轴中心，后天线放置于后轮中心。
4.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，卫星导航接收机通过具有RTK技术的全球卫星导航获取通用基站差分信号。
5.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，卫星导航接收机通过北斗或GPS获取通用基站差分信号。
6.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，TOF三维传感器安装在无人车中心。
7.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，无人车的规划线路为环形线路，则主线路集合Ln的首尾端点坐标值相同。
8.根据权利要求1所述的一种园区无人车路径规划与控制方法，其特征在于，无人车的规划线路往返式路径，则在转向时将主线路集合Ln坐标调转即可。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811464445.XA CN110045727B (zh) | 2018-12-03 | 2018-12-03 | 一种园区无人车路径规划与控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811464445.XA CN110045727B (zh) | 2018-12-03 | 2018-12-03 | 一种园区无人车路径规划与控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110045727A true CN110045727A (zh) | 2019-07-23 |
| CN110045727B CN110045727B (zh) | 2022-08-05 |
Family
ID=67273273
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201811464445.XA Active CN110045727B (zh) | 2018-12-03 | 2018-12-03 | 一种园区无人车路径规划与控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110045727B (zh) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110580046A (zh) * | 2019-09-12 | 2019-12-17 | 吉利汽车研究院（宁波）有限公司 | 一种无人驾驶观光车的控制方法及其系统 |
| CN111459172A (zh) * | 2020-05-20 | 2020-07-28 | 中国北方车辆研究所 | 围界安防无人巡逻车自主导航系统 |
| CN112256034A (zh) * | 2020-11-02 | 2021-01-22 | 东软睿驰汽车技术（沈阳）有限公司 | 自主避障规划方法和装置 |
| CN113253741A (zh) * | 2021-06-29 | 2021-08-13 | 浙江华睿科技有限公司 | 一种agv叉车的控制方法、装置及计算机可读介质 |
| CN113362487A (zh) * | 2021-06-21 | 2021-09-07 | 广西电网有限责任公司电力科学研究院 | 配电线路无人机智能自主巡检统一管控系统 |
| CN114234968A (zh) * | 2021-12-17 | 2022-03-25 | 江西洪都航空工业集团有限责任公司 | 一种基于a星算法的移动机器人自主导航方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104714551A (zh) * | 2015-03-23 | 2015-06-17 | 中国科学技术大学 | 一种适用于车式移动机器人的室内区域覆盖方法 |
| US20170015312A1 (en) * | 2015-07-13 | 2017-01-19 | Magna Electronics Inc. | Parking assist system for vehicle |
| CN106371445A (zh) * | 2016-11-17 | 2017-02-01 | 浙江大学 | 一种基于拓扑地图的无人车规划控制方法 |
| CN107037812A (zh) * | 2017-03-31 | 2017-08-11 | 南京理工大学 | 一种基于仓储无人车的车辆路径规划方法 |
| CN107943049A (zh) * | 2017-12-13 | 2018-04-20 | 江西洪都航空工业集团有限责任公司 | 一种无人车控制方法及无人割草车 |
-
2018
- 2018-12-03 CN CN201811464445.XA patent/CN110045727B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104714551A (zh) * | 2015-03-23 | 2015-06-17 | 中国科学技术大学 | 一种适用于车式移动机器人的室内区域覆盖方法 |
| US20170015312A1 (en) * | 2015-07-13 | 2017-01-19 | Magna Electronics Inc. | Parking assist system for vehicle |
| CN106371445A (zh) * | 2016-11-17 | 2017-02-01 | 浙江大学 | 一种基于拓扑地图的无人车规划控制方法 |
| CN107037812A (zh) * | 2017-03-31 | 2017-08-11 | 南京理工大学 | 一种基于仓储无人车的车辆路径规划方法 |
| CN107943049A (zh) * | 2017-12-13 | 2018-04-20 | 江西洪都航空工业集团有限责任公司 | 一种无人车控制方法及无人割草车 |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110580046A (zh) * | 2019-09-12 | 2019-12-17 | 吉利汽车研究院（宁波）有限公司 | 一种无人驾驶观光车的控制方法及其系统 |
| CN110580046B (zh) * | 2019-09-12 | 2022-08-16 | 吉利汽车研究院（宁波）有限公司 | 一种无人驾驶观光车的控制方法及其系统 |
| CN111459172A (zh) * | 2020-05-20 | 2020-07-28 | 中国北方车辆研究所 | 围界安防无人巡逻车自主导航系统 |
| CN111459172B (zh) * | 2020-05-20 | 2023-10-31 | 中国北方车辆研究所 | 围界安防无人巡逻车自主导航系统 |
| CN112256034A (zh) * | 2020-11-02 | 2021-01-22 | 东软睿驰汽车技术（沈阳）有限公司 | 自主避障规划方法和装置 |
| CN112256034B (zh) * | 2020-11-02 | 2024-03-19 | 东软睿驰汽车技术（沈阳）有限公司 | 自主避障规划方法和装置 |
| CN113362487A (zh) * | 2021-06-21 | 2021-09-07 | 广西电网有限责任公司电力科学研究院 | 配电线路无人机智能自主巡检统一管控系统 |
| CN113253741A (zh) * | 2021-06-29 | 2021-08-13 | 浙江华睿科技有限公司 | 一种agv叉车的控制方法、装置及计算机可读介质 |
| CN114234968A (zh) * | 2021-12-17 | 2022-03-25 | 江西洪都航空工业集团有限责任公司 | 一种基于a星算法的移动机器人自主导航方法 |
| CN114234968B (zh) * | 2021-12-17 | 2023-12-05 | 江西洪都航空工业集团有限责任公司 | 一种基于a星算法的移动机器人自主导航方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110045727B (zh) | 2022-08-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110045727A (zh) | 一种园区无人车路径规划与控制方法 | |
| CN108983781B (zh) | 一种无人车目标搜索系统中的环境探测方法 | |
| CN106774313B (zh) | 一种基于多传感器的室外自动避障agv导航方法 | |
| US10845457B2 (en) | Drone localization | |
| US10627816B1 (en) | Change detection using curve alignment | |
| US11423677B2 (en) | Automatic detection and positioning of pole-like objects in 3D | |
| US10970542B2 (en) | Scalable three dimensional object segmentation | |
| CN103456185B (zh) | 智能车在城市道路行驶中的接力导航方法 | |
| Pfaff et al. | Towards mapping of cities | |
| CN108645420B (zh) | 一种基于差分导航的自动驾驶车辆多路径地图的创建方法 | |
| CN105955257A (zh) | 基于固定路线的公交车自动驾驶系统及其驾驶方法 | |
| CN108961811A (zh) | 停车场车辆定位方法、系统、移动终端及存储介质 | |
| CN110992723A (zh) | 一种无人驾驶交通导航信号设备和其管理系统 | |
| CN112629522B (zh) | 一种反光板与激光slam融合的agv定位方法及系统 | |
| CN102788580A (zh) | 无人机视觉导航中的飞行路线合成方法 | |
| CN108627864A (zh) | 基于汽车钥匙的定位方法及系统、无人驾驶汽车系统 | |
| CN107091647A (zh) | 港口集装箱水平搬运无人车导航方法 | |
| Li et al. | Hybrid filtering framework based robust localization for industrial vehicles | |
| CN108549373A (zh) | 一种基于导航角偏差进行车辆运行信息处理的方法和装置 | |
| Axmann et al. | LUCOOP: Leibniz University Cooperative Perception and Urban Navigation Dataset | |
| Wang et al. | Stop-line-aided cooperative positioning for connected vehicles | |
| CN111708010B (zh) | 一种可移动设备的定位方法、装置、系统及可移动设备 | |
| CN106382916A (zh) | 自建参考系的双六足机器人复杂地形三维立体测绘系统与方法 | |
| Betaille et al. | Making an enhanced map for lane location based services | |
| CN109828569A (zh) | 一种基于2d-slam导航的智能agv叉车 |
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 |