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

权利要求书

1.基于北斗卫星导航的四轮载具自动驾驶装置，包括北斗卫星移动站接收机、北斗卫星基准站接收机、角位移传感器、车载控制器、卫星天线；所述北斗卫星移动站接收机与北斗卫星基准站接收机通过无线网络连接，所述北斗卫星移动站接收机与车载控制器通过数据线缆连接，其特征是：还包括电控方向盘，所述电控方向盘与车载控制器通过数据与电源线缆连接，角位移传感器与电控方向盘通过数据线缆连接；电控方向盘通过花键与农机的转向轴连接，控制器控制电控方向盘转动同时带动转向轴转动，转向轴带动导向轮转动，实现对农机前进方向的控制。

2.根据权利要求1所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：所述角位移传感器安装在任意一个导向轮转轴上，导向轮受方向盘控制，并且与转轴成同轴转动，使得角位移传感器能反应导向轮的真实转角，用于获取导向轮的角度变化。

3.根据权利要求1所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：将两个卫星天线分别安装在四轮载具的前端左右两侧的机架上，并且与四轮载具的前向呈近似90度的夹角，并且将卫星天线的电缆连接到北斗卫星移动站接收机。

4.根据权利要求1所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：所述北斗卫星移动站接收机包括两个卫星天线、一个接收机主板、一个无线接收天线；北斗卫星移动站接收机的两个卫星天线用于计算安装有两个卫星天线的四轮载具的横滚角度以及四轮载具的前向与正北方向的夹角。

5.根据权利要求1或4所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：北斗卫星移动站接收机用于获取载波相位观测值并且通过无线接收天线获取北斗卫星基准站接收机发送的载波相位观测值，之后通过载波相位差分算法计算北斗卫星移动站接收机的高精度位置。

6.根据权利要求1所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：所述北斗卫星基准站接收机包括一个卫星天线、一个接收机主板、一个无线发射天线；北斗卫星基准站接收机用于获取载波相位观测值并将其获取的载波相位观测值通过无线发射天线发送给北斗卫星移动站接收机。

7.根据权利要求1所述的基于北斗卫星导航的四轮载具自动驾驶装置，其特征是：所述车载控制器为带有显示屏的车载工控机；所述车载控制器能够根据北斗卫星移动站接收机提供的两个卫星天线的位置来计算当前四轮载具的位置与姿态，同时计算与目标路径的相位误差。

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

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

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

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

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

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

S6)过程重复：系统自动检测并重复步骤2-5，使农机会逐渐逼近理想路径，之后会按照规划好的理想路径进行行驶，从而实现对农机的自动驾驶控制。