本发明专利技术公开了一种基于双陀螺仪控制的自动驾驶农机，包括车身和底盘，所述底盘前后分别连接有前桥和后桥，所述前桥包括前车轮、前连接臂和转向机构，所述前连接臂两端分别连接有转向盘，所述前连接臂靠近其中一个转向盘的一端上方设置有第一陀螺仪，且所述前连接臂靠近另一个转向盘的一侧设置有缓冲机构，所述转向杆两端分别连接转向盘，所述后桥包括后车轮和后连接臂，所述后连接臂的中间位置设置有第二陀螺仪，通过两只陀螺仪实时进行角度纠偏，可以避免单一陀螺仪检测故障造成农机自动驾驶过度偏离的问题，同时整个导航过程中，通过两只陀螺仪耦合了陀螺的误差，即上个时刻的位置速度姿态误差等影响比较大的误差源，从而提高导航精度。高导航精度。高导航精度。
【技术实现步骤摘要】
一种基于双陀螺仪控制的自动驾驶农机
[0001]本专利技术属于农机
，尤其涉及一种基于双陀螺仪控制的自动驾驶农机 。
技术介绍
[0002]我国农业机械化程度越来越高，大大提高了农业的生产力。但传统的机械应用完全依赖人工操作，劳动强度大，对驾驶员技能要求高，作业质量无法保证，夜间作业质量更低甚至无法作业;尤其针对播种、开沟、覆膜、起垄、中耕、打药等对直线度及结合线精度要求较高的作业，无法保证质量和效率，导致土地浪费严重，作业损耗严重。目前已有很多农机自动驾驶系统，可以有效提高农业自动化作业。
[0003]然而目前的农机自动驾驶方案普遍存在导航精度不高，同时，农机作业时受轮胎磨损程度和地形状况等因素影响，行驶过程中累计误差逐渐造成航向偏离，需要反复调整，不能够有效实现农机精确按照预设线路自动行驶，因此需要一种能够自动调整航向的农机，使农机可以长时间按照既定导航路线精确行驶。
技术实现思路
[0004]本专利技术的目的在于：为了解决现有技术容易导航精度低，受轮胎磨损程度和地形状况等因素影响，容易产生收割遗漏的问题，而提出的一种基于双陀螺仪控制的自动驾驶农机 。
[0005]为了实现上述目的，本专利技术采用了如下技术方案：一种基于双陀螺仪控制的自动驾驶农机 ，包括车身和底盘，所述底盘前后分别连接有前桥和后桥，所述前桥包括前车轮、前连接臂和转向机构，所述前连接臂两端分别连接有转向盘，且所述转向盘分别转动连接两个前车轮，所述前连接臂靠近其中一个转向盘的一端上方设置有第一陀螺仪，且所述前连接臂靠近另一个转向盘的一侧设置有缓冲机构，所述转向机构包括转向机和与转向机轴端连接的转向杆，所述转向杆两端分别连接转向盘，所述后桥包括后车轮和后连接臂，所述后连接臂的中间位置设置有第二陀螺仪，所述缓冲机构包括壳体和从动杆，所述壳体朝向转向杆的一侧开设有滑槽，所述从动杆限位在滑槽内并延伸至壳体外与转向杆铰接，所述从动杆的一端延伸至所述壳体的内腔且末端转动连接有第一齿轮，所述第一齿轮的转轴与所述壳体的底壁转动连接，所述第一齿轮远离所述从动杆的一侧啮合连接有第二齿轮，所述第二齿轮通过转轴转动连接有角度传感器，所述第一齿轮上开设有弧形滑槽，所述从动杆靠近所述第一齿轮的一端两侧分别设置有容差机构，所述容差机构包括第一弹簧、挡板、和凸台，所述凸台通过螺柱穿过第一齿轮与壳体固定在所述凸台的顶面，所述第一弹簧的两端分别与所述挡板和所述从动杆固定连接，且所述第一弹簧与左右两侧的所述挡板连接处分别设有第一压力传感器和第二压力传感器。
[0006]优选的，所述第二齿轮下方设置有固定在壳体底部的支撑台，所述第二齿轮通过转轴固定在支撑台上，第一齿轮与所述第二齿轮的轴心连接线与所述壳体底端平行。
[0007]优选的，所述第二齿轮的为半圆形结构，且所述第二齿轮的半圆端面一侧通过第
二弹簧连接有支板，所述支板固定在支撑台上。
[0008]优选的，所述车身上方设置有Gnss天线，用以接收导航系统转角信号，所述底盘上设置有控制器，所述控制器分别与第一陀螺仪、第二陀螺仪、转向机、角度传感器及Gnss天线电连接，所述控制器控制转向机的左右轴伸缩驱动转向杆带动前车轮进行转向。
[0009]优选的，所述第一陀螺仪与第二陀螺仪均为单轴陀螺仪，所述前车轮的转向角θ为；其中ωa为所述第二陀螺仪的Z轴角速度，ωb为所述第一陀螺仪的Z轴角速度。
[0010]优选的，所述角度传感器测得的角度值为γ，所述第一齿轮与第二齿轮的齿轮比为b，所述车身转向角为bγ所述农机导航的累计误差为；其中n为控制器采集对比所述车身转向角与所述前车轮的转向角θ实时比较数量。
[0011]优选的，所述第一压力传感器和第二压力传感器实时检测所述第一弹簧对左、右挡板的压力，且所述第一压力传感器测得的压力值为F
1 ，所述第二压力传感器测得压力值为F2，当F1=F2时，γ=0,代入累计误差对陀螺仪进行角度纠偏校正。
[0012]优选的，所述弧形滑槽与第一齿轮同心。
[0013]优选的，所述第一齿轮与第二齿轮的齿轮比为b≥4。
[0014]优选的，所述后连接臂上设置有驱动机构用以车轮驱动。
[0015]综上所述，由于采用了上述技术方案，本专利技术的有益效果是：1、本专利技术中，通过两只陀螺仪实时进行角度纠偏，可以避免单一陀螺仪检测故障造成农机自动驾驶过度偏离的问题，同时整个导航过程中，通过两只陀螺仪耦合了陀螺的误差，即上个时刻的位置速度姿态误差等影响比较大的误差源，从而提高导航精度。
[0016]2、本专利技术中，通过角度传感器可以及时进行检测发现农机作业时因为地况环境影响前车轮发生的微小偏转，并通过控制器进行纠正，而农机长时间作业后陀螺仪的角度测量值就会产生累计误差，控制器每隔一段时间采集角度传感器的测量值和两只陀螺仪测量的角度值进行累计误差统计，当累计误差超过允差范围，控制器控制陀螺仪进行角度纠偏，从而进一步提高了自动驾驶农机的精确导航；3、本专利技术中，通过容差机构中的第一压力传感器和第二压力传感器实时检测第一弹簧对左、右挡板的压力，有效判定车身调正，从而可以根据每个转向过程中的转角累计误差反馈到控制器中，控制器对两只陀螺仪进行一次角度纠偏，提高下一个转向过程的转向角度，提高导航精度，使得农机高效、高质量的作业。
附图说明
[0017]图1为本专利技术一种基于双陀螺仪控制的自动驾驶农机的结构示意图；图2为本专利技术一种基于双陀螺仪控制的自动驾驶农机的底盘结构示意图；图3为本专利技术一种基于双陀螺仪控制的自动驾驶农机的前桥结构示意图；
图4为本专利技术一种基于双陀螺仪控制的自动驾驶农机的前桥俯视图；图5为本专利技术一种基于双陀螺仪控制的自动驾驶农机的后桥俯视图；图6为本专利技术一种基于双陀螺仪控制的自动驾驶农机的缓冲机构示意图；图7为本专利技术一种基于双陀螺仪控制的自动驾驶农机的剖面示意图。
[0018]图例说明：1、车身；2、底盘；3、前桥；31、前车轮；32、前连接臂；33、转向机构；331、转向机；332、转向杆；34、第一陀螺仪；35、缓冲机构；351、壳体；352、从动杆；353、滑槽；354、第一齿轮；355、第二齿轮；356、第二弹簧；357、支板；358、弧形滑槽；359、支撑台； 36、转向盘；4、后桥；41、后车轮；42、后连接臂；43、第二陀螺仪；44、驱动机构；5、容差机构；51、第一弹簧；52、挡板；53、凸台；7、Gnss天线。
具体实施方式
[0019]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本专利技术保护的范围。
[0020]实施例1参考图1-7，一种基于双陀螺仪控制的自动驾驶农机 ，包括车身1和底盘2，底盘2前后分别连接有前桥3和后桥4，前桥3包括前车轮31、前连接臂32和转向机构33，后桥4本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种基于双陀螺仪控制的自动驾驶农机 ，包括车身（1）和底盘（2），所述底盘（2）前后分别连接有前桥（3）和后桥（4），其特征在于，所述前桥（3）包括前车轮（31）、前连接臂（32）和转向机构（33），所述前连接臂（32）两端分别连接有转向盘（36），且所述转向盘（36）分别转动连接两个前车轮（31），所述前连接臂（32）靠近其中一个转向盘（36）的一端上方设置有第一陀螺仪（34），且所述前连接臂（32）靠近另一个转向盘（36）的一侧设置有缓冲机构（35）；所述转向机构（33）包括转向机（331）和与转向机（331）轴端连接的转向杆（332），所述转向杆（332）两端分别与转向盘（36）铰接；所述后桥（4）包括后车轮（41）和后后连接臂（42），所述后连接臂（42）的中间位置设置有第二陀螺仪（43）；所述缓冲机构（35）包括壳体（351）和从动杆（352），所述壳体（351）朝向转向杆（332）的一侧开设有滑槽（353），所述从动杆（352）限位在滑槽（353）内并延伸至壳体（351）外与转向杆（332）铰接，所述从动杆（352）的一端延伸至所述壳体（351）的内腔且末端转动连接有第一齿轮（354），所述第第一齿轮（354）的转轴与所述壳体（351）的底壁转动连接，所述第一齿轮（354）远离所述从动杆（352）的一侧啮合连接有第二齿轮（355），所述第二齿轮（355）通过转轴转动连接有角度传感器（6）；所述第一齿轮（354）上开设有弧形滑槽（358），所述从动杆（352）靠近所述第一齿轮（354）的一端两侧分别设置有容差机构（5），所述容差机构（5）包括第一弹簧（51）、挡板（52）、和凸台（53），所述凸台（53）通过螺柱穿过第一齿轮（354）与壳体（351)底部固定，所述挡板（52）固定在所述凸台（53）的顶面，所述第一弹簧（51）的两端分别与所述挡板（52）和所述从动杆（352）固定连接，且所述第一弹簧（51）与左右两侧的所述挡板（52）连接处分别设有第一压力传感器和第二压力传感器。2.根据权利要求1所述的基于双陀螺仪控制的自动驾驶农机 ，其特征在于， 所述第二齿轮（355）下方设置有固定在壳体（351）底部的支撑台（359），所述第二齿轮（355）通过转轴固定在支撑台（359）上，第一齿轮（354）与...
【专利技术属性】
技术研发人员：张义，
申请(专利权)人：深圳市瑞芬科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。