[发明专利]基于北斗卫星导航的四轮载具自动驾驶装置及其操控方法

说明书

技术领域

本发明涉及车辆自动控制系统，尤其是基于北斗高精度卫星导航的农机无人驾驶与自动驾驶的装置及操控方法。

背景技术

自动驾驶车辆是一种典型的四轮移动机器人，涉及众多交叉学科知识，是当代计算机科学、模式识别、控制技术的高度结合和发展的产物，其利用功能不一的传感器来感知车辆状态，并根据规划好的路径，控制车辆的速度和转向，从而使车辆能够安全地在道路上自主驾驶。

无人驾驶车辆技术的迅速发展和广泛应用将给人们的日常生活带来深远影响和巨大的利益。积极研究和发展无人驾驶车辆技术，对于我国在激烈的国际竞争中取得有利地位具有重要意义。

目前国内农机自动驾驶的相关研究存在的问题有两点。第一：需要改装液压油路，会给农机带来故障隐患。第二：由于直接控制液压油缸，会出现突然打死导向轮的情况，有可能发生安全事故。

发明内容

为了解决上述技术问题，本发明提供一种四轮载具自动驾驶装置，通过安装电控方向盘实现控制转向轴来控制导向轮转动，从而实现对农机的自动驾驶控制；在安装的过程中避免对农机的油路进行改装，直接在方向盘位置安装电控方向盘，从而防止破坏农机的原有设备；本装置完全模拟真人操作方向盘，避免了突然打死导向轮的情况发生，避免了安全事故隐患。

本发明还提供了该装置的操控方法，先设置农机理想路径到控制器，控制器将根据理想路径控制电控方向盘带动农机转向轴转动从而驱动导向轮，实现对农机的自动驾驶控制。

本发明解决其技术问题所采用的技术方案是：

基于北斗卫星导航的四轮载具自动驾驶装置，包括北斗卫星移动站接收机、北斗卫星基准站接收机、角位移传感器、车载控制器、卫星天线。

北斗卫星移动站接收机与北斗卫星基准站接收机通过无线网络连接，北斗卫星移动站接收机与车载控制器通过数据线缆连接。

还包括电控方向盘，所述电控方向盘与车载控制器通过数据与电源线缆连接，角位移传感器与电控方向盘通过数据线缆连接。

电控方向盘通过花键与农机的转向轴连接，控制器控制电控方向盘转动同时带动转向轴转动，转向轴带动导向轮转动，实现对农机前进方向的控制。

所述角位移传感器安装在任意一个导向轮转轴上，导向轮受方向盘控制，并且与转轴成同轴转动，使得角位移传感器能反应导向轮的真实转角，用于获取导向轮的角度变化。

将两个卫星天线分别安装在四轮载具的前端左右两侧的机架上，并且与四轮载具的前向呈近似90度的夹角，并且将卫星天线的电缆连接到北斗卫星移动站接收机。

所述北斗卫星移动站接收机包括两个卫星天线、一个接收机主板、一个无线接收天线。

北斗卫星移动站接收机的两个卫星天线用于计算安装有两个卫星天线的四轮载具的横滚角度以及四轮载具的前向与正北方向的夹角。

北斗卫星移动站接收机用于获取载波相位观测值并且通过无线接收天线获取北斗卫星基准站接收机发送的载波相位观测值，之后通过载波相位差分算法计算北斗卫星移动站接收机的高精度位置。

所述北斗卫星基准站接收机包括一个卫星天线、一个接收机主板、一个无线发射天线。

北斗卫星基准站接收机用于获取载波相位观测值并将其获取的载波相位观测值通过无线发射天线发送给北斗卫星移动站接收机。

所述车载控制器为带有显示屏的车载工控机。

所述车载控制器能够根据北斗卫星移动站接收机提供的两个卫星天线的位置来计算当前四轮载具的位置与姿态，同时计算与目标路径的相位误差。

基于北斗卫星导航的四轮载具自动驾驶装置的操控方法，包括如下几个步骤：

S1)路径及参数设置：通过车载控制器设置四轮载具的各项参数，包括北斗卫星移动站接收机的两个卫星天线的安装位置、四轮载具轴距、四轮载具轮距和四轮载具的车轮极限角度、方向盘与转向轮的传动比，然后规划理想路径；

S2)位置及姿态计算：根据北斗卫星移动站接收机提供的高精度的经纬度数据进行投影计算，获取当前位置的平面坐标，并且根据设置好的各项参数计算四轮载具此时的位置和姿态；

S3）计算目标转向角度：通过比较此时四轮载具位置与理想路径的横向误差与航向误差，计算获得当前需要四轮载具的转向角度为目标转向角度，记为γ；

S4）计算导向轮转动角：通过读取角位移传感器的数据，得到导向轮此时的角度θ，则导向轮还需要转动的角度为γ-θ，记为Δθ；

S5）角度换算：将导向轮还需要转动的角度Δθ换算成为电控方向盘的转动圈数，同时控制方向盘转动相应的圈数；