Tobacco leaf harvesting machine walking control system and method

Through the combination of the crawler walking control system, Hall rocker and rotary potentiometer, the problem of wheeled tobacco harvester with large turning radius and difficult control is solved, and the effect of strong adaptability and flexible steering is achieved, and the harvesting is improved Efficiency and transmission efficiency.

CN118938912APending Publication Date: 2024-11-12SHANDONG UNIV OF TECH +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410989525.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-23
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The existing wheeled tobacco harvesters have problems such as large turning radius, difficult handling, complex transmission structure and high cost, resulting in low harvesting efficiency and adaptability.

Method used

The track-type walking control system is adopted, and the working state of the left and right drive motors is directly controlled through the combination of Hall rocker and rotating potentiometer, to realize the functions of acceleration and deceleration, steering, etc., simplify the mechanical transmission mechanism and improve the transmission efficiency.

Benefits of technology

It achieves the effects of strong adaptability, flexible steering and small turning radius, which reduces pressure on the ground, improves the passing ability in muddy or rugged lands, and solves the problem of difficulty in handling.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938912A_ABST
    Figure CN118938912A_ABST
Patent Text Reader

Abstract

The invention discloses a traveling control system and method for a tobacco leaf harvesting machine, and relates to the technical field of tobacco leaf harvesting machine control. The system is applied to the tobacco leaf harvesting machine provided with a crawler-type walking mechanism. The system comprises a walking controller and a two-way driving assembly. The two-way driving assembly is connected with the crawler-type walking mechanism and the walking controller. The walking controller obtains the locking signal and converts the locking signal into a locking digital signal, and when the locking digital signal is smaller than or equal to a preset value, the walking control system of the tobacco harvesting machine is locked. And when the locking digital signal is greater than the preset value, acquiring an expected steering angular velocity signal and an expected velocity signal, and generating a control signal according to the expected steering angular velocity signal and the expected velocity signal. The control signals comprise a left track control signal and a right track control signal; the two-way driving assembly controls the crawler-type walking mechanism according to the control signal. By arranging the crawler-type walking mechanism, the controllability of walking control of the tobacco leaf harvesting machine can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of tobacco harvester control, and in particular to a tobacco harvester travel control system and method. Background Art

[0002] In the process of tobacco production, timely and efficient harvesting is the key to ensuring the quality of tobacco leaves. In recent years, with the development of digital agriculture and smart agriculture, tobacco planting, field management and harvesting have basically been mechanized. As one of the important equipment, the tobacco harvester has a stable and efficient walking system that is of great significance to the improvement of tobacco harvesting efficiency and quality. The Chinese patent with publication number CN113016341A discloses a wheeled tobacco harvester, whose steering system adopts a double hydraulic cylinder structure to ensure that the left and right steering angles are consistent, avoiding the generation of cylinder empty stroke. The invention does not consider the problems of difficulty in turning and turning in the field caused by the large turning radius of the wheeled harvester. The control system of the existing wheeled tobacco harvester has defects such as difficult control, complex transmission structure, and high cost. The wheeled tobacco harvester generally adopts a mechanical structure to change the transmission ratio to achieve speed control, and adopts a traditional hydraulic steering system to control the steering, which leads to problems such as low transmission efficiency. Therefore, in view of the low adaptability and inflexible steering of wheeled tobacco harvesters, there is an urgent need for a tobacco harvester travel control system that can improve the tobacco harvesting efficiency. Summary of the invention

[0003] The purpose of the present application is to provide a tobacco harvester travel control system and method, which can improve the controllability of the tobacco harvester travel control.

[0004] To achieve the above objectives, this application provides the following solutions:

[0005] In a first aspect, the present application provides a tobacco harvester travel control system, wherein the tobacco harvester travel control system is applied to a tobacco harvester provided with a crawler travel mechanism; the crawler travel mechanism is a double crawler structure;

[0006] The tobacco harvester travel control system comprises: a travel controller and a dual-path drive assembly;

[0007] The dual-path driving assembly is respectively connected to the crawler-type walking mechanism and the walking controller;

[0008] The walking controller is used to obtain a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the walking control system of the tobacco harvester is locked; when the locking digital signal is greater than a preset value, an expected steering angular velocity signal and an expected speed signal are obtained, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal; the control signal includes a left crawler control signal and a right crawler control signal;

[0009] The dual-path driving assembly is used to control the crawler-type walking mechanism according to the control signal.

[0010] Optionally, the dual-channel driving component specifically includes: a left-channel driving component and a right-channel driving component;

[0011] The left-side driving assembly is respectively connected to the travel controller and the left crawler track of the crawler-type travel mechanism; the right-side driving assembly is respectively connected to the travel controller and the right crawler track of the crawler-type travel mechanism;

[0012] The left-side driving assembly comprises: a left motor driver and a left driving motor;

[0013] The left motor driver is connected to the walking controller and the left driving motor respectively;

[0014] The left drive motor is connected to the left crawler track of the crawler-type walking mechanism;

[0015] The right road driving assembly comprises: a right motor driver and a right driving motor;

[0016] The right motor driver is connected to the walking controller and the right driving motor respectively;

[0017] The right drive motor is connected to the right crawler track in the crawler-type walking mechanism.

[0018] Optionally, the tobacco harvester travel control system further includes: a lithium battery and a voltage reduction module;

[0019] The voltage reduction module is connected to the lithium battery and the walking controller respectively.

[0020] Optionally, the walking controller includes a microprocessor, a Hall rocker and a rotary potentiometer;

[0021] The microprocessor is respectively connected to the dual-channel drive component, the Hall rocker and the rotary potentiometer;

[0022] The microprocessor is used to obtain the Y-axis status signal of the Hall rocker as a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the tobacco harvester travel control system is locked; when the locking digital signal is greater than the preset value, the X-axis status signal of the Hall rocker is obtained as an expected steering angular velocity signal, the rotary potentiometer signal is obtained as an expected speed signal, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal.

[0023] In a second aspect, the present application provides a tobacco harvester walking control method, the tobacco harvester walking control method is applied to the tobacco harvester walking control system, and the tobacco harvester walking control method includes:

[0024] The straight-line control strategy is used to control the tobacco leaf harvester to travel from the starting point of the current harvesting row to the end point of the current harvesting row; the starting points of all odd-numbered harvesting rows and the end points of all even-numbered harvesting rows in the tobacco field are collinear; the end points of all odd-numbered harvesting rows and the starting points of even-numbered harvesting rows in the tobacco field are collinear;

[0025] The U-turn control strategy is used to control the tobacco leaf harvester to travel from the end point of the current harvesting row to the starting point of the next harvesting row, and the next harvesting row is used as the current harvesting row and returns to the step "using the straight control strategy to control the tobacco leaf harvester to travel from the starting point of the current harvesting row to the end point of the current harvesting row" until all the harvesting rows in the tobacco field are traversed.

[0026] Optionally, the straight-ahead control strategy is:

[0027] Get the Y-axis status signal of the Hall rocker as a locking signal;

[0028] Converting the locking signal into a locking digital signal;

[0029] When the locking digital signal is less than or equal to a preset value, locking the tobacco harvester travel control system;

[0030] When the locking digital signal is greater than a preset value, the X-axis state signal of the Hall rocker is obtained as a desired steering angular velocity signal, and the rotary potentiometer signal is obtained as a desired speed signal;

[0031] A control signal is generated according to the expected steering angle velocity signal and the expected velocity signal; the control signal includes a left track control signal and a right track control signal.

[0032] Optionally, generating a control signal according to the expected steering angle velocity signal and the expected velocity signal comprises:

[0033] Digitally processing the desired steering angular velocity signal to obtain a desired steering angular velocity digital signal;

[0034] Digitally processing the desired speed signal to obtain a desired speed digital signal;

[0035] Determine the left track speed and the right track speed according to the desired steering angle velocity digital signal and the desired speed digital signal;

[0036] determining a voltage signal of a left drive motor according to a speed of the left crawler track;

[0037] Determine the voltage signal of the right drive motor according to the speed of the right crawler track;

[0038] At a preset frequency, the left crawler track control signal is gradually increased according to the initial left crawler track control signal and the step voltage value until the left crawler track control signal reaches the left drive motor voltage signal;

[0039] According to the preset frequency, the right crawler track control signal is gradually generated according to the initial right crawler track control signal and the step voltage value until the right crawler track control signal reaches the right drive motor voltage signal.

[0040] Optionally, the left drive motor voltage signal and the right drive motor voltage signal are:

[0041]

[0042] In the formula,

[0043] Among them, U L is the voltage signal of the left drive motor, U R is the voltage signal of the right drive motor, D L The left track speed when the straight-ahead control strategy is used, D R The right track speed when the straight-ahead control strategy is used, D V is the expected speed digital signal, B is the track gauge, D ω is the desired steering angular velocity digital signal, and Z is the Hall rocker mid-position offset correction coefficient.

[0044] Optionally, the U-turn control strategy includes:

[0045] Determine the transition point C; the transition point C is on the symmetry axis between the current harvesting row and the next harvesting row, and the distance from the transition point C to the parallel boundary of the tobacco field near the start and end lines is half of the total length of the tobacco leaf harvester; the parallel boundary near the start and end lines is the boundary closest to the end point of the current harvesting row among the two boundaries of the tobacco field parallel to the current start and end lines; the current start and end lines are the straight lines where the end point of the current harvesting row and the starting point of the next harvesting row are located;

[0046] Using the steering strategy crawler speed formula, determine the left crawler speed and the right crawler speed of the tobacco harvester when it travels from the end point B of the current harvesting row to the transition point C;

[0047] Based on the left crawler speed and the right crawler speed, the tobacco leaf harvester is controlled to travel from the end point B of the current harvesting row to the transition point C;

[0048] Use the rotation angle formula to determine the transition point rotation angle;

[0049] Control the tobacco leaf harvester to rotate in situ at transition point C to achieve a transition point rotation angle;

[0050] Using the steering strategy crawler speed formula, determine the left crawler speed and the right crawler speed of the tobacco harvester when it travels from the transition point C to the starting point D of the next harvesting row;

[0051] Based on the left crawler speed and the right crawler speed, the tobacco harvester is controlled to travel from the transition point C to the starting point D of the next harvesting row.

[0052] Optionally, the steering strategy is:

[0053]

[0054] Among them, V L is the left track speed during the steering strategy, V R is the right crawler speed when the steering strategy is in effect, B is the crawler gauge, h is the tobacco row spacing, L1 is the field width, and the field width is the distance between the parallel boundary near the start and end line and the current start and end line; L C is the total length of the tobacco harvester, V C is the center point speed of the machine;

[0055] The rotation angle formula is:

[0056]

[0057] Where θ is the rotation angle of the transition point.

[0058] According to the specific embodiments provided in this application, this application discloses the following technical effects:

[0059] The present application provides a tobacco harvester travel control system and method, which achieves the effects of strong adaptability, flexible steering and small turning radius based on a crawler travel mechanism. The crawler travel mechanism has a larger ground contact area, thereby reducing the pressure on the ground and improving the passability in muddy or rugged terrain. The crawler travel mechanism can turn on the spot and turn unilaterally, solving the problem of large turning radius; a combination of Hall rocker and potentiometer is used to directly control the working status of the left and right drive motors, realizing the basic functions of the tobacco harvester such as acceleration, deceleration, and steering, simplifying the mechanical transmission mechanism, improving the transmission efficiency, realizing cruise control, acceleration and deceleration, turning on the spot, turning unilaterally and other functions, solving the problem of difficult control. BRIEF DESCRIPTION OF THE DRAWINGS

[0060] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0061] Figure 1 This is a schematic diagram of the structure of a tobacco harvester travel control system in one embodiment of the present application;

[0062] Figure 2 for Figure 1 Schematic diagram of the walking controller;

[0063] Figure 3 A schematic diagram of a walking route of a tobacco harvester walking control method provided by another embodiment of the present application;

[0064] Figure 4 A flow chart of a straight-ahead control strategy provided in one embodiment of the present application;

[0065] Figure 5 A schematic diagram of a straight-ahead control strategy provided in an embodiment of the present application;

[0066] Figure 6 A schematic diagram of a U-turn control strategy provided in one embodiment of the present application.

[0067] Description of the drawings: 1- Emergency stop button, 2- Main power switch, 3- Hall rocker, 4- Power display module, 5- Horn button, 6- Lighting button, 7- Status indicator light, 8- Rotary potentiometer. DETAILED DESCRIPTION

[0068] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0069] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, the present application is further described in detail below with reference to the accompanying drawings and specific implementation methods.

[0070] like Figure 1 The present application provides a tobacco harvester travel control system, which is applied to a tobacco harvester provided with a crawler travel mechanism. The crawler travel mechanism is a double crawler structure.

[0071] The tobacco harvester travel control system includes: a travel controller and a dual-channel drive assembly. The dual-channel drive assembly is connected to the crawler travel mechanism and the travel controller respectively. The travel controller is used to obtain a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the tobacco harvester travel control system is locked. When the locking digital signal is greater than the preset value, the expected steering angular velocity signal and the expected speed signal are obtained, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal. The control signal includes a left crawler control signal and a right crawler control signal. The dual-channel drive assembly is used to control the crawler travel mechanism according to the control signal.

[0072] The dual-path drive assembly specifically includes: a left-path drive assembly and a right-path drive assembly. The left-path drive assembly is connected to the travel controller and the left crawler track in the crawler-type travel mechanism respectively. The right-path drive assembly is connected to the travel controller and the right crawler track in the crawler-type travel mechanism respectively. The left-path drive assembly includes: a left motor driver and a left drive motor. The left motor driver is connected to the travel controller and the left drive motor respectively. The left drive motor is connected to the left crawler track in the crawler-type travel mechanism. The right-path drive assembly includes: a right motor driver and a right drive motor. The right motor driver is connected to the travel controller and the right drive motor respectively. The right drive motor is connected to the right crawler track in the crawler-type travel mechanism.

[0073] The tobacco harvester travel control system also includes: a lithium battery and a voltage reduction module. The voltage reduction module is connected to the lithium battery and the travel controller respectively.

[0074] like Figure 2 The walking controller includes a microprocessor, a Hall rocker and a rotary potentiometer. The microprocessor is connected to the dual-channel drive assembly, the Hall rocker and the rotary potentiometer respectively. The microprocessor is used to obtain the Y-axis state signal of the Hall rocker as a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the walking control system of the tobacco harvester is locked. When the locking digital signal is greater than the preset value, the X-axis state signal of the Hall rocker is obtained as an expected steering angular velocity signal, the rotary potentiometer signal is obtained as an expected speed signal, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal.

[0075] The present invention mainly includes a lithium battery, a left drive motor, a right drive motor, a left motor driver, a right motor driver, a crawler assembly, a step-down module, an electromagnetic switch and a walking controller. The left drive motor and the right drive motor are connected to the crawler drive wheel through a reducer to drive the tobacco harvester to walk. The left motor driver and the right motor driver are respectively connected to the left and right motor control ends of the walking controller to receive instructions issued by the walking controller to realize functions such as precise speed regulation, starting, braking, and changing the rotation direction of the motor. The left motor driver is connected to the left drive motor, and the right motor driver is connected to the right drive motor. The motor driver is a device for controlling the operation of the motor. It receives signals from the walking controller and adjusts parameters such as the current, voltage and frequency of the motor to realize functions such as starting, braking, speed regulation and protection of the motor. The crawler assembly includes components such as a frame, a drive wheel, and a support wheel. The crawler assembly is a mechanical component used for the walking of the tobacco harvester. The frame mainly plays a bearing and supporting role, and is installed with components related to the crawler chassis, such as drive wheels, support wheels, guide wheels, tensioning mechanisms and other components. The driving wheel plays the role of driving the crawler. It is fixed on the reducer and transmits the torque of the motor to the crawler through the gear structure. The function of the supporting wheel is to support the weight of the tobacco harvester. The step-down module converts the lithium battery voltage into 12V to power the electromagnetic switch and the travel controller. The electromagnetic switch is used to control the on and off of the power supply of the left motor driver and the right motor driver.

[0076] Compared with the existing wheeled tobacco harvester which is mainly powered by a diesel engine, the steering system of the wheeled tobacco harvester is composed of a full hydraulic steering gear, a steering cylinder, a hydraulic valve group and a hydraulic pump. When steering, the steering wheel is manually moved to activate the full hydraulic steering gear, thereby controlling the extension and retraction of the steering cylinder, driving the wheel to deflect and complete the steering. The present invention adopts a crawler-type walking chassis, with two drive motors directly driving the crawlers on both sides, and the travel controller controls the rotation direction and speed of the drive motor to realize acceleration, deceleration, braking, differential steering and other functions.

[0077] like Figure 2As shown, the travel controller mainly includes an emergency stop button 1, a main power switch 2, a Hall rocker 3, a power display module 4, a horn button 5, a lighting button 6, a status indicator light 7 and a rotary potentiometer 8. The Hall rocker is used to lock and unlock the control system and control the steering of the harvester. The rotary potentiometer is used to control the travel direction and travel speed of the harvester. The emergency stop button is connected to the control end of the electromagnetic switch to control the on and off of the electromagnetic switch. The power display module is used to detect the power of the lithium battery. The main power switch is used to control the on and off of the power supply of the entire travel system. The lighting button is used to control the on and off of the lights. The horn button is used to control the on and off of the horn. The status indicator light is used to display the travel status of the harvester in real time; the microprocessor is a PIC18F258 series single-chip microcomputer. The microprocessor A0, A1, and A2 pins are connected to the rotary potentiometer, the Hall rocker Y axis, and the Hall rocker X axis respectively to read the control signal. The microprocessor pins 0 and 1 output the speed control signal to the left and right motor driver speed control ports to control the speed of the drive motor. The C0 and C1 pins are connected to the left and right motor driver rotation control ports to control the rotation direction of the drive motor. The main power supply line of the travel controller is divided into four routes after the main power switch. The first route is connected to the external step-down module to reduce the voltage to 12V and then divided into two routes. One route is connected to the electromagnetic switch control end through the emergency stop button to control the power on and off of the left and right drive motors. The other route is connected to the 12V to 5V step-down module to power the microprocessor, Hall rocker, rotary potentiometer, and status indicator light. The second route is connected to the power display module. The third and fourth routes are connected to the lights and horns through the lighting button and horn button respectively.

[0078] Based on the same inventive concept, the embodiment of the present application also provides a tobacco harvester walking control method, the tobacco harvester walking control method is applied to a tobacco harvester walking control system, such as Figure 3 , the tobacco leaf harvester walking control method includes:

[0079] Step 1: Use the straight-line control strategy to control the tobacco harvester to travel from the starting point of the current harvesting row to the end point of the current harvesting row. The starting points of all odd-numbered harvesting rows and the end points of all even-numbered harvesting rows in the tobacco field are collinear. The end points of all odd-numbered harvesting rows and the starting points of even-numbered harvesting rows in the tobacco field are collinear.

[0080] Step 2: Use the U-turn control strategy to control the tobacco harvester to travel from the end of the current harvesting row to the starting point of the next harvesting row, take the next harvesting row as the current harvesting row and return to step 1 until all harvesting rows in the tobacco field are traversed.

[0081] like Figure 4 and Figure 5 , the straight control strategy is:

[0082] Step 1-1: Get the Y-axis status signal of the Hall rocker as a lock signal.

[0083] Step 1-2: Convert the locking signal into a locking digital signal.

[0084] Step 1-3: When the locking digital signal is less than or equal to the preset value, the tobacco harvester travel control system is locked.

[0085] Step 1-4: When the locked digital signal is greater than a preset value, the X-axis state signal of the Hall rocker is obtained as a desired steering angular velocity signal, and the rotary potentiometer signal is obtained as a desired speed signal.

[0086] Step 1-5: Generate a control signal according to the desired steering angle velocity signal and the desired velocity signal. The control signal includes a left track control signal and a right track control signal.

[0087] Steps 1-5 include:

[0088] Step 1-5-1: Digitally process the desired steering angular velocity signal to obtain a desired steering angular velocity digital signal.

[0089] Step 1-5-2: Digitally process the desired speed signal to obtain the desired speed digital signal.

[0090] Step 1-5-3: Determine the left track speed and the right track speed based on the desired steering angle velocity digital signal and the desired speed digital signal.

[0091] Step 1-5-4: Determine the left drive motor voltage signal based on the left track speed.

[0092] Step 1-5-5: Determine the right drive motor voltage signal based on the right track speed.

[0093] Step 1-5-6: Generate a left track control signal at a preset frequency, based on the initial left track control signal and the step voltage value, until the left track control signal reaches the left drive motor voltage signal.

[0094] Step 1-5-7: Generate the right track control signal gradually and incrementally according to the initial right track control signal and the step voltage value at the preset frequency until the right track control signal reaches the right drive motor voltage signal.

[0095] The voltage signal of the left drive motor and the voltage signal of the right drive motor are:

[0096]

[0097] In the formula,

[0098] Among them, U L is the voltage signal of the left drive motor, U R is the voltage signal of the right drive motor, DL The left track speed when the straight-ahead control strategy is used, D R The right track speed when the straight-ahead control strategy is used, D V is the expected speed digital signal, B is the track gauge, D ω is the desired steering angular velocity digital signal, and Z is the Hall rocker mid-position offset correction coefficient.

[0099] like Figure 6 , U-turn control strategy, including:

[0100] Step 2-1: Determine the transition point C. The transition point C is on the axis of symmetry between the current harvesting row and the next harvesting row, and the distance from the transition point C to the parallel boundary of the tobacco field near the start and end line is half of the total length of the tobacco harvester. The parallel boundary near the start and end line is the boundary closest to the end point of the current harvesting row among the two boundaries of the tobacco field parallel to the current start and end line. The current start and end line is the straight line where the end point of the current harvesting row and the start point of the next harvesting row are located.

[0101] Step 2-2: Use the steering strategy track speed formula to determine the left track speed and the right track speed of the tobacco harvester when it travels from the end point B of the current harvesting row to the transition point C.

[0102] Step 2-3: Based on the left crawler speed and the right crawler speed, control the tobacco harvester to move from the end point B of the current harvesting row to the transition point C.

[0103] Step 2-4: Use the rotation angle formula to determine the rotation angle of the transition point.

[0104] Step 2-5: Control the tobacco harvester to rotate in situ at transition point C by a transition point rotation angle.

[0105] Step 2-6: Use the steering strategy track speed formula to determine the left track speed and the right track speed of the tobacco harvester when it travels from the transition point C to the starting point D of the next harvesting row.

[0106] Step 2-7: Based on the left crawler speed and the right crawler speed, control the tobacco harvester to travel from the transition point C to the starting point D of the next harvesting row.

[0107] The steering strategy is:

[0108] Among them, V L is the left track speed during the steering strategy, V R is the right crawler speed during the steering strategy, B is the crawler gauge, h is the tobacco row spacing, L1 is the field width, and the field width is the distance between the parallel boundary near the start and end line and the current start and end line. C is the total length of the tobacco harvester, V C is the center speed of the machine.

[0109] The rotation angle formula is:

[0110] Where θ is the rotation angle of the transition point.

[0111] The present invention uses a microprocessor to read the desired steering angular velocity signal and the desired speed signal generated by the Hall rocker and the rotary potentiometer, and uses the above signals to calculate the speed of the tracks on both sides, and finally sends the drive motor control signal to the left motor driver and the right motor driver. The control signal only contains the speed and rotation direction control signals of the drive motors on both sides. The control process is as follows:

[0112] Step 1: Read the control signal. Hall rocker Y-axis signal U Y The X-axis signal U is used to enable the control system to lock and unlock. ω The desired steering angular velocity signal is used to control the left and right turn of the tobacco harvester. Rotary potentiometer signal U V The desired speed signal is used to control the speed of the tobacco harvester. The microprocessor reads the analog signal and converts it into a corresponding digital signal D Y , D ω and D V , the calculation formula is as follows.

[0113]

[0114] Step 2: System unlocking and locking. The microprocessor unlocks or locks the tobacco harvester travel control system according to the Y-axis signal of the Hall rocker. Y The voltage range is 0-5V, and the digital signal D obtained by digital-to-analog conversion Y The range is 0-255. Manually push the Hall rocker upward to make D Y The system is unlocked when the value of is greater than 200. Manually push the Hall rocker downward to make D Y The system is locked when the value is less than 45. When the control system is in unlocked state, go to step 3, otherwise the system does not respond.

[0115] Step 3: Calculate the speed of the left and right tracks. During the process of traveling, the microprocessor calculates the speed V of the left track according to the expected steering angular velocity signal of the Hall rocker and the expected speed signal of the rotary potentiometer. L and right track speed V R The kinematic model of the tracked chassis is as follows: Figure 5 As shown, O is the turning center, R is the turning radius, B is the track gauge, V C is the center speed of the machine, V L 、V R are the speeds of the left and right tracks respectively, ω is the steering angular velocity of the tobacco harvester, and the calculation formulas for the left and right track speeds are as follows.

[0116]

[0117] Among them, when the tobacco harvester moves forward, V C When positive, V C is negative, ω is positive when turning left, and negative when turning right. From formula (2), we get:

[0118]

[0119] Among them, D L , D R are the left and right track speed values ​​calculated by the microprocessor respectively, and Z is the correction coefficient of the rocker mid-position offset.

[0120] Step 4: Control command output. The microprocessor sends commands to the left and right motor drivers according to the left and right track speed values ​​calculated in step 3. L , D R The positive or negative value of determines the rotation direction of the left and right motors. When the value is positive, the microprocessor sends a high level to the motor driver, and the motor rotates forward. When the value is negative, the microprocessor sends a low level to the motor driver, and the motor reverses. The motor speed is related to the input voltage of the motor driver speed control terminal. The microprocessor L With D R The value is converted into the corresponding voltage signal U L with U R To realize the control of motor speed, the conversion formula is as follows.

[0121]

[0122] The harvester needs to start smoothly to avoid excessive starting current and damage to mechanical parts. Therefore, the microprocessor needs to send the speed control voltage signal to the motor driver control end in a step-by-step manner, and limit the change rate of the control voltage with the step voltage value to ensure the smooth start of the tobacco harvester. The implementation method is as follows.

[0123] U Lout =U Lt +U S (5)

[0124] U Rout =U Rt +U S (6)

[0125] Among them, U Lout is the speed control signal currently sent by the microprocessor to the left motor driver, U Rout is the speed control signal currently sent by the microprocessor to the right motor driver, U LtIt is the speed control signal sent by the microprocessor to the left motor driver last time, and its initial value is 0. Rt It is the speed control signal sent by the microprocessor to the right motor driver last time, and its initial value is 0. s is the step voltage value.

[0126] When the left crawler speed control signal output by the microprocessor satisfies U L >U Lt +U s When the microprocessor uses formula (5) to superimpose the speed control signal at frequency f, the U calculated each time is Lout The values ​​are sent to the left motor driver until U Lout =U L At this time, the microprocessor continues to send control signal U to the left motor driver L . When U L ≤U Lt +U s When U Lout =U L The control signal is the actual voltage value. The speed of the driving motor is related to the control voltage input to the speed control terminal of the motor driver. The speed increases with the increase of the input voltage. When the voltage reaches 5V, the motor speed is the highest. Successive superposition: The microprocessor repeatedly calculates at a frequency of f, calculates once plus the step length, outputs a control signal, and repeats this step to achieve the purpose of gradually increasing the speed control signal. U Lout It is the speed control signal currently sent by the microprocessor to the left motor driver.

[0127] When the right crawler speed control signal output by the microprocessor satisfies U R >U Rt +U s When the microprocessor uses formula (6) to superimpose the speed control signal at frequency f, the U calculated each time is Rout The values ​​are sent to the right motor driver until U Rout =U R At this time, the microcontroller continues to send control signal U to the right motor driver. R . When U R ≤U Rt +U s When U Rout =U R .U Rout It is the speed control voltage signal currently sent by the microprocessor to the right motor driver.

[0128] During operation, in order to avoid crushing the tobacco plants, it is necessary to harvest the field headland area with a width of L1 in advance to provide turning space for the tobacco leaf harvester. The chassis of the tobacco leaf harvester crosses the tobacco ridges and picks in a path parallel to the tobacco ridges until it reaches the field headland on the other side of the field to complete picking of the current row, and then enters the adjacent tobacco ridge after turning at the field headland. Repeat the above operation until the tobacco harvesting work of the entire tobacco field is completed. Repeating the above operation means that the chassis repeatedly crosses the tobacco ridges and picks in a path parallel to the tobacco ridges until it reaches the field headland on the other side of the field to complete picking of the current row, and then enters the adjacent tobacco ridge after turning at the field headland. Figure 6 shown.

[0129] During field operations, the turning speed of the tobacco harvester directly affects the harvesting efficiency. In order to solve the problems of the existing tobacco harvester with large turning radius and large required headland space, the present invention provides a headland turning method based on the flexible steering characteristics of the crawler chassis to shorten the turning radius and reduce the required headland space. Figure 6 As shown, point B is the end point of the harvesting row, and point D is the starting point of the adjacent pre-harvesting row. The tobacco harvester moves to point B to complete the harvesting of this row, and starts to perform turning and changing rows. It turns to point C with a turning radius R, then turns at an angle θ on the spot, and then turns to point D with a turning radius R, and then continues to work in a straight line along the pre-harvesting row. The specific implementation steps are as follows.

[0130] Step 1: Turn from point B to point C. Point B is the end point of the tobacco harvesting row and is located at the end point of the harvesting row. Point C is located on the center line a between the current harvesting row and the pre-harvesting row. At the same time, to ensure that the tobacco harvester is not affected by the field boundary during the on-site turning process, the vertical distance between point C and the short side of the field should be greater than half the length of the machine body. In order to smoothly turn to the above point, the turning radius R of the harvester needs to be determined, which is given by Figure 6 The calculation formula is as follows.

[0131]

[0132] Where L C is the total length of the tobacco harvester, h is the distance between tobacco rows, and L1 is the width of the field.

[0133] The microprocessor first determines the radius at which the tobacco harvester must turn to get from point B to point C by setting relevant parameters, and then calculates the speed values ​​of the tracks on both sides based on the turning radius R. Finally, the microprocessor sends speed and rotation direction control signals to the drivers on both sides to make the tobacco harvester turn within the radius R.

[0134] In order to realize the above-mentioned steering mode, it is necessary to determine the crawler speeds on both sides of the tobacco harvester. Figure 2 The calculation formula for the track speed on both sides is as follows.

[0135]

[0136] Step 2: Turn in place at point C. The tobacco harvester turns in place at point C through an angle θ to achieve a quick U-turn of the tobacco harvester. The calculation formula for the rotation angle θ is as follows:

[0137]

[0138] Step 3 turns from point C to point D. Point D is the starting point of the adjacent pre-harvest line and is located at the end point of the adjacent pre-harvest line. The harvester travels an arc distance CD with a turning radius R from point C, enters the pre-harvest line after reaching point D, and completes the turning and changing line operation. Step 3 is symmetrical with the walking trajectory of step 1 about straight line a.

[0139] The microprocessor first determines the angle θ that the tobacco harvester needs to rotate in place by setting relevant parameters, then calculates the speed values ​​of the crawlers on both sides based on the θ value, and finally sends speed and rotation direction control signals to the drivers on both sides to make the tobacco harvester rotate θ degrees.

[0140] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0141] Specific examples are used herein to illustrate the principles and implementation methods of the present application. The description of the above embodiments is only used to help understand the method and core ideas of the present application. At the same time, for those of ordinary skill in the art, according to the ideas of the present application, there will be changes in the specific implementation methods and application scopes. In summary, the content of this specification should not be understood as limiting the present application.

Claims

1. A tobacco harvester travel control system, It is characterized in that The tobacco leaf harvester travel control system is applied to a tobacco leaf harvester provided with a crawler-type travel mechanism; The crawler-type walking mechanism is a double crawler structure; The tobacco harvester travel control system comprises: a travel controller and a dual-path drive assembly; The dual-path driving assembly is respectively connected to the crawler-type walking mechanism and the walking controller; The walking controller is used to obtain a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the walking control system of the tobacco harvester is locked; when the locking digital signal is greater than a preset value, an expected steering angular velocity signal and an expected speed signal are obtained, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal; the control signal includes a left crawler control signal and a right crawler control signal; The dual-path driving assembly is used to control the crawler-type walking mechanism according to the control signal.

2. The tobacco harvester travel control system according to claim 1, It is characterized in that The dual-path drive assembly specifically includes: a left-path drive assembly and a right-path drive assembly; The left-side driving assembly is respectively connected to the travel controller and the left crawler track of the crawler-type travel mechanism; the right-side driving assembly is respectively connected to the travel controller and the right crawler track of the crawler-type travel mechanism; The left-side driving assembly comprises: a left motor driver and a left driving motor; The left motor driver is connected to the walking controller and the left driving motor respectively; The left drive motor is connected to the left crawler track of the crawler-type walking mechanism; The right-side driving assembly comprises: a right motor driver and a right driving motor; The right motor driver is connected to the walking controller and the right driving motor respectively; The right drive motor is connected to the right crawler track in the crawler type walking mechanism.

3. The tobacco harvester travel control system according to claim 1, It is characterized in that The tobacco harvester travel control system also includes: a lithium battery and a voltage reduction module; The voltage reduction module is connected to the lithium battery and the walking controller respectively.

4. The tobacco harvester travel control system according to claim 1, It is characterized in that The walking controller includes a microprocessor, a Hall rocker and a rotary potentiometer; The microprocessor is respectively connected to the dual-channel drive component, the Hall rocker and the rotary potentiometer; The microprocessor is used to obtain the Y-axis status signal of the Hall rocker as a locking signal and convert the locking signal into a locking digital signal. When the locking digital signal is less than or equal to a preset value, the tobacco harvester travel control system is locked; when the locking digital signal is greater than the preset value, the X-axis status signal of the Hall rocker is obtained as an expected steering angular velocity signal, the rotary potentiometer signal is obtained as an expected speed signal, and a control signal is generated according to the expected steering angular velocity signal and the expected speed signal.

5. A walking control method for a tobacco harvester, It is characterized in that The tobacco harvester walking control method is applied to the tobacco harvester walking control system according to any one of claims 1 to 4, and the tobacco harvester walking control method comprises: The straight-line control strategy is used to control the tobacco leaf harvester to travel from the starting point of the current harvesting row to the end point of the current harvesting row; the starting points of all odd-numbered harvesting rows and the end points of all even-numbered harvesting rows in the tobacco field are collinear; the end points of all odd-numbered harvesting rows and the starting points of even-numbered harvesting rows in the tobacco field are collinear; The U-turn control strategy is used to control the tobacco leaf harvester to travel from the end point of the current harvesting row to the starting point of the next harvesting row, and the next harvesting row is used as the current harvesting row and returns to the step "using the straight control strategy to control the tobacco leaf harvester to travel from the starting point of the current harvesting row to the end point of the current harvesting row" until all the harvesting rows in the tobacco field are traversed.

6. The tobacco harvester travel control method according to claim 5, It is characterized in that The straight-ahead control strategy is: Get the Y-axis status signal of the Hall rocker as a locking signal; Converting the locking signal into a locking digital signal; When the locking digital signal is less than or equal to a preset value, locking the tobacco harvester travel control system; When the locking digital signal is greater than a preset value, the X-axis state signal of the Hall rocker is obtained as a desired steering angular velocity signal, and the rotary potentiometer signal is obtained as a desired speed signal; A control signal is generated according to the expected steering angle velocity signal and the expected velocity signal; the control signal includes a left track control signal and a right track control signal.

7. The tobacco harvester travel control method according to claim 6, It is characterized in that Generating a control signal according to the desired steering angle velocity signal and the desired velocity signal comprises: Digitally processing the desired steering angular velocity signal to obtain a desired steering angular velocity digital signal; Digitally processing the desired speed signal to obtain a desired speed digital signal; Determine the left track speed and the right track speed according to the desired steering angle velocity digital signal and the desired speed digital signal; determining a voltage signal of a left drive motor according to a speed of the left crawler track; Determine the voltage signal of the right drive motor according to the speed of the right crawler track; At a preset frequency, the left crawler track control signal is gradually increased according to the initial left crawler track control signal and the step voltage value until the left crawler track control signal reaches the left drive motor voltage signal; According to the preset frequency, the right crawler track control signal is gradually generated according to the initial right crawler track control signal and the step voltage value until the right crawler track control signal reaches the right drive motor voltage signal.

8. The tobacco harvester travel control method according to claim 7, It is characterized in that The left drive motor voltage signal and the right drive motor voltage signal are: In the formula, Among them, U L is the voltage signal of the left drive motor, U R is the voltage signal of the right drive motor, D L The left track speed when the straight-ahead control strategy is used, D R The right track speed when the straight-ahead control strategy is used, D V is the expected speed digital signal, B is the track gauge, D ω is the desired steering angular velocity digital signal, and Z is the Hall rocker mid-position offset correction coefficient.

9. The tobacco harvester travel control method according to claim 7, It is characterized in that The U-turn control strategy includes: Determine the transition point C; the transition point C is on the symmetry axis between the current harvesting row and the next harvesting row, and the distance from the transition point C to the parallel boundary of the tobacco field near the start and end lines is half of the total length of the tobacco leaf harvester; the parallel boundary near the start and end lines is the boundary closest to the end point of the current harvesting row among the two boundaries of the tobacco field parallel to the current start and end lines; the current start and end lines are the straight lines where the end point of the current harvesting row and the starting point of the next harvesting row are located; Using the steering strategy crawler speed formula, determine the left crawler speed and the right crawler speed of the tobacco harvester when it travels from the end point B of the current harvesting row to the transition point C; Based on the left crawler speed and the right crawler speed, the tobacco leaf harvester is controlled to travel from the end point B of the current harvesting row to the transition point C; Use the rotation angle formula to determine the transition point rotation angle; Control the tobacco leaf harvester to rotate in situ at transition point C to achieve a transition point rotation angle; Using the steering strategy crawler speed formula, determine the left crawler speed and the right crawler speed of the tobacco harvester when it travels from the transition point C to the starting point D of the next harvesting row; Based on the left crawler speed and the right crawler speed, the tobacco harvester is controlled to travel from the transition point C to the starting point D of the next harvesting row.

10. The tobacco harvester travel control method according to claim 9, It is characterized in that The steering strategy is: Among them, V L is the left track speed during the steering strategy, V R is the right track speed during the steering strategy, B is the track gauge, h is the tobacco row spacing, L is 1 The width of the headland is the distance between the parallel boundary of the nearest start and end line and the current start and end line; L C is the total length of the tobacco harvester, V C is the center point speed of the machine; The rotation angle formula is: Where θ is the rotation angle of the transition point.