一个实例了解自动驾驶路径规划 —— （一）自动泊车实例介绍及A*算法代码分享

言归正传，自动泊车是目前（2021年）自动驾驶ADAS中非常火热的一环，与ACC，AEB不同的是，自动泊车是低速自动驾驶，安全问题要小的多。自动泊车主要涉及的领域有：

1、感知：计算机视觉——车位识别，AVM车位（视觉检测的白线车位）；超声波雷达——检测障碍物车位（处理没有白线，或者压住白线导致车位检测不到）；

2、融合：视觉车位与超声波雷达车位的信息融合；

3、定位：用以确定车辆实时位置，判断车辆是否停到位等；

4、路径规划：结合感知和定位给出合理路径，主要应用HybridA*（自动泊车属于狭窄空间路径规划，还是挺难的）；

5、控制：泊车执行环节，控制车的方向盘，车速，使车辆根据给出的路径到达终点，stanly算法，纯跟踪算法，PID控制基本都属于这一环节。

可见，自动泊车涉及的自动驾驶领域还是很全的。自动泊车的车位主要分为三类：

• 垂直车位

• 水平车位

• 斜列车位

其中斜列车位可以和垂直车位看做一体，可以把垂直车位看做特殊的斜列车位。

在现在的市场中，可以听到小马智行，百度apollo，AutoX这样的科技公司运营自动驾驶出租车，也可以看到小鹏、比亚迪、特斯拉这样上市的辅助驾驶车，自动泊车属于辅助驾驶，需要注意的是，根据车辆成本，实现自动驾驶的方案是不一样的，进而导致算法不一样。比如AutoX的出租车，成本很高，可以做到高级自动驾驶，多采用激光雷达和毫米波雷达等，车顶上都有个大盖子。这样的配置在十几万的国产车上是不现实的，因此就有了低成本方案，通过十几块钱的板子、结合摄像头、超声波雷达来做自动泊车这样的辅助驾驶。很明显，板子的算力有限，因此自动泊车的算法要与AUtoX这样的出租车中的算法有明显不同。

自动泊车分为很多类，有APA、记忆泊车、AVP代客泊车等等，简要的说，就是自动泊车是从帮助人停车往自动寻找车位，自动停车，自动泊出的方向进化的，最终的理想状态可以想象这样一幅场景：

1、驾车前往商场，到商场门口后下车购物，同时下达自动泊车指令，车辆开始巡航，寻找商场停车位并完成泊车；购物结束后，从另外一个门出来，手机给车辆发送定位，车辆自动泊出，并前往上车地点。

2、到家后，犹豫很久未充电，车辆电力不足，下达充电指令，车辆搜索附近充电桩占用情况，发现一小时后有空位，于是一小时后自动启动，前往充电桩充电，省去人排队的时间，充电完毕后结合支付设定完成付费，再次自动泊车至家中位置。

可以看到，自动泊车解决了自动驾驶的开始和结束的问题，这里也可以发现一个明显问题，车辆如何知道附近有车位，或者充电桩信息呢？于是就有了车端和场端的概念，停车场，充电桩也智能化，与汽车完成通信，发送自身的信息，如车位信息，充电桩占用信息等，这就是场端。

随之而来的下一个问题，就是在到达车位、充电桩的过程中，要走怎样的路径，这就涉及到本次主题路径规划了，路径规划分全局路径规划和局部路径规划，个人认为不需要如此细分，细分过多反而带来理解上个困难，两者用的其实都是同一原理，算法稍有不同，但目的就是为了找到一条路。粗略理解可以按以下理解：

1、全局规划：停车场告知车位位置，车辆从自身位置到车位附近这一段是全局路径规划（如S1到S3），感知的信息是周围的环境信息。

2、局部规划：车道车位附近后，比如在S3点，要停到车位的中间点A5，那么S3到A5的路线就是局部规划。