Heterogeneous cooperative intelligent pesticide applying machine structure for commercial crops in hilly areas and path tracking method thereof

By designing heterogeneous collaborative intelligent pharmaceutical applicators in hilly areas, using crawler-type mobile platforms, foldable pharmaceutical applicators and drones to work together, combining multi-source data and deep learning technology, agricultural mechanization and positioning accuracy in hilly areas are solved. The problem of low efficiency and flexibility in application and environmental perception are achieved, and the operation efficiency is improved.

CN119073291AActive Publication Date: 2024-12-06JIANGSU UNIV
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411235239.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-12-06
Estimated Expiration
2044-09-04

AI Technical Summary

Technical Problem

The complex terrain and diverse crop species in hilly and mountainous areas make it difficult for existing agricultural machinery to adapt, resulting in limited development of agricultural mechanization, intelligence and unmanned agriculture, and problems such as high labor intensity, poor spray uniformity and low positioning accuracy.

Method used

A heterogeneous collaborative intelligent pharmaceutical applicator for hilly areas was designed, using a crawler-type mobile platform, foldable pharmaceutical applicator and drone collaborative operation, combining Beidou positioning, vision sensors and lidar, utilizing neural networks and deep learning Technology conducts high-precision map construction and path tracking to achieve precise drug application and environmental perception.

Benefits of technology

It improves the flexibility and positioning accuracy of the pharmaceutical application machine, reduces labor intensity, enhances operating efficiency, and solves the problem of signal deficiency through wireless charging and data integration, adapts to the application needs of different crops and terrain.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119073291A_ABST
    Figure CN119073291A_ABST
Patent Text Reader

Abstract

The invention discloses a heterogeneous cooperative intelligent pesticide application machine structure for commercial crops in hilly areas and a path tracking method thereof. Belongs to the technical field of agricultural machinery. Comprising a pesticide applying machine body 1, a lifting frame 2 fixed at the front end of the pesticide applying machine, a foldable pesticide applying rod 4 fixed on the lifting frame, a pesticide box support 9 fixed at the rear end of the pesticide applying machine, and a pesticide box 8 fixed on the support. The pesticide applying machine body adopts a crawler-type double-layer platform design and comprises a crawler-type movable chassis 11 and a double-layer bracket 12, and a central controller and drive circuit control board 6, a water pump 7, a data acquisition and communication module 3, an unmanned aerial vehicle 5 and an unmanned aerial vehicle wireless charging platform 10 are fixed on the bracket; the data acquisition and communication module comprises a laser radar 32, a visual sensor 31, a Beidou satellite antenna 33 and a radio receiver 34. According to the invention, a corresponding structure and a path tracking method are designed for a pesticide application operation scene in a hilly area, and finally precise pesticide application and path tracking of a heterogeneous cooperative intelligent pesticide application machine are realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of agricultural machinery and relates to a heterogeneous pesticide applicator for economic crops, and more specifically to a heterogeneous collaborative intelligent pesticide applicator structure for economic crops in hilly areas and a path tracking method thereof. Background Art

[0002] my country's hilly and mountainous areas are vast, accounting for about 70% of the country's total land area. They are mainly distributed in more than 1,400 counties and cities in 19 provinces, autonomous regions and municipalities, and their cultivated land area and crop planting area account for 1 / 3 of the country. Due to the characteristics of different cultivated land slopes, irregular plots, and complex topography and landforms in hilly and mountainous areas, the development of agricultural mechanization in hilly and mountainous areas has been seriously affected, and there is a realistic problem of "no machines available and no good machines to use" in agricultural production. The reason is that the current research and development of agricultural machinery and equipment suitable for hilly and mountainous areas lacks the necessary technical support. In addition, my country is one of the countries in the world with the most cultivated cash crops. Due to the high quality standards for exported cash crops, it is urgent to accelerate the promotion of mechanization, intelligence, unmanned and precision agriculture in hilly and mountainous areas. Summary of the invention

[0003] The purpose of the present invention is to design a heterogeneous collaborative intelligent pesticide applicator for cash crops in hilly areas, which is suitable for carrying out pesticide application operations while autonomously navigating, realizing human-machine separation, avoiding direct contact between operators and liquid pesticides, greatly reducing labor intensity and improving operating efficiency. The crawler mobile platform can better adapt to the operating environment in hilly areas, and the liftable and foldable pesticide rod structure broadens the operating environment of the pesticide applicator.

[0004] To achieve the above object, the technical solution of the present invention is as follows:

[0005] A heterogeneous collaborative intelligent pesticide spraying machine structure for cash crops in hilly areas comprises a crawler-type mobile chassis (11), a double-layer bracket (12), a lifting frame (2), a foldable pesticide spraying rod (4), a data acquisition and communication module (3), a central controller and a drive circuit control board (6), a water pump (7), a medicine box (8), a medicine box bracket (9), an unmanned aerial vehicle (5) and an unmanned aerial vehicle wireless charging platform (10); the double-layer bracket (12) is fixed on the crawler-type mobile chassis (11) to provide support for other components of the pesticide spraying machine; the crawler-type mobile chassis (11) is driven by two independent permanent magnet synchronous motors (112); a battery box (111) is fixed at the front end of the chassis, and a battery is installed in the battery box (111) to supply power to the entire pesticide spraying machine; the lifting frame (2) is fixed at the front end of the pesticide spraying machine and can drive the foldable pesticide spraying rod (4) to move up and down. The data acquisition and communication module (3) comprises a Beidou antenna (33), a radio receiver (34), a laser radar (32) and a visual sensor (31); the central controller and drive circuit control board (6) are used to process the data acquired by the data acquisition and communication module (3) and drive each module of the pesticide applicator; the liquid medicine is stored in a medicine box (8), which is fixed to the rear of the pesticide applicator through a medicine box bracket (9), and is connected to a water pump (7) and a nozzle (42) in sequence; the drone (5) realizes real-time communication with the pesticide applicator through a radio receiver (34), and is parked on a drone wireless charging platform (10).

[0006] Furthermore, the crawler-type mobile chassis (11) provides a mounting platform. When the permanent magnet synchronous motor (112) drives the driving wheel to rotate, the driving wheel, under the action of the reducer driving torque, continuously rolls up the crawler track from the rear through the meshing between the gear teeth on the driving wheel and the crawler chain, thereby realizing the position adjustment of the heterogeneous collaborative intelligent pesticide applicator.

[0007] Furthermore, the lifting frame (2) is fixed at the front end of the pesticide applicator, and grooves are formed on both sides of the bracket (21). An electric telescopic rod (23) moves up and down to drive the gear on the top to engage with the chain (22). One end of the chain (22) is fixed to the lower end of the lifting frame (2), and the other end is fixed to the front frame (43) of the foldable pesticide applicator rod (4). The front frame has sliders on both sides embedded in the grooves on both sides of the bracket (21). The up and down movement of the foldable pesticide applicator rod (4) is achieved by the engagement of the gear and the chain (22).

[0008] Furthermore, the foldable pesticide application rod (4) is composed of a pesticide application rod (41), a spray head (42), a front frame (43) and an electric telescopic rod (44). The two ends of the front frame are provided with sliders embedded in grooves on both sides of the lifting frame. The pesticide application rod (41) is connected to both sides of the front frame by a latch and can be driven by a telescopic rod (44) connected between the front frame and the pesticide application rod to rotate around the latch connecting the front frame (43) and the spray rod (41). The spray heads (42) are evenly distributed on the lower side of the spray rod, and the liquid medicine can be evenly sprayed onto the crops through a water pump (7).

[0009] Furthermore, the visual sensor (31) and the laser radar (32) are located on the top of the pesticide sprayer and are used to obtain image information around the pesticide sprayer and detect surrounding obstacles respectively. The neural network technology is used to efficiently integrate multi-source perception with maps, meteorological satellite data and other heterogeneous data sources, and then the distributed feature extraction technology based on deep learning is used to obtain key information to establish a high-precision, real-time updated agricultural information map.

[0010] Furthermore, the Beidou antenna (33) and the radio receiver (34) are respectively located on the upper layer of the double-layer bracket of the pesticide sprayer and the side rear support of the double-layer bracket. The Beidou antenna (33) is used to obtain the satellite position signal of the pesticide sprayer, and the radio receiver (34) is used to obtain the reference position information of the base station. By utilizing the spatial correlation of the observation errors between the above two types of information, most of the errors in the observation data of the mobile station are removed by RTK differential method.

[0011] Furthermore, the central controller and drive circuit control board (6) are Raspberry Pi 5 and STM32F407 control boards, which achieve the task of precise pesticide application for economic crops in hilly areas by driving the crawler mobile chassis (11), the foldable pesticide application rod (4), the drone (5) and the water pump (7).

[0012] Furthermore, the UAV (5) is equipped with a high-resolution visual sensor, which can obtain a high-definition image of the current position of the agricultural machinery in real time, extract landmarks, feature points or patterns in the image, realize high-precision perception of the position of the unmanned pesticide sprayer, and establish a visual map of the unmanned pesticide sprayer; secondly, combined with Beidou positioning information, the position information is supplemented and corrected through visual perception data, and the position of the unmanned pesticide sprayer is estimated more accurately, which makes up for the problem of limited Beidou signals in complex terrain and improves the positioning accuracy of agricultural machinery in hilly and mountainous areas; the UAV wireless charging platform (10) adopts an 84W RiCharge module with an input voltage of 220V and an output power of 84W, and can wirelessly charge the UAV within a range of 3-8cm.

[0013] The path tracking method of a heterogeneous collaborative intelligent pesticide applicator structure for cash crops in hilly areas of the present invention comprises the following steps:

[0014] Step 1: Assuming that the tracks on both sides are exactly the same, the overall center of mass coincides with the geometric center, and without considering the side slip of the tracks, the kinematic model of the pesticide sprayer in the global coordinate system is established according to the motion model of the tracked mobile chassis (11):

[0015]

[0016] Where x and y are the horizontal and vertical coordinates of the center of mass of the sprayer in the global coordinate system, respectively; θ is the angle between the longitudinal direction of the sprayer and the X-axis, i.e. the heading angle; υ is the linear velocity of the center of mass along the longitudinal direction of the fuselage; ω is the angular velocity of the fuselage rotation;

[0017] Step 2: Let x e and e are the x-axis and y-axis errors between the actual position of the applicator and the reference position, θ e is the heading angle error, and the differential equation of trajectory tracking error can be obtained by differentiating it:

[0018]

[0019] Where υ d and ω d are the expected linear velocity and the expected angular velocity respectively;

[0020] Step 3: Select sliding mode variables

[0021]

[0022] Step 4: Design the control input as

[0023]

[0024] Where k1 and k2 are positive constants;

[0025] Step 5: The linear velocity υ and angular velocity ω are determined by the crawler speeds on both sides and their center distances. The crawler speeds on both sides are determined by the speeds of the drive motors on both sides, the transmission ratio and the radius of the drive wheels. Then:

[0026]

[0027] In the formula, υ L ,υ R are the left and right track linear speeds, N L 、N R are the speeds of the left and right driving motors, r is the radius of the driving wheel, and i is the transmission ratio of the reducer;

[0028] Step 6: From equation (11), the rotation speeds of the permanent magnet synchronous motors (112) on the left and right sides of the crawler mobile chassis (11) are respectively:

[0029]

[0030] Step 7: The position and posture information of the pesticide applicator is obtained by using the data acquisition and communication module (3). According to the planned path, the backstepping control method is used to adjust the rotation speed of the permanent magnet synchronous motor (112) on the left and right sides of the crawler mobile chassis (11) to adjust the movement angle and displacement of the pesticide applicator in real time.

[0031] Traditional crops are generally sprayed with a backpack sprayer or a driving sprayer at a fixed dose, which is labor-intensive and has problems such as poor spraying uniformity, repeated spraying, and missed spraying. In addition, the terrain in hilly areas is undulating and the working environment is more complex, which puts higher requirements on the environmental perception and path tracking of unmanned sprayers.

[0032] In view of the above problems, the present invention adopts a crawler-type mobile chassis, a folding pesticide application rod, and a cooperative operation between a drone and a pesticide application machine to broaden the working environment of the pesticide application machine. The crawler-type chassis and the folding pesticide application rod not only reduce the overall volume of the pesticide application machine to a certain extent, making it more flexible to operate, but also the flexible pesticide application rod can make it adapt to the operation scenes of different crops, thereby improving the working efficiency.

[0033] The beneficial technical effects of the present invention are as follows:

[0034] 1. The crawler mobile platform can better adapt to the geographical environment of hilly areas and move more flexibly;

[0035] 2. The coordination between the pesticide applicator and the drone can not only improve the positioning accuracy, but also better obtain environmental information. At the same time, it can compensate for the impact of signal loss to a certain extent and improve the operation efficiency.

[0036] 3. The use of a liftable and foldable spraying rod can meet the spraying needs of different crops, and the folding of the spraying rod can improve the flexibility of the sprayer. BRIEF DESCRIPTION OF THE DRAWINGS

[0037] Figure 1 It is a left rear view of the present invention;

[0038] Figure 2 This is a schematic diagram of the crawler-type mobile chassis of the present invention;

[0039] Figure 3 This is a schematic diagram of the lifting frame and the foldable spraying rod of the present invention;

[0040] Figure 4 Schematic diagram of path tracking. DETAILED DESCRIPTION

[0041] The invention scheme is described in detail below in conjunction with the accompanying drawings in the invention examples.

[0042] like Figure 1 The left rear view of a heterogeneous collaborative intelligent pesticide spraying machine structure for cash crops in hilly areas is shown. It mainly consists of a crawler mobile chassis (11), a double-layer bracket (12), a data acquisition and communication module (3), a foldable pesticide spraying rod (4), a drone (5), a drone wireless charging platform (10), a central controller and a drive circuit control board (6), a water pump (7), a medicine box (8) and a medicine box bracket (9). It also includes the following parts: 31-visual sensor, 32-laser radar, 33-Beidou satellite antenna, 34-radio receiver; 111-battery box, 112-permanent magnet synchronous motor; 21-bracket, 22-chain, 23-electric telescopic rod, 41-pesticide spraying rod, 43-front frame, 44-electric telescopic rod. The crawler mobile chassis (11) uses a sliding mode controller designed based on step 9 to control the motion trajectory. The double-layer bracket (12) is made of aluminum profiles and aluminum plates connected by metal corner pieces. While providing support for the entire heterogeneous collaborative intelligent pesticide sprayer, it also reduces its own weight. The data acquisition and communication module (3) is used to obtain the position, posture and surrounding environment of the pesticide sprayer in real time, and the pictures and radar scanning information, wherein the Beidou antenna (33) is used to obtain the satellite position signal of the pesticide sprayer, and the radio receiver (34) is used to obtain the reference position information of the base station. The spatial correlation of the observation errors between the above two types of information is used to remove most of the errors in the mobile station observation data through RTK difference. The unmanned aerial vehicle (5) is equipped with a high-resolution visual sensor, which can obtain a high-definition image of the current position of the agricultural machinery in real time, extract landmarks, feature points or patterns from the image, realize high-precision perception of the position of the unmanned pesticide sprayer, and establish a visual map of the unmanned pesticide sprayer; and combined with the positioning information, the position information is supplemented and corrected through visual perception data, so as to make a more accurate position estimate of the unmanned pesticide sprayer. The unmanned aerial vehicle wireless charging platform (10) can wirelessly charge the unmanned aerial vehicle. The central controller and drive circuit control board (6) are used to receive and process the information collected and received by the data collection and communication module (3), and achieve the task of precise pesticide application for economic crops in hilly areas by driving the crawler-type mobile chassis (11), the foldable pesticide application rod (4), the drone (5) and the water pump (7).

[0043] like Figure 2The schematic diagram of the crawler-type mobile chassis is shown. Considering the large undulations in the hilly area, a crawler-type mobile platform is used. The chassis is driven by two independent permanent magnet synchronous motors. When the permanent magnet synchronous motor (112) drives the driving wheel to rotate, the driving wheel, under the action of the reducer driving torque, continuously rolls up the crawler from the rear through the meshing between the gear teeth on the driving wheel and the crawler chain, thereby realizing the position adjustment of the heterogeneous collaborative intelligent pesticide sprayer. Since two independent power units are used for driving, a differential method is used for turning, the turning radius is small, the turning is more flexible, and it is more suitable for hilly areas with rugged terrain. In addition, the crawler-type mobile platform increases the contact area with the ground, increases the friction force, and is not easy to cause the vehicle to sink, which is very suitable for the working environment in hilly areas. A battery box (111) is fixed at the front end of the chassis, and the battery box (111) is equipped with a battery to power the entire pesticide sprayer.

[0044] like Figure 3 The figure is a schematic diagram of a lifting frame and a foldable spraying rod. Considering the different spraying heights for different crops at different times and the requirements for flexibility, the use of a foldable spraying rod and a lifting frame can broaden the working environment of the sprayer and meet the spraying requirements of different crops at different times. The lifting frame is fixed to the front end of the sprayer. There are grooves on both sides of the bracket (21). An electric telescopic rod (23) moves up and down to drive the upper gear to engage with the chain (22). One end of the chain (22) is fixed to the lower end of the lifting frame (2), and the other end is fixed to the front frame (43) of the foldable spraying rod (4). The front frame has sliders on both sides embedded in the grooves on both sides of the bracket (21). The up and down movement of the foldable spraying rod (4) is achieved by the engagement of the gear with the chain (22).

[0045] like Figure 4 is a schematic diagram of path tracking, in which L is the width of the fuselage, d is the width of the single-side track, V is the longitudinal forward linear velocity of the fuselage, ω is the angular velocity of the fuselage, and V R and V L are the left and right track linear speeds respectively.

[0046] Assuming that the tracks on both sides are exactly the same, the overall center of mass coincides with the geometric center, and without considering the side slip of the tracks, the kinematic model of the pesticide sprayer in the global coordinate system is established based on the motion model of the tracked mobile chassis (11):

[0047]

[0048] Where x and y are the horizontal and vertical coordinates of the center of mass of the pesticide applicator in the global coordinate system; θ is the angle between the longitudinal direction of the pesticide applicator and the X-axis, i.e. the heading angle;

[0049] Let x e and e are the x-axis and y-axis errors between the actual position of the applicator and the reference position, θe is the heading angle error, and the differential equation of trajectory tracking error can be obtained by differentiating it:

[0050]

[0051] Where υ d and ω d are the expected linear velocity and the expected angular velocity respectively;

[0052] Select sliding mode variables

[0053]

[0054] The control input is designed to be

[0055]

[0056] Where k1 and k2 are positive constants;

[0057] The linear velocity υ and angular velocity ω are determined by the crawler speeds on both sides and their center distances. The crawler speeds on both sides are determined by the speeds of the drive motors on both sides, the transmission ratio and the radius of the drive wheel. Then:

[0058]

[0059] Where N L 、N R are the speeds of the left and right driving motors respectively, r is the radius of the driving wheel, and i is the transmission ratio of the reducer.

[0060] From formula (17), it can be obtained that the rotation speeds of the permanent magnet synchronous motors (112) on the left and right sides of the crawler mobile chassis (11) are respectively:

[0061]

[0062] The position and posture information of the pesticide applicator is obtained by using a data acquisition and communication module (3), and the movement angle and displacement of the pesticide applicator are adjusted in real time by adjusting the rotation speed of the permanent magnet synchronous motors (112) on the left and right sides of the crawler-type mobile chassis (11) according to the planned path using a backstepping control method.

Claims

1. A heterogeneous collaborative intelligent pesticide spraying machine structure for cash crops in hilly areas, characterized in that: The invention comprises a crawler-type mobile chassis (11), a double-layer bracket (12), a lifting frame (2), a foldable pesticide application rod (4), a data acquisition and communication module (3), a central controller and a drive circuit control board (6), a water pump (7), a medicine box (8), a medicine box bracket (9), an unmanned aerial vehicle (5) and an unmanned aerial vehicle wireless charging platform (10); the double-layer bracket (12) is fixed on the crawler-type mobile chassis (11) to provide support for other components of the pesticide application machine; the crawler-type mobile chassis (11) is driven by two independent permanent magnet synchronous motors (112); a battery box (111) is fixed at the front end of the chassis, and a battery is installed in the battery box (111) to supply power to the entire pesticide application machine; the lifting frame (2) is fixed at the front end of the pesticide application machine and can drive the foldable pesticide application rod (4) to move up and down; the data acquisition and communication module (3) comprises a Beidou antenna (33), a radio receiver (34), a laser radar (32) and a visual sensor (31); The liquid medicine is stored in a medicine box (8), which is fixed to the rear of the pesticide applicator via a medicine box bracket (9), and is connected to a water pump (7) and a nozzle (42) in sequence; the drone (5) can achieve real-time communication with the pesticide applicator, and can be wirelessly charged via a drone wireless charging platform (10); the central controller and drive circuit control board (6) are used to process data acquired by the data acquisition and communication module (3) and drive various modules of the pesticide applicator to complete path tracking and precise pesticide application tasks.

2. The structure according to claim 1, characterized in that: The crawler-type mobile chassis (11) provides a mounting platform. When the permanent magnet synchronous motor (112) drives the driving wheel to rotate, the driving wheel, under the action of the reducer driving torque, continuously rolls up the crawler from the rear through the meshing between the gear teeth on the driving wheel and the crawler chain, thereby realizing the position adjustment of the heterogeneous collaborative intelligent pesticide applicator.

3. The structure according to claim 1, characterized in that: The lifting frame (2) is fixed at the front end of the pesticide spraying machine, and the bracket (21) includes grooves on both sides, and an electric telescopic rod (23) moves up and down to drive the gear on the top to engage with the chain (22); one end of the chain (22) is fixed to the lower end of the lifting frame (2), and the other end is fixed to the front frame (43) of the foldable pesticide spraying rod (4), and the front frame has sliders on both sides embedded in the grooves on both sides of the bracket (21), and the up and down movement of the foldable pesticide spraying rod (4) is realized by the engagement of the gear and the chain (22).

4. The structure according to claim 1, characterized in that The foldable pesticide application rod (4) is composed of a pesticide application rod (41), a spray head (42), a front frame (43) and an electric telescopic rod (44). The front frame has sliders at both ends embedded in grooves on both sides of the lifting frame. The pesticide application rod (41) is connected to both sides of the front frame by a latch and can be driven by an electric telescopic rod (44) connected between the front frame and the pesticide application rod to rotate around the latch connecting the front frame (43) and the pesticide application rod (41). The spray heads (42) are evenly distributed on the lower side of the spray rod, and the drug solution can be evenly sprayed onto the target crop through a water pump (7).

5. The structure according to claim 1, characterized in that: The visual sensor (31) and the laser radar (32) are located on the top of the pesticide sprayer and are used to obtain image information around the pesticide sprayer and detect obstacles around it. The neural network technology is used to efficiently integrate multi-source perception with maps, meteorological satellite data and other heterogeneous data sources, and then the distributed feature extraction technology based on deep learning is used to obtain key information to establish a high-precision, real-time updated agricultural information map.

6. The structure according to claim 1, characterized in that The Beidou antenna (33) and the radio receiver (34) are respectively located on the upper layer of the double-layer bracket of the pesticide sprayer and the side rear support of the double-layer bracket. The Beidou antenna (33) is used to obtain the satellite position signal of the pesticide sprayer, and the radio receiver (34) is used to obtain the reference position information of the base station. The spatial correlation of the observation errors between the above two types of information is used to remove most of the errors in the mobile station observation data through real-time dynamic (RTK) difference.

7. The structure according to claim 1, characterized in that The central controller and drive circuit control board (6) are Raspberry Pi 5 and STM32F407 control boards, which achieve precise pesticide application tasks for cash crops in hilly areas by driving a crawler-type mobile chassis (11), a foldable pesticide application rod (4), a drone (5) and a water pump (7).

8. The structure according to claim 1, characterized in that The UAV (5) is equipped with a high-resolution visual sensor, which can obtain a high-definition image of the current position of the agricultural machinery in real time, extract landmarks, feature points or patterns in the image, realize high-precision perception of the position of the unmanned pesticide sprayer, and establish a visual map of the unmanned pesticide sprayer; secondly, combined with Beidou positioning information, the position information is supplemented and corrected through visual perception data, and the position of the unmanned pesticide sprayer is estimated more accurately, which makes up for the problem of limited Beidou signals in complex terrain and improves the positioning accuracy of agricultural machinery in hilly and mountainous areas; the UAV wireless charging platform (10) adopts an 84WRiCharge module with an input voltage of 220V and an output power of 84W, and can wirelessly charge the UAV within a range of 3-8cm.

9. The path tracking method of heterogeneous collaborative intelligent pesticide spraying machine structure for cash crops in hilly areas according to claim 1 is characterized in that: Here are the steps: Step 1: Assuming that the tracks on both sides are exactly the same, the overall center of mass coincides with the geometric center, and without considering the side slip of the tracks, the kinematic model of the pesticide sprayer in the global coordinate system is established according to the motion model of the tracked mobile chassis (11): Where x and y are the horizontal and vertical coordinates of the center of mass of the sprayer in the global coordinate system, respectively; θ is the angle between the longitudinal direction of the sprayer and the X-axis, i.e. the heading angle; υ is the linear velocity of the center of mass along the longitudinal direction of the fuselage; ω is the angular velocity of the fuselage rotation; Step 2: Let x e and e are the x-axis and y-axis errors between the actual position of the applicator and the reference position, θ e is the heading angle error, and the differential equation of trajectory tracking error can be obtained by differentiating it: Where υ d and ω d are the expected linear velocity and the expected angular velocity respectively; Step 3: Select sliding mode variables Where s1 is the x-axis error between the actual position of the applicator and the reference position, and s2 is the sum of the arc tangent of the product of the y-axis error and the expected linear velocity and the heading angle error; Step 4: Design the control input as Where k1 and k2 are positive constants; Step 5: The linear velocity υ and angular velocity ω are determined by the track speeds on both sides and their center distances. The track speeds on both sides are determined by the drive motor speeds, transmission ratios and drive wheel radius on both sides. Then: In the formula, υ L ,υ R are the left and right track linear speeds, N L 、N R are the speeds of the left and right drive motors, r is the radius of the drive wheel, i is the transmission ratio of the reducer, L is the width of the machine body, and d is the width of the single-side crawler track; Step 6: From equation (5), the rotation speeds of the permanent magnet synchronous motors (112) on the left and right sides of the crawler mobile chassis (11) are respectively: Step 7: The position and posture information of the pesticide applicator is obtained by using the data acquisition and communication module (3). According to the planned path, the backstepping control method is used to adjust the rotation speed of the permanent magnet synchronous motor (112) on the left and right sides of the crawler mobile chassis (11) to adjust the movement angle and displacement of the pesticide applicator in real time.

Citation Information

Patent Citations

  • Plant protection unmanned vehicle with variable height and span

    CN114711212A

  • Intelligent walking chassis for lifting operation platform for hilly and mountainous area environment

    CN115145288A

  • Orchard pesticide applying device

    CN218042668U