[发明专利]一种农机自动导航控制系统

说明书

本发明涉及卫星导航控制技术领域，提供了一种包括：导航控制装置、电子控制单元ECU、液压控制装置、车轮装置和转向角度测量装置的农机自动导航控制系统，该系统为一个闭环控制系统，从而提高了农机自动导航驾驶技术的精度。同时本发明还提供包括角度传感器、固定支架、连接杆、夹板、第一连杆、第二连杆和转动件的角度转向角度测量装置，此装置可以应用在不同的农机上，能够精确地测量农机的转向角度信息，同时安装灵活，提高角度传感器的稳定性和精度，为农机自动导航控制系统的精度提供很好的基础。

技术领域

本发明涉及卫星导航控制技术领域,尤其涉及一种农机自动导航控制系统。

背景技术

精准农业是当今世界农业发展的新潮流，现阶段主要是应用全球定位系统(Global Position System，简称GPS)，全球定位系统具有全天候、高精度、自动化等显著特点，为地理地籍信息采集提供了较为成熟的定位技术。其中，单GPS系统的定位精度优于10米，而采用差分全球定位系统(Difference Global Positioning System，简称DGPS)技术，利用已知精确三维坐标的差分GPS基准台求得DGPS差分数据，再将该差分数据实时或事后发送给用户接收机，对用户的测量数据进行误差修正，定位精度可达到厘米或毫米级。

全球定位技术虽然已经比较高，但只是依靠GPS信号来判断农机的位置是不够准确度，GPS可以准确的提供农机的位置(农机所在的精度与纬度)，而不能很好地提供农机方向盘的操作实时状况(不能判断农机实时方向盘位于左打，右打或者中间位置，更加不要说可以提供方向盘位于左打多少度或右打多少度)，而没有一个正确的反馈过程，所以这种开环控制的农机自动驾驶技术使农机自动行驶过程会出现过大的偏差，从而导致农机自动导航驾驶技术的精度不高。

另外，现有的角度转向角度测量装置比较多，根据应于领域不同，其角度测量原理就不同。例如应用于汽车领域的角度转向角度测量装置，一种轻型汽车转向节角度转向角度测量装置(公告号：CN 203349763 U)，该装置包括底板、主销孔定位轴、转向臂支承孔键槽延伸板、转向臂支承孔键槽角度测量板、主轴颈缩角度检测板等构件。但是该装置不能应用于农业拖拉机的转向节角度测量，只能应用于有主销与转向节的汽车，而农业拖拉机前轮没有主销。

发明内容

本发明的目的在于提供农机自动导航控制系统,旨在解决现有的农机自动导航控制系统精度不高和转向角度不易测量的问题。

一种农机自动导航控制系统，所述系统包括：导航控制装置、电子控制单元ECU、液压控制装置、车轮装置和转向角度测量装置；

所述导航控制装置用于接收差分信号，确定定位信息并将所述定位信息发送给所述电子控制单元ECU；所述转向角度测量装置用于测量农机的行驶信息，并将所述行驶信息发送给所述电子控制单元ECU；

所述电子控制单元ECU根据所述定位信息和所述行驶信息，经过数据处理后生产控制信息，并将所述控制信息发送给所述液压控制装置；

所述液压控制装置根据所述控制信息控制农机车轮装置实现农机向着预设轨迹行驶；所述转向角度测量装置还用于测量农机的转向角度信息，并将转向角度信息传递给电子控制单元ECU，所述电子控制单元ECU结合所述定位信息进行第二次调控，直至农机按预设轨迹行走为止；

所述导航控制装置、电子控制单元ECU、液压控制装置、车轮装置和转向角度测量装置构成闭合控制环路。

进一步地，所述转向角度测量装置包括加速度转向角度测量装置和角度转向角度测量装置,所述加速度转向角度测量装置用于测量农机行驶的加速度信息；所述角度转向角度测量装置用于测量农机行驶的转向角度信息。

进一步地，所述角度转向角度测量装置包括：角度传感器、固定支架、连接杆、夹板、第一连杆、第二连杆和转动件；