CN112124426A - An all-terrain intelligent agricultural multifunctional power chassis - Google Patents

An all-terrain intelligent agricultural multifunctional power chassis Download PDF

Info

Publication number
CN112124426A
CN112124426A CN202010984712.7A CN202010984712A CN112124426A CN 112124426 A CN112124426 A CN 112124426A CN 202010984712 A CN202010984712 A CN 202010984712A CN 112124426 A CN112124426 A CN 112124426A
Authority
CN
China
Prior art keywords
chassis
information
terrain
driving
path planning
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010984712.7A
Other languages
Chinese (zh)
Other versions
CN112124426B (en
Inventor
张兆国
张振东
薛浩田
解开婷
王海翼
李彦彬
余小兰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunming University of Science and Technology
Original Assignee
Kunming University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kunming University of Science and Technology filed Critical Kunming University of Science and Technology
Priority to CN202010984712.7A priority Critical patent/CN112124426B/en
Publication of CN112124426A publication Critical patent/CN112124426A/en
Application granted granted Critical
Publication of CN112124426B publication Critical patent/CN112124426B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D21/00Understructures, i.e. chassis frame on which a vehicle body may be mounted
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60KARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K1/00Arrangement or mounting of electrical propulsion units
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D21/00Understructures, i.e. chassis frame on which a vehicle body may be mounted
    • B62D21/18Understructures, i.e. chassis frame on which a vehicle body may be mounted characterised by the vehicle type and not provided for in groups B62D21/02 - B62D21/17
    • B62D21/186Understructures, i.e. chassis frame on which a vehicle body may be mounted characterised by the vehicle type and not provided for in groups B62D21/02 - B62D21/17 for building site vehicles or multi-purpose tractors
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01NINVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
    • G01N27/00Investigating or analysing materials by the use of electric, electrochemical, or magnetic means
    • G01N27/02Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating impedance
    • G01N27/04Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating impedance by investigating resistance
    • G01N27/041Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating impedance by investigating resistance of a solid body
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • General Physics & Mathematics (AREA)
  • Combustion & Propulsion (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Analytical Chemistry (AREA)
  • Pathology (AREA)
  • Immunology (AREA)
  • General Health & Medical Sciences (AREA)
  • Biochemistry (AREA)
  • Architecture (AREA)
  • Structural Engineering (AREA)
  • Electromagnetism (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Health & Medical Sciences (AREA)
  • Electrochemistry (AREA)
  • Chemical Kinetics & Catalysis (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to an all-terrain intelligent agricultural multifunctional power chassis, and belongs to the technical field of vehicles. The invention comprises a profile driving system, wherein the profile driving system comprises four groups of driving devices which are respectively arranged below a chassis, the structures of the driving devices are the same, and each group of driving devices comprises a connecting rod suspension, a profile wheel set, a suspension link tension spring, an angle encoder, a steering pull rod, a hydraulic oil cylinder, a cantilever and a motor. The invention provides an all-terrain intelligent agricultural multifunctional power chassis, which is used for meeting the driving requirements of various terrains and improving the adaptability and trafficability of agricultural machinery to the terrains during re-cultivation. The problems of poor ground adaptability, poor skid resistance, insufficient adhesive force, poor trafficability, difficulty in leveling of the vehicle body and the like of agricultural equipment in a complex farmland environment are solved.

Description

一种全地形智能农用多功能动力底盘An all-terrain intelligent agricultural multifunctional power chassis

技术领域technical field

本发明涉及一种全地形智能农用多功能动力底盘,属于车辆技术领域。The invention relates to an all-terrain intelligent agricultural multifunctional power chassis, which belongs to the technical field of vehicles.

背景技术Background technique

农业机械的工作行驶环境为田间或山地等非道路复杂场合,行驶条件较为恶劣,而良好的行驶平顺性能可以大大改善作业者的工作条件,提高作业质量,改善行驶安全性,并能延长整车或整机使用寿命。我国大部分耕地为小地块,垄沟、田埂等地形复杂,简单的车轮系统并不能有效地解决复杂地形的行驶和越障问题。The working and driving environment of agricultural machinery is complex non-road occasions such as fields or mountains, and the driving conditions are relatively harsh, but good driving smooth performance can greatly improve the working conditions of the operator, improve the quality of work, improve driving safety, and can extend the entire vehicle. or the service life of the whole machine. Most of the cultivated land in my country is small plots, and the terrain such as ridges and ridges is complex. A simple wheel system cannot effectively solve the problems of driving and obstacle crossing in complex terrain.

发明内容SUMMARY OF THE INVENTION

本发明要解决的技术问题是:本发明针对以丘陵山区为代表性的复杂地形,提供一种全地形智能农用多功能动力底盘,以适应各种不同地形的行驶要求,提高农业机械再耕作时对其地形适应性、通过性。The technical problem to be solved by the present invention is: the present invention provides an all-terrain intelligent agricultural multi-functional power chassis for the complex terrain represented by hills and mountainous areas, so as to adapt to the driving requirements of various terrains and improve the time of re-cultivation of agricultural machinery. Adaptability to its terrain and passability.

本发明技术方案是:一种全地形智能农用多功能动力底盘,包括仿形驱动系统,所述仿形驱动系统包括四组驱动装置,均分别安装在底盘5下方,每组驱动装置结构均相同,每一组驱动装置包括连杆悬架7、仿形轮组11、悬架链接拉簧12、角度编码器13、转向拉杆14、液压油缸15、悬臂17、电机18;The technical scheme of the present invention is: an all-terrain intelligent agricultural multi-functional power chassis, comprising a profiling drive system, wherein the profiling drive system includes four sets of drive devices, all of which are respectively installed under the chassis 5, and each set of drive devices has the same structure , each group of drive devices includes a link suspension 7, a profiling wheel group 11, a suspension link tension spring 12, an angle encoder 13, a steering rod 14, a hydraulic cylinder 15, a cantilever 17, and a motor 18;

所述连杆悬架7上端和底盘5铰接,下端与第一法兰圆盘19活动铰接,两个悬臂17的上端活动的连接在第一法兰圆盘19、第二法兰圆盘20之间,两个悬臂17的下端分别安装有仿形轮组11,两个悬臂17的下端之间安装有悬架链接拉簧12,第二法兰圆盘20的第一筋肋板21上安装有液压油缸15,液压油缸15的伸缩端上端安装在底盘5下底面,第二法兰圆盘20的第二筋肋板22上安装有转向拉杆14,转向拉杆14再与电机18连接,角度编码器13安装在第二法兰圆盘上,控制器4分别与角度编码器13、液压油缸15、电机18连接。The upper end of the link suspension 7 is hinged with the chassis 5, the lower end is hinged with the first flange disc 19, and the upper ends of the two cantilevers 17 are movably connected to the first flange disc 19 and the second flange disc 20. In between, the lower ends of the two cantilever arms 17 are respectively installed with a profile wheel set 11 , the lower ends of the two cantilever arms 17 are installed with a suspension link tension spring 12 , and the first rib plate 21 of the second flange disc 20 is installed A hydraulic oil cylinder 15 is installed, the upper end of the telescopic end of the hydraulic oil cylinder 15 is installed on the lower bottom surface of the chassis 5, the second rib plate 22 of the second flange disc 20 is installed with a steering pull rod 14, and the steering pull rod 14 is connected with the motor 18, The angle encoder 13 is mounted on the second flange disc, and the controller 4 is respectively connected with the angle encoder 13 , the hydraulic cylinder 15 and the motor 18 .

作为本发明的进一步方案,所述连杆悬架7包括2根伸缩杆、一根伸缩连杆机构,2根伸缩杆、一根伸缩连杆机构上端均和底盘5铰接,下端均与第一法兰圆盘19活动铰接。As a further solution of the present invention, the link suspension 7 includes two telescopic rods and one telescopic link mechanism, the upper ends of the two telescopic rods and one telescopic link mechanism are hinged with the chassis 5, and the lower ends are both hinged with the first The flanged disc 19 is articulated live.

作为本发明的进一步方案,还包括田间环境感知系统;所述田间环境感知系统包括一个安装于车架底盘前侧的激光雷达1与安装在激光雷达侧面更靠近中心位置的TOF深度相机16,车架安装于农机具前方,用于对农机具工作环境进行信息采集;TOF深度相机16负责获取作业时局部范围内较精细的地形信息;其中若干个传感器放置于传感器盒6内,通过若干个传感器采集田间环境信息,传感器盒6中各传感器采集数据传输给控制器4,并通过坐标变换系统构建高程地图模型。As a further solution of the present invention, a field environment perception system is also included; the field environment perception system includes a lidar 1 installed on the front side of the frame chassis and a TOF depth camera 16 installed on the side of the lidar closer to the center. The frame is installed in front of the agricultural machinery and is used to collect information on the working environment of the agricultural machinery; the TOF depth camera 16 is responsible for obtaining finer terrain information in the local range during operation; several sensors are placed in the sensor box 6, and through several sensors Field environmental information is collected, the data collected by each sensor in the sensor box 6 is transmitted to the controller 4, and an elevation map model is constructed through a coordinate transformation system.

作为本发明的进一步方案,还包括路径规划导航系统;所述路径规划导航系统,包括导航系统模块与路径规划模块,导航系统模块以SLAM系统为整个导航系统的核心模块;路径规划导航系统首先接收经过坐标变换后的田间环境感知系统采集的数据信息,根据底盘5的运动模型和观测模型,利用概率或优化的SLAM算法完成路标提取、数据关联、传感器数据融合、底盘定位、增量式地图构建工作,为路径规划模块,提供精确的定位和地图模型;其次辅以路径规划模块接受底盘的定位信息、里程计信息和周围环境地图信息,在精准定位的前提下,自主规划行走路线,并实时有效的避障行驶,同时角度编码器13将地面起伏情况反馈给仿形驱动系统。As a further solution of the present invention, it also includes a route planning and navigation system; the route planning and navigation system includes a navigation system module and a route planning module, and the navigation system module takes the SLAM system as the core module of the entire navigation system; the route planning and navigation system first receives The data information collected by the field environment perception system after coordinate transformation, according to the motion model and observation model of chassis 5, use probability or optimized SLAM algorithm to complete road sign extraction, data association, sensor data fusion, chassis positioning, and incremental map construction Work, provide accurate positioning and map model for the path planning module; secondly, the path planning module accepts the positioning information of the chassis, odometer information and surrounding environment map information, and under the premise of accurate positioning, autonomously plans the walking route and real-time. Effective obstacle avoidance driving, while the angle encoder 13 feeds back the ground undulation to the profiling drive system.

作为本发明的进一步方案,还包括人机交互系统;所述人机交互系统用于地图和底盘模型的可视化界面显示,实现二维地图的增量式创建,以及底盘前方实际环境的图像显示;同时能为自主模式下的路径规划系统指定目标点,在人工控制模式下通过键盘或手柄实现底盘的运动控制,完成土壤水分、土壤坚实度物理信息的测定并汇总上传至云平台储存。As a further solution of the present invention, it also includes a human-computer interaction system; the human-computer interaction system is used for visual interface display of maps and chassis models, realizing incremental creation of two-dimensional maps, and image display of the actual environment in front of the chassis; At the same time, it can specify the target point for the path planning system in the autonomous mode, realize the motion control of the chassis through the keyboard or handle in the manual control mode, complete the measurement of soil moisture and soil firmness physical information, and upload it to the cloud platform for storage.

作为本发明的进一步方案,还包括供电系统;所述供电系统由锂电池组2、电机18、电源管理系统组成,电源管理系统负责管理电池输出的电源对各个子系统的供电分配,实现供电管理和保护。As a further solution of the present invention, it also includes a power supply system; the power supply system is composed of a lithium battery pack 2, a motor 18, and a power management system, and the power management system is responsible for managing the power supply distribution of the power output from the battery to each subsystem, so as to realize power supply management and protection.

本发明的有益效果是:本发明的全地形智能农用多功能动力底盘与现有技术相比,具有以下优点:The beneficial effects of the present invention are: compared with the prior art, the all-terrain intelligent agricultural multifunctional power chassis of the present invention has the following advantages:

1.设计了全方位多自由度全地面仿形行走机构,配合角度编码器和直线传感器精准仿形,更好的解决了地面适应性差、车轮易打滑、附着力不足等问题;1. The all-round multi-degree-of-freedom full-ground profiling walking mechanism is designed, and the angle encoder and linear sensor are used for accurate profiling, which better solves the problems of poor ground adaptability, easy wheel slippage, and insufficient adhesion;

2.运用激光雷达和深度相机实时构建地图高程模型,并用SLAM算法进行路径规划,实现底盘的智能化自主避障和行驶;2. Use lidar and depth camera to build a map elevation model in real time, and use SLAM algorithm for path planning to realize intelligent autonomous obstacle avoidance and driving of the chassis;

3.在底盘上安装有TDR测量仪,通过电导率的测量得出土壤的多种物理性质,并上传云端储存,增加了底盘的实用功能。3. A TDR measuring instrument is installed on the chassis, and various physical properties of the soil are obtained through the measurement of electrical conductivity, and uploaded to the cloud for storage, which increases the practical function of the chassis.

附图说明Description of drawings

图1是本发明的机械结构左视图;Fig. 1 is the left side view of the mechanical structure of the present invention;

图2是本发明的机械结构局部放大图;Fig. 2 is a partial enlarged view of the mechanical structure of the present invention;

图3是本发明的仿形驱动系统的局部示意图;Fig. 3 is the partial schematic diagram of the profiling drive system of the present invention;

图4是本发明的机械结构的轴测图;Fig. 4 is the axonometric view of the mechanical structure of the present invention;

图5是本发明的机械结构的正视图;Fig. 5 is the front view of the mechanical structure of the present invention;

图6是本发明的机械结构控制流程示意图。FIG. 6 is a schematic diagram of the control flow of the mechanical structure of the present invention.

图1-6中各标号:1-激光雷达,2-锂电池组,3-直流变压器,4-控制器,5-底盘,6-传感器盒,7-连杆悬架,8-IMU模块,9-线槽,10-驱动器,11-仿形轮组,12-悬架链接拉簧,13-角度编码器,14-转向拉杆,15-液压油缸,16-TOF深度相机,17-悬臂,18-电机,19-第一法兰圆盘,20-第二法兰圆盘,21-第一筋肋板,22-第二筋肋板。Labels in Figure 1-6: 1-Lidar, 2-Lithium battery pack, 3-DC transformer, 4-Controller, 5-Chassis, 6-Sensor box, 7-Link suspension, 8-IMU module, 9-Wireway, 10-Driver, 11-Profile wheel set, 12-Suspension link tension spring, 13-Angle encoder, 14-Steering rod, 15-Hydraulic cylinder, 16-TOF depth camera, 17-Cantilever, 18-motor, 19-first flange disc, 20-second flange disc, 21-first rib plate, 22-second rib plate.

具体实施方式Detailed ways

下面结合附图和具体实施例,对本发明作进一步说明。The present invention will be further described below with reference to the accompanying drawings and specific embodiments.

实施例1:如图1-6所示,一种全地形智能农用多功能动力底盘,包括仿形驱动系统,所述仿形驱动系统包括四组驱动装置,均分别安装在底盘5下方,每组驱动装置结构均相同,每一组驱动装置包括连杆悬架7、仿形轮组11、悬架链接拉簧12、角度编码器13、转向拉杆14、液压油缸15、悬臂17、电机18;Embodiment 1: As shown in Figures 1-6, an all-terrain intelligent agricultural multi-functional power chassis includes a profiling drive system. The profiling drive system includes four sets of driving devices, all of which are respectively installed under the chassis 5. The structure of the group driving devices is the same. Each group of driving devices includes a link suspension 7, a profile wheel group 11, a suspension link tension spring 12, an angle encoder 13, a steering rod 14, a hydraulic cylinder 15, a cantilever 17, and a motor 18. ;

所述连杆悬架7上端和底盘5铰接,下端与第一法兰圆盘19活动铰接,两个悬臂17的上端活动的连接在第一法兰圆盘19、第二法兰圆盘20之间,两个悬臂17的下端分别安装有仿形轮组11,两个悬臂17的下端之间安装有悬架链接拉簧12,第二法兰圆盘20的第一筋肋板21上安装有液压油缸15,液压油缸15的伸缩端上端安装在底盘5下底面,第二法兰圆盘20的第二筋肋板22上安装有转向拉杆14,转向拉杆14再与电机18连接,角度编码器13安装在第二法兰圆盘上,控制器4分别与角度编码器13、液压油缸15、电机18连接。The upper end of the link suspension 7 is hinged with the chassis 5, the lower end is hinged with the first flange disc 19, and the upper ends of the two cantilevers 17 are movably connected to the first flange disc 19 and the second flange disc 20. In between, the lower ends of the two cantilever arms 17 are respectively installed with a profile wheel set 11 , the lower ends of the two cantilever arms 17 are installed with a suspension link tension spring 12 , and the first rib plate 21 of the second flange disc 20 is installed A hydraulic oil cylinder 15 is installed, the upper end of the telescopic end of the hydraulic oil cylinder 15 is installed on the lower bottom surface of the chassis 5, the second rib plate 22 of the second flange disc 20 is installed with a steering pull rod 14, and the steering pull rod 14 is connected with the motor 18, The angle encoder 13 is mounted on the second flange disc, and the controller 4 is respectively connected with the angle encoder 13 , the hydraulic cylinder 15 and the motor 18 .

作为本发明的进一步方案,所述连杆悬架7包括2根伸缩杆、一根伸缩连杆机构,2根伸缩杆、一根伸缩连杆机构上端均和底盘5铰接,下端均与第一法兰圆盘19活动铰接。As a further solution of the present invention, the link suspension 7 includes two telescopic rods and one telescopic link mechanism, the upper ends of the two telescopic rods and one telescopic link mechanism are hinged with the chassis 5, and the lower ends are both hinged with the first The flanged disc 19 is articulated live.

作为本发明的进一步方案,还包括田间环境感知系统;所述田间环境感知系统包括一个安装于车架底盘前侧的激光雷达1与安装在激光雷达侧面更靠近中心位置的TOF深度相机16,车架安装于农机具前方,用于对农机具工作环境进行信息采集;TOF深度相机16负责获取作业时局部范围内较精细的地形信息;其中若干个传感器放置于传感器盒6内,通过若干个传感器采集田间环境信息,传感器盒6中各传感器采集数据传输给控制器4,并通过坐标变换系统构建高程地图模型。As a further solution of the present invention, a field environment perception system is also included; the field environment perception system includes a lidar 1 installed on the front side of the frame chassis and a TOF depth camera 16 installed on the side of the lidar closer to the center. The frame is installed in front of the agricultural machinery and is used to collect information on the working environment of the agricultural machinery; the TOF depth camera 16 is responsible for obtaining finer terrain information in the local range during operation; several sensors are placed in the sensor box 6, and through several sensors Field environmental information is collected, the data collected by each sensor in the sensor box 6 is transmitted to the controller 4, and an elevation map model is constructed through a coordinate transformation system.

作为本发明的进一步方案,还包括路径规划导航系统;所述路径规划导航系统,包括导航系统模块与路径规划模块,导航系统模块以SLAM系统为整个导航系统的核心模块;路径规划导航系统首先接收经过坐标变换后的田间环境感知系统采集的数据信息,根据底盘5的运动模型和观测模型,利用概率或优化的SLAM算法完成路标提取、数据关联、传感器数据融合、底盘定位、增量式地图构建工作,为路径规划模块,提供精确的定位和地图模型;其次辅以路径规划模块接受底盘的定位信息、里程计信息和周围环境地图信息,在精准定位的前提下,自主规划行走路线,并实时有效的避障行驶,同时角度编码器13将地面起伏情况反馈给仿形驱动系统。As a further solution of the present invention, it also includes a route planning and navigation system; the route planning and navigation system includes a navigation system module and a route planning module, and the navigation system module takes the SLAM system as the core module of the entire navigation system; the route planning and navigation system first receives The data information collected by the field environment perception system after coordinate transformation, according to the motion model and observation model of chassis 5, use probability or optimized SLAM algorithm to complete road sign extraction, data association, sensor data fusion, chassis positioning, and incremental map construction Work, provide accurate positioning and map model for the path planning module; secondly, the path planning module accepts the positioning information of the chassis, odometer information and surrounding environment map information, and under the premise of accurate positioning, autonomously plans the walking route and real-time. Effective obstacle avoidance driving, while the angle encoder 13 feeds back the ground undulation to the profiling drive system.

作为本发明的进一步方案,还包括人机交互系统;所述人机交互系统用于地图和底盘模型的可视化界面显示,实现二维地图的增量式创建,以及底盘前方实际环境的图像显示;同时能为自主模式下的路径规划系统指定目标点,在人工控制模式下通过键盘或手柄实现底盘的运动控制,完成土壤水分、土壤坚实度物理信息的测定并汇总上传至云平台储存。在底盘上安装有TDR测量仪,通过电导率的测量得出土壤的多种物理性质,并上传云端储存,增加了底盘的实用功能;As a further solution of the present invention, it also includes a human-computer interaction system; the human-computer interaction system is used for visual interface display of maps and chassis models, realizing incremental creation of two-dimensional maps, and image display of the actual environment in front of the chassis; At the same time, it can specify the target point for the path planning system in the autonomous mode, realize the motion control of the chassis through the keyboard or handle in the manual control mode, complete the measurement of soil moisture and soil firmness physical information, and upload it to the cloud platform for storage. A TDR measuring instrument is installed on the chassis, and various physical properties of the soil are obtained through the measurement of electrical conductivity, and uploaded to the cloud for storage, which increases the practical function of the chassis;

作为本发明的进一步方案,还包括供电系统;所述供电系统由锂电池组2、电机18、电源管理系统组成,电源管理系统负责管理电池输出的电源对各个子系统的供电分配,实现供电管理和保护。As a further solution of the present invention, it also includes a power supply system; the power supply system is composed of a lithium battery pack 2, a motor 18, and a power management system, and the power management system is responsible for managing the power supply distribution of the power output from the battery to each subsystem, so as to realize power supply management and protection.

本发明的工作原理是:所述角度编码器13负责检测两个悬臂17之间的夹角信号;The working principle of the present invention is: the angle encoder 13 is responsible for detecting the angle signal between the two cantilevers 17;

当所述仿形轮组11遇到凸起障碍后,两个悬臂17之间的夹角的变化值被角度编码器13采集到,检测到模拟信号小于设定值,角度编码器13将模拟信号转化为数字信号传输给控制器4;所述控制器4控制液压油缸15收缩动作的集成功率开关打开,接通液压油缸15的收缩油路,液压油缸15伸缩端收缩按压与之连接的第一筋肋板21,从而带动第一法兰圆盘19、第二法兰圆20均向下运动,使得两个悬臂17之间的夹角增大,此时,连杆悬架7的2根伸缩杆、一根伸缩连杆机构均伸缩,纵向摆动,进而调整悬架高度变低,实现仿生行走调整动态平衡;When the profiling wheel set 11 encounters a raised obstacle, the change value of the angle between the two cantilevers 17 is collected by the angle encoder 13, and when the analog signal is detected to be less than the set value, the angle encoder 13 will simulate the The signal is converted into a digital signal and transmitted to the controller 4; the controller 4 controls the integrated power switch of the hydraulic cylinder 15 to open, and the contraction oil circuit of the hydraulic cylinder 15 is connected. A rib plate 21 drives both the first flange disk 19 and the second flange circle 20 to move downward, so that the angle between the two cantilevers 17 increases. A telescopic rod and a telescopic link mechanism are both telescopic and longitudinally oscillating, so as to adjust the height of the suspension to lower, and realize the dynamic balance of bionic walking adjustment;

当遇到凹下的地面时,两个悬臂17之间的夹角的变化值被角度编码器13采集到,检测到模拟信号大于设定值,角度编码器13将模拟信号转化为数字信号传输给控制器4;所述控制器4控制液压油缸15伸出动作的集成功率开关打开,接通液压油缸15的伸出油路,液压油缸15伸缩端伸出减轻与之连接的第一筋肋板21上的压力,从而带动第一法兰圆盘19、第二法兰圆20均向上运动,使得两个悬臂17之间的夹角减小,此时,连杆悬架7的2根伸缩杆、一根伸缩连杆机构均伸缩,纵向摆动,进而调整悬架高度变高,实现仿生行走调整动态平衡;When encountering a concave ground, the change value of the angle between the two cantilevers 17 is collected by the angle encoder 13, and it is detected that the analog signal is greater than the set value, and the angle encoder 13 converts the analog signal into a digital signal for transmission To the controller 4; the integrated power switch of the controller 4 to control the extension action of the hydraulic cylinder 15 is turned on, and the extension oil circuit of the hydraulic cylinder 15 is connected, and the telescopic end of the hydraulic cylinder 15 extends to reduce the first rib connected to it. The pressure on the plate 21 drives the first flange disk 19 and the second flange circle 20 to move upward, so that the angle between the two cantilevers 17 is reduced. The telescopic rod and a telescopic link mechanism are both telescopic and longitudinally swinging, and then the height of the suspension can be adjusted to become higher, so as to realize the dynamic balance of bionic walking adjustment;

设置在底盘下的直线位移传感器将液压油缸15的伸缩位移量反馈回控制器4,控制器4经分析调整信号后输出控制信号,确保调整动态平衡。前方有障碍物需要绕行时,控制器4输出电信号给驱动器10,驱动器10控制电机18转动,电机18转动传递扭距给转向拉杆14,转向拉杆14由于它的长度自身形成转动偏距,绕法兰中心转动,完成转向。The linear displacement sensor arranged under the chassis feeds back the telescopic displacement of the hydraulic cylinder 15 back to the controller 4, and the controller 4 outputs a control signal after analyzing the adjustment signal to ensure the dynamic balance of adjustment. When there is an obstacle ahead that needs to be detoured, the controller 4 outputs an electrical signal to the driver 10, the driver 10 controls the motor 18 to rotate, the motor 18 rotates and transmits the torque to the steering rod 14, and the steering rod 14 forms a rotational offset due to its length, Turn around the center of the flange to complete the turn.

如图1所示:图1是全地形智能农用多功能动力底盘的机械结构左视图,所述锂电池组2为整套系统提供能源,所述直流变压器3固定于底盘5上,通过AD/DA转换,输出端电流被送到电磁阀的上升线圈,使该线圈吸引阀芯,根据地面的凹凸情况,接通液压油缸15的伸出/收缩油路,通过悬架链接拉簧12的收缩使悬架夹角发生变化,调整悬架高度,从而实现仿形驱动。夹角变化度数由倾角传感器读取,悬臂相对运动角称为横向仿形角α,通过拉簧实现角度的范围调整,配合传感器完成底盘对地面横向仿形。后悬臂和车架之间的夹角为纵向仿形角β,对应不同安装位置的仿形角依次为β1、β2、β3、β4,4个仿形角随地形变化情况被角度编码器采集反馈,实现底盘对地面纵向仿形。As shown in Figure 1: Figure 1 is the left side view of the mechanical structure of the all-terrain intelligent agricultural multi-functional power chassis. The lithium battery pack 2 provides energy for the entire system, and the DC transformer 3 is fixed on the chassis 5. AD/DA After conversion, the output current is sent to the rising coil of the solenoid valve, so that the coil attracts the spool, and according to the unevenness of the ground, the extension/contraction oil circuit of the hydraulic cylinder 15 is connected, and the contraction of the suspension link tension spring 12 makes the The included angle of the suspension is changed, and the height of the suspension is adjusted to realize the profiling drive. The degree of change in the included angle is read by the inclination sensor, and the relative movement angle of the cantilever is called the lateral profiling angle α. The range of the angle is adjusted by the tension spring, and the horizontal profiling of the chassis to the ground is completed with the sensor. The included angle between the rear cantilever and the frame is the longitudinal profiling angle β, and the profiling angles corresponding to different installation positions are β 1 , β 2 , β 3 , β 4 in turn. The encoder collects feedback to realize longitudinal profiling of the chassis to the ground.

如图2所示:图2是全地形智能农用多功能动力底盘的机械部分局部放大图,包括悬架7、仿形轮组11、悬架链接拉簧12、角度编码器13、悬臂14,所述四组仿形轮组11分别安装于悬架链接拉簧12两侧,四个电机18分别与前、后、左、右四个转向拉杆14垂直连接,固定于底盘5侧面,当所述仿形轮组11遇到凸起障碍后,所述角度编码器13检测到模拟信号小于设定值,模拟信号转换成数字信号传到控制器,控制器处理后输出的数字信号转换成模拟信号,所述控制液压油缸15接收信号收缩动作的集成功率开关,接通液压油缸15的收缩油路,悬臂17夹角增大。当遇到凹下的地面时,所述角度编码器13检测到模拟信号高于设定值,模拟信号输入到控制器4的输入端,所述控制液压油缸伸出动作的集成功率开关,接通液压油缸15的伸出油路,悬臂17夹角缩小。As shown in Figure 2: Figure 2 is a partial enlarged view of the mechanical part of the all-terrain intelligent agricultural multi-functional power chassis, including the suspension 7, the profiling wheel set 11, the suspension link tension spring 12, the angle encoder 13, the cantilever 14, The four sets of profiling wheel sets 11 are respectively installed on both sides of the suspension link tension spring 12, and the four motors 18 are respectively vertically connected with the front, rear, left and right steering rods 14, and are fixed on the side of the chassis 5. After the profiling wheel set 11 encounters a raised obstacle, the angle encoder 13 detects that the analog signal is less than the set value, the analog signal is converted into a digital signal and transmitted to the controller, and the digital signal output by the controller is converted into an analog signal. Signal, the integrated power switch that controls the hydraulic cylinder 15 to receive the signal to contract the action, turns on the contraction oil circuit of the hydraulic cylinder 15, and the angle of the cantilever 17 increases. When encountering a concave ground, the angle encoder 13 detects that the analog signal is higher than the set value, and the analog signal is input to the input end of the controller 4. The integrated power switch that controls the extension of the hydraulic cylinder is connected to Through the extension oil passage of the hydraulic cylinder 15, the included angle of the cantilever 17 is reduced.

如图4所示:图4是全地形智能农用多功能动力底盘的机械结构的轴测图。所述传感器盒6内放置多种传感器,其中各传感器采集数据传输给控制器4,并通过坐标变换系统构建高程地图模型。同时,所述传感器盒6中的位移传感器将液压缸的伸缩位移量反馈回控制器,控制器经分析调整信号后输出控制信号,所述底盘5调整动态平衡。所述控制器4接收经过坐标变换后的各类传感器信息,根据底盘的运动模型和观测模型,利用概率或优化的SLAM算法完成路标提取、数据关联、传感器数据融合、底盘定位、增量式地图构建等工作,为路径规划系统提供精确的定位和地图模型。As shown in Figure 4: Figure 4 is an axonometric view of the mechanical structure of the all-terrain intelligent agricultural multifunctional power chassis. A variety of sensors are placed in the sensor box 6, wherein the collected data of each sensor is transmitted to the controller 4, and an elevation map model is constructed through a coordinate transformation system. At the same time, the displacement sensor in the sensor box 6 feeds back the telescopic displacement of the hydraulic cylinder to the controller, the controller outputs a control signal after analyzing the adjustment signal, and the chassis 5 adjusts the dynamic balance. The controller 4 receives various sensor information after coordinate transformation, and uses probability or optimized SLAM algorithm to complete road sign extraction, data association, sensor data fusion, chassis positioning, and incremental map according to the motion model and observation model of the chassis. Construction and other work to provide accurate positioning and map models for the path planning system.

如图5所示:图5全地形智能农用多功能动力底盘的机械结构正视图。所述激光雷达1、安装在激光雷达侧面更靠近中心位置的TOF深度相机16和IMU模块8,IMU模块8能采集底盘当前底盘姿态状况,所述激光雷达1和TOF深度相机16获取作业时局部范围内较精细的地形信息。并基于得到的环境深度信息,运用SLAM算法,为路径规划系统提供精确的定位和地图模型。所述角度编码器13作为里程计将信号反馈回上位机,融合激光雷达与深度相机等多种传感器探究动态避障以及局部路径规划方法,实现移动底盘在动态环境中安全避障,以提升动力底盘路径规划的效率、运行的平稳性及安全性。所述传感器盒6将采集的数据发送给控制器4,用于对农机具未来工作环境进行信息采集。As shown in Figure 5: Figure 5 is a front view of the mechanical structure of the all-terrain intelligent agricultural multi-functional power chassis. The lidar 1, the TOF depth camera 16 and the IMU module 8 installed on the side of the lidar closer to the center, the IMU module 8 can collect the current chassis attitude status of the chassis, and the lidar 1 and the TOF depth camera 16 obtain the local parts during operation. The finer terrain information in the range. And based on the obtained environmental depth information, the SLAM algorithm is used to provide accurate positioning and map models for the path planning system. The angle encoder 13 acts as an odometer to feed back the signal to the host computer, and integrates various sensors such as lidar and depth camera to explore dynamic obstacle avoidance and local path planning methods, so as to realize the safe obstacle avoidance of the mobile chassis in a dynamic environment to improve power The efficiency of chassis path planning, running stability and safety. The sensor box 6 sends the collected data to the controller 4 for collecting information on the future working environment of the agricultural machinery.

上面结合附图对本发明的具体实施例作了详细说明,但是本发明并不限于上述实施例,在本领域普通技术人员所具备的知识范围内,还可以在不脱离本发明宗旨的前提下作出各种变化。The specific embodiments of the present invention have been described in detail above in conjunction with the accompanying drawings, but the present invention is not limited to the above-mentioned embodiments, and can also be made within the scope of knowledge possessed by those of ordinary skill in the art without departing from the purpose of the present invention. Various changes.

Claims (6)

1. The utility model provides an agricultural multi-functional power chassis of all-terrain intelligence which characterized in that: the device comprises a profile driving system, wherein the profile driving system comprises four groups of driving devices which are respectively arranged below a chassis (5), each group of driving devices has the same structure, and each group of driving devices comprises a connecting rod suspension (7), a profile wheel group (11), a suspension link tension spring (12), an angle encoder (13), a steering pull rod (14), a hydraulic oil cylinder (15), a cantilever (17) and a motor (18);
the upper end of the connecting rod suspension (7) is hinged to the chassis (5), the lower end of the connecting rod suspension is movably hinged to the first flange disc (19), the upper ends of the two cantilevers (17) are movably connected between the first flange disc (19) and the second flange disc (20), the copying wheel sets (11) are installed at the lower ends of the two cantilevers (17) respectively, a suspension link tension spring (12) is installed between the lower ends of the two cantilevers (17), a hydraulic oil cylinder (15) is installed on a first rib plate (21) of the second flange disc (20), the upper end of a telescopic end of the hydraulic oil cylinder (15) is installed on the lower bottom surface of the chassis (5), a steering pull rod (14) is installed on a second rib plate (22) of the second flange disc (20), the steering pull rod (14) is connected with the motor (18), an angle encoder (13) is installed on the second flange disc, and a controller (4) is connected with the angle encoder, The hydraulic oil cylinder (15) and the motor (18) are connected.
2. An all-terrain intelligent agricultural multifunctional power chassis according to claim 1, characterized in that: the connecting rod suspension (7) comprises 2 telescopic rods and a telescopic connecting rod mechanism, the upper ends of the 2 telescopic rods and the telescopic connecting rod mechanism are hinged with the chassis (5), and the lower ends of the 2 telescopic rods and the telescopic connecting rod mechanism are movably hinged with the first flange disc (19).
3. An all-terrain intelligent agricultural multifunctional power chassis according to claim 1, characterized in that: the field environment sensing system is also included; the field environment sensing system comprises a laser radar (1) arranged on the front side of a chassis of the frame and a TOF depth camera (16) arranged on the side surface of the laser radar closer to the center, and the frame is arranged in front of the agricultural implement and used for collecting information of the working environment of the agricultural implement; the TOF depth camera (16) is responsible for acquiring finer topographic information in a local range during operation; the sensors are placed in the sensor box (6), field environment information is collected through the sensors, data collected by the sensors in the sensor box (6) are transmitted to the controller (4), and an elevation map model is built through the coordinate transformation system.
4. An all-terrain intelligent agricultural multifunctional power chassis according to claim 1, characterized in that: the system also comprises a path planning navigation system; the path planning navigation system comprises a navigation system module and a path planning module, wherein the navigation system module takes an SLAM system as a core module of the whole navigation system; the path planning navigation system firstly receives data information acquired by the field environment sensing system after coordinate transformation, and finishes road sign extraction, data association, sensor data fusion, chassis positioning and incremental map construction work by utilizing a probability or optimized SLAM algorithm according to a motion model and an observation model of a chassis (5) so as to provide an accurate positioning and map model for a path planning module; and secondly, a path planning module is used for receiving positioning information, odometer information and surrounding environment map information of the chassis, the walking route is planned autonomously on the premise of accurate positioning, the obstacle avoidance driving is effectively carried out in real time, and meanwhile, an angle encoder (13) feeds back the ground fluctuation condition to the profiling driving system.
5. An all-terrain intelligent agricultural multifunctional power chassis according to claim 1, characterized in that: the system also comprises a human-computer interaction system; the human-computer interaction system is used for displaying a map and a visual interface of a chassis model, and realizing incremental creation of a two-dimensional map and image display of an actual environment in front of a chassis; meanwhile, a target point can be appointed for the path planning system in the autonomous mode, the motion control of the chassis is realized through a keyboard or a handle in the manual control mode, and the measurement of the soil moisture and the soil firmness physical information is completed and is summarized and uploaded to the cloud platform for storage.
6. An all-terrain intelligent agricultural multifunctional power chassis according to claim 1, characterized in that: the system also comprises a power supply system; the power supply system consists of a lithium battery pack (2), a motor (18) and a power management system, and the power management system is responsible for managing power distribution of a power supply output by a battery to each subsystem so as to realize power supply management and protection.
CN202010984712.7A 2020-09-18 2020-09-18 An all-terrain intelligent agricultural multifunctional power chassis Active CN112124426B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010984712.7A CN112124426B (en) 2020-09-18 2020-09-18 An all-terrain intelligent agricultural multifunctional power chassis

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010984712.7A CN112124426B (en) 2020-09-18 2020-09-18 An all-terrain intelligent agricultural multifunctional power chassis

Publications (2)

Publication Number Publication Date
CN112124426A true CN112124426A (en) 2020-12-25
CN112124426B CN112124426B (en) 2025-04-25

Family

ID=73841350

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010984712.7A Active CN112124426B (en) 2020-09-18 2020-09-18 An all-terrain intelligent agricultural multifunctional power chassis

Country Status (1)

Country Link
CN (1) CN112124426B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113207430A (en) * 2021-04-22 2021-08-06 广西壮族自治区农业科学院 Sugarcane leaf processing machine for collecting, crushing and returning all-terrain fields

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3653455A (en) * 1969-08-01 1972-04-04 Allan E Hetteen Off-road vehicle wheel suspension
CA2484325A1 (en) * 2003-10-08 2005-04-08 Pride Mobility Products Corporation Active anti-tip system for power wheelchairs
CN101407174A (en) * 2008-11-25 2009-04-15 中国农业大学 Walking device
CN106427453A (en) * 2016-11-07 2017-02-22 中国农业大学 Adaptive leveling suspension
US20200215866A1 (en) * 2019-01-08 2020-07-09 Liftmaster Ltd. Multi-lifting-tandems suspension
CN213534843U (en) * 2020-09-18 2021-06-25 昆明理工大学 Agricultural multi-functional power chassis of all-terrain intelligence
CN114851797A (en) * 2022-03-10 2022-08-05 广东天凛高新科技有限公司 Adaptive flat base adaptive to variable ground

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3653455A (en) * 1969-08-01 1972-04-04 Allan E Hetteen Off-road vehicle wheel suspension
CA2484325A1 (en) * 2003-10-08 2005-04-08 Pride Mobility Products Corporation Active anti-tip system for power wheelchairs
CN101407174A (en) * 2008-11-25 2009-04-15 中国农业大学 Walking device
CN106427453A (en) * 2016-11-07 2017-02-22 中国农业大学 Adaptive leveling suspension
US20200215866A1 (en) * 2019-01-08 2020-07-09 Liftmaster Ltd. Multi-lifting-tandems suspension
CN213534843U (en) * 2020-09-18 2021-06-25 昆明理工大学 Agricultural multi-functional power chassis of all-terrain intelligence
CN114851797A (en) * 2022-03-10 2022-08-05 广东天凛高新科技有限公司 Adaptive flat base adaptive to variable ground

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113207430A (en) * 2021-04-22 2021-08-06 广西壮族自治区农业科学院 Sugarcane leaf processing machine for collecting, crushing and returning all-terrain fields

Also Published As

Publication number Publication date
CN112124426B (en) 2025-04-25

Similar Documents

Publication Publication Date Title
WO2019233222A1 (en) Automatic wall-climbing radar photoelectric robot system for use in non-destructive detection and diagnosis of bridge-tunnel structure damage
CN109900280A (en) A kind of livestock and poultry information Perception robot and map constructing method based on independent navigation
CN203324816U (en) Field soil moisture content detection trolley based on automatic navigation
CN111596671A (en) An unmanned intelligent sweeper trajectory tracking control method and system
CN110715665B (en) A field crop phenotype monitoring robot and its navigation method
CN103134457B (en) A kind of agricultural machinery and implement tilling depth method of real-time
CN110809951B (en) Full-hydraulic crawler-type unmanned rape direct seeder
CN102628783A (en) Robot for testing soil hardness
CN104842822A (en) High-precision Beidou positioning based universal automatic driving control device for agricultural machinery
CN110293808B (en) Vehicle double-cylinder leveling device based on position control mode
CN107443383A (en) Robot used for intelligent substation patrol environmental map laser positioning guider and method
CN207216418U (en) Agricultural robot automatic driving system
CN112947433A (en) Orchard mobile robot and autonomous navigation method thereof
CN108401648A (en) A kind of wind-light storage fills integrated intelligent lawn maintenance system
CN117030974A (en) Polluted site sampling robot and automatic sampling method
CN114296463A (en) A method for generating paths between work areas and a garden system
CN112124426A (en) An all-terrain intelligent agricultural multifunctional power chassis
CN114700927A (en) Combined weeding robot with parallel mechanical arms and flexible mechanical arm and control method
CN114617114A (en) A solar-powered weeding robot and its control method
CN110412589A (en) System and method for three-dimensional scanning of tree roots
CN110948490A (en) Orchard inspection robot with autonomous navigation function
CN216883946U (en) Greenhouse intelligent inspection robot
CN108032926A (en) Paddy field mud foot depth survey remote operated vehicle
CN211333212U (en) Orchard inspection robot with autonomous navigation function
CN204623196U (en) Based on the universal automatic driving of agricultural machinery control setup of Big Dipper high fix

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant