第11卷第3期2021年3月
农业工程
Agricultural Engineering
Vol. 11 No.3
郝帅红，武志明，部韦輪，余科松，温盡伟
(山西农业大学农业工程学院，山西晋中030801)
摘要：随着科学技术的不断发展，无人驾驶技术越来越多地应用到农业机械领域。以Q/C R01-2015型山地拖拉机为 载体，通过设计电子系统、液压系统等，实现对无人驾驶拖拉机的底层控制，设计方案易于施行，具备与智能决策系统对接的条件，方便对传统农机进行无人驾驶改造。
关键词：无人驾驶；拖拉机；底层控制系统；智能决策；芯片 中图分类号：S24 文献标识码：A文章编号：2095-1795(2021 )03-0062-05
Design of Bottom Control System for Unmanned Tractor
HAO Shuaihong,WU Zhiming,GUO Weitao,YU Kesong,WEN Xinwei
(College o f Agricultural Engineering, Shanxi Agricultural University, Jinzhong Shanxi 030801,China)
A b stract：With continuous development of science and technology, u n m a n n e d technology is more and more applied to field of agricultural machinery. Taking Q/C R01-2015 mountain tractor as carrier，through design of electronic system and hydraulic sys-tern, bottom control of u n m a n n e d tractor was realized. T h e design was easy to implement and had the conditions of docking with intelligent decision system. I t was convenient for u n m a n n e d transformation of traditional agricultural machinery.
K eyw ords: u n m a n n e d,tractor,bottom control system,intelligent decision making, chip
〇引言
农田作业的现代化技术离不开机械化、自动 化[|]。中国是农业大国，也是全球农机制造大国，2019年，全国规模以上农机企业主营业务收入实现2 464. 67亿元m。拖拉机是我国保有量较大的农机产品之一，但是目前大部分拖拉机依旧由人工驾驶，驾 驶员操作技术水平参差不齐，很难满足高精度作业
的要求m。发展拖拉机无人驾驶技术迫在眉睫，该技术可提高作业效率与作业精度，同时降低驾驶员劳动强度。
国外农业发达国家完成了对农田作业机械智能导航控制技术及相关产品的研究，并将相关技术应用于农业生产，生产效益得到显著提高[4]。我国在农机自动化、信息化和智能化等技术方面的研究还处于起步阶段，但发展速度很快，尤其是拖拉机自动导航驾驶技术，如东方红X-804型拖拉机配备的载波相位差分全球定位系统（DGPS)，实现了对拖拉机的无人驾驶控制:n。
目前，国内对无人驾驶拖拉机的研究大多都是基于全新的机械设计基础之上的一次开发，很少有在传统的农机基础之上进行无人驾驶技术的二次开发。如 果能在已有农机上通过加装底层执行机构并与智能决策系统相结合，将保有量较大的传统农机改造成无人驾驶拖拉机，则意义重大。
本研究以Q/CR01-2015型山地拖拉机为载体，通过设计电子系统、液压系统等，实现对无人驾驶拖拉机的底层控制，设计方案易于施行，方便对传统农机进行无人驾驶改造。
1底层控制系统组成
无人驾驶拖拉机底层控制系统结构示意如图1所 示，底层控制系统主要由负责指令发送的SBUS发射 器、负责指令接收的SBUS接收机、主控芯片、电子 系统、液压伺服系统及拖拉机机械硬件等部分组
成。工作流程：SBUS发射器发送操作指令—SBUS接收机 接收发射器指令—主控芯片解码发射器指令—电子系 统执行主控芯片程序完成拖拉机相应的电子电路功能—液压伺服系统执行主控芯片程序完成拖拉机相应的机械构件功能。
收稿日期：2021-01-04 修回日期：202丨-03-10
基金项目：山西省重点研发项目（201903D221029)
作者简介：郝帅红，硕士生，主要从事农业工程研究。E-mail: ****************
武志明，通信作者，副教授，主要从事农业机械设计、农业航空工程和智能农机装备研究。
E-mail: ***************
在线投稿www.d1 ae
郝帅红等：无人驾驶拖拉机底层控制系统设计63
智能决策A 模块^
电子底层控制底层执系统微行模块
液压
系统
图1无人驾驶拖拉机底层控制系统示意Fig. 1Bottom control system schematic of unmanned tractor
2硬件设计
无人驾驶拖拉机底层控制系统包括硬件电路和软件系统，硬件电路的性能直接决定整个系统的综合性能，好的硬件支持对于软件系统开发具有重要意
义15<。本研究主要从控制系统芯片的选型、最小系 统、SBUS接收机连接电路、驱动执行部分和电源管理模块等部分进行硬件电路设计。
2. 1芯片选型与资源分配
主控芯片是控制系统的关键核心部件，合适的主 控芯片对发挥控制系统的性能具有重要作用。芯片选 择往往需要考虑系统各方面的要求，如工作主频、运 算能力、外设资源、易于开发、集成等。STM32系列高速处理器是S T公司近年来推出的新型处理器，其内置资源丰富，内部集成的定时器多达7个，包括 基本定时器、通用定时器和高级定时器等；同时拥有 丰富的通信接口，如USART、CAN和SP丨等，可以 完成通信功能781。
无人驾驶拖拉机底层控制系统对芯片的响应速度要求较高，同时需要多达12路的PWM外设、1个 USART接口，故选择高性能的STM32单片机作为主控芯片。本底层控制系统配备1个串行接口用于SBUS通信，12路PWM信号用于控制数字舵机与伺服换向阀，3个通用GPIO口对开关设备进行控制。底层控制系统资源分配方案如表1所示。
表1底层控制系统资源分配方案
Tab. 1Resource allocation scheme of bottom control system
系统硬件资源类型对应芯片引脚
拖拉机泄压阀P W M PA0
拖拉机离合P W M PA1
拖拉机左/右刹P W M PA2/PA3
拖拉机通用挡位1/2/3P W M PA6/PA7/PB0
拖拉机高/低档P W M PB1
拖拉机作业器械升降P W M PB6
拖拉机液压系统总阀P W M PB7
拖拉机旋耕机驱动P W M PB8
S B U S接收机数据发送引脚（T X D)U S A R T PB11
拖拉机引擎启动开关GPI0PB12
拖拉机近/远光灯GPI0PB13/PB14
2. 2STM32单片机的最小系统
STM32 F103系列单片机的最小系统主要由电源、晶振和复位电路3部分组成，供电电压3.3 V。STM32单片机内部电路集成度高，芯片内部电源线比较细，为使单片机稳定工作，设计供电模块由4组供电电源组成，同时电源正极与地之间均加入〇. 1 “F的去耦电 容，保证系统工作的稳定性[9]。复位电路主要由电阻、电容和按键组成，使用R C充放电电路主要实现芯片的上电复位，同时保证在按键弹起的状态下，单片机NRST脚始终处于高电平，芯片正常工作；该芯片外接了一个8 MHz的晶振，为其工作产生稳定的频率，STM32单片机内部设计了倍频电路，可将该晶振频率倍频到72 MHz，从而指挥单片机快速、有序地工作。
2. 3接收机接收指令部分
SBUS接收机功能是实现拖拉机的遥控驾驶，由SBUS通信协议可知，该设备低电平为0，高电平为3.3 V，采用负逻辑，解码该类接收机时需在数据线上加人一个取反电路，取反电路由1个S9013NPN型 三极管与限流电阻、上拉电阻组成。
2.4驱动执行部分
2. 4.1继电器
无人驾驶拖拉机电子系统多是大功率电子元件，普通电子开关管难以承受持续的大电流，因此采用继电器控制大功率元件，实现电子驱动功能。将大功率元件的正极串联于继电器的常开触点间，每路继电器的控制端分别与单片机的GPI0 口相联，同时单独为继电器的控制侧提供3.3 V电源。继电器及负载电路如图2所示。
U6
图2继电器及负载电路
Fig. 2 Relay and load circuit
2. 4. 2舵机
为实现拖拉机油门的精确控制，并且任意时刻油门的位置都保持在当前的油门量上，选择大扭力伺服舵机作为油门的驱动执行装置。大扭力伺服舵机内部有角度传感器和控制芯片，控制芯片可实时采集当前的转角并与控制信号实时比较，形成闭环系统，实现 精准响应。油门控制电路如图3所示。
2.4. 3伺服换向阀
为实现油路转换，需要使用换向阀装置，选用伺服换向阀进行精准的流量控制与方向控制。本设计中
64
农业工程信息与电气化
U2
GND
图3 油门控制电路
Fig. 3
Throttle control circuit
G N D
5V U5
T l .v c c
GND CHI C.H2Decompression Valvc 3
Clinch 4
Break L
5Break R
6Cfear 1CH 5
CH 6CH 7
Ciear 2H Gear 39Gear H L 10CHS OEL II ChW HV 12e m o Rutuvator 13CHI 1
S e r \o solenoid valve
底层控制系统的强阻力执行机构有i i 个，因此配置 11路伺服换向阀。伺服换向阀采用PWM 信号控制， 其内部有角度传感器，实时形成闭环控制，使得控制 更稳定、可靠。伺服换向阀电路如图4所示。
2. 5电源管理模块
底层控制电路使用的电源电压等级主要有3.3、5
和24 V ，由于拖拉机能够提供24 V 的车载铅蓄电池电 源，所以选择可调压的直流调压模块2个，将24 V 的 车载电源分别降为5 V 与3.3 V 给相应模块供电。该 直流降压模块的最大输出电流可达5A ，由于小电压等 级模块的电流总和不会超过3 A ，故该供电模块完全满 足设计要求。电源管理模块电路如图5所示。
2. 6硬件电路连接
底层控制系统的总体硬件连接如图6所示。以主
图4
伺服换向阀电路
Fig. 4
Servo directional valve circuit
24V
5V
一
U82
DCin (0〜38V )
DCout (0-38V)
4
-
DC-DC
U9
3.3V
下
12
DCin (0-38V )DCout (0-38V )
DC-DC
■
_GND
GND
Fig. 5
图5
电源管理模块电路
Power management module circuit
图6
底层控制系统硬件连接电路
Fig. 6
Hardware connection circuit of bottom control
system
郝帅红等：无人驾驶拖拉机底层控制系统设计
65
控芯片为中心，将底层硬件电路分为3大部分：输人 部分、数据处理与逻辑控制部分、指令执行部分。输 人部分主要由SBUS 接收机组成，SBUS 接收机将
SBUS 发射器的指令传给主控芯片。数据处理与逻辑
控制部分主要由主控芯片组成，主控芯片将SBUS 接 收机的数据进行解码并根据指令产生相应的逻辑控制 指令。指令执行部分主要由继电器、舵机和伺服换向 阀组成，分别接收主控芯片的控制指令，完成相应的 底层执行功能。电源模块为整个系统提供稳定的电压 与电流，保证系统的稳定运行。
3软件设计
软件设计主要内容包括划分功能模块及安排程序
结构，画出各程序模块流程图，选择合适的语言编写 程序，将各个模块连接成完整的程序等[1°]。本设计 中将软件系统分为接收数据、处理数据和控制逻辑3 部分。
3.1接收数据
主控芯片对数据的接收主要通过SBUS 协议完 成，SBUS 通信协议为串口通信，只需正确配置串口 的工作模式与通信协议即可。当主控芯片接收到
SBUS 接收机发出的数据后，其串口接收中断将被触
发，中断处理函数（图7)对接收到的数据进行处理 并正确保存。
3. 2
处理数据
当主控芯片成功接收到SBUS 接收机的数据后， 需根据SBUS 协议对原始数据进行一次解码，将
SBUS 接收机内各个通道的数据分离出来并标准化，
供逻辑控制部分使用[12]。主要流程包括判断是否正 确接收数据、对数据解码、判断解码是否完成及转化 成标准化数据。
3. 3
控制逻辑
数据正确解码后需要进行二次解码，然后根据解 码指令对电子系统与液压系统进行逻辑控制。对于电
子系统的控制，以引擎控制为例进行介绍，如图8所 示；对于液压系统的控制，以制动执行为例进行介 绍，如图9所示。
图7 中断处理函数流程Fig. 7
Interrupt handling function flow
图8引擎模块控制流程Fig. 8
Engine module control flow
图9
制动执行模块控制流程
Fig. 9
Brake execution module control
process
66农业工程信息与电气化
4 试验验证
依据上述硬件设计及软件设计方案，搭建实际系统开发平台，如图10所示。在实际开发平台上对相关代码进行调试，以控制制动的踩放为例，利用程序通过控制换向阀，进而控制液压缸的伸缩，实现制动，液压缸的伸出和收缩效果如图11和图12所示。试验证明，使用发射器发送油缸的伸缩指令，换向阀
图10 系统开发平台
Fig. 10 System development platform
图11 油缸伸出效果
Fig. 11 Effect of cylinder extension
图12 油缸缩回效果
Fig. 12 Effect of cylinder retraction 能够快速、准确地响应，基本满足底层控制系统的性
能要求，故该底层控制系统具备与智能决策系统对接
的条件。
5结束语
以Q/CR01-2015型山地拖拉机为载体对其进行
改造，设计出底层控制系统，实现对无人驾驶拖拉机
的底层控制。试验证明该底层控制系统各项性能满足
设计要求，具备与智能决策系统对接的条件，为社会 上保有量较大的传统拖拉机进行无人驾驶改造升级提
供了系统支撑。
参考文献
无人驾驶系统
[1] 许予永.东方红无人驾驶拖拉机闪耀央视舞台[■!].农机质M
与监督，2018(9): 37.
[2] 王洪华.拖拉机自动导航驾驶及导航技术[门.农业工程技术，
2020, 40(36)：43-45.
[3] 陈志，罗锡文，王锋德，等.从零基础到农机大国的发展之
路：中国农机工业百年发展历程回顾[J].农学学报，2018, 8
(1) ：158-162.
C H E N Zhi,L U O Xiwen, W A N G Fengde, e t a l.Road of develop
ment from zero base t o a large agricultural machinery country ：a re
view of China agricultural machinery industry i n a century [J] .Jour
nal of agriculture, 2018, 8(1)：158-162.
[4] 宋春月.无人驾驶拖拉机控制系统设计研究[D]•上海：上海
工程技术大学，2015.
S O N G Chunyue. Design and research of unmaned tractor automatic
navigation control system [ D].Shanghai ：Shanghai University of
Engineering Science, 2015.
[5] 刘志.无线电硬件电路的设计与调试探讨[J].电子世界，
2020(2) ：60-61.
[6] 高铭阳.单片机的原理及接口技术[J].电子技术与软件工程，
2017(4) ：257.
[7] 董红生，马伟龙，齐雁•基于S T M32列车轴温无线监测系统
设计[J].兰州工业学院学报，2020, 27(6): 57-61.
D O N G Hongsheng, M A Weilong, QI Yan. Design of wireless m o
nitoring system for train axle temperature based on STM32 [ J].
Journal of Lanzhou Institute of Technology,2020, 27(6) ：57-61. [8] 周江.S T M32单片机原理及硬件电路设计研究[J]•数字技术
与应用，2015(11): 1.
[9] 王楠.单片机控制系统的设计与调试方法探讨[J].农村经济
与科技，2017, 28(8): 294.
[10]张洋，刘军•原子教你玩儿S T M32(库函数版）[M]. 2版.北
京：北京航空航天大学出版社，2015: 62-63.
[11]欧阳劲志，杨辉，罗小全.人车分离无人驾驶拖拉机关键技术
研究[J].决策探索，2019(5): 62-63.
[12]刘蕊.小型工业机器人的智能化应用趋势研究[J].精密制造
与自动化，2018(2): 5-8,
40.
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议