Electric suspension device for operation machine tool and nonlinear control method
Through electric suspension devices and nonlinear control methods, the problems of low control accuracy and energy efficiency of traditional hydraulic suspension devices are solved, and the precise adjustment and efficient lifting of the working equipment are achieved, and the intelligent and energy-saving performance of agricultural machinery is improved.
Patent Information
- Application Number
- CN202411203490.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-29
AI Technical Summary
The traditional agricultural machinery suspension device is driven by hydraulic mechanisms, with low control accuracy, and cannot accurately adjust the height of the working equipment, and the energy efficiency is not high.
An electric suspension device is designed, using electric push rods and linear sensors to achieve accurate lifting and lowering of the working equipment, combined with an angle detection mechanism, precise control is performed through the control unit, and a nonlinear control method is used to synchronize the movement of the electric push rod.
It realizes precise adjustment of the height of the working equipment, improves control accuracy and energy efficiency, avoids collision with the ridge, improves operating efficiency, and makes contributions to the electrification and intelligence of tractors.
Smart Images

Figure CN118923254A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of agricultural machinery, and in particular to an electric suspension device for an operating tool and a nonlinear control method. Background Art
[0002] The suspension device is the component that connects the tractor to the working machine, and its structure directly affects the working efficiency of the tractor. The suspension device used in traditional agricultural machinery is driven by a hydraulic mechanism. The above driving method requires the engine to provide power to the hydraulic mechanism to operate, and the control accuracy is not high. It is impossible to accurately adjust the height of the working machine, and the energy efficiency is not high. Summary of the invention
[0003] The purpose of the present invention is to overcome the above-mentioned problems and provide an electric suspension device for a working machine. The electric suspension device adopts an electric drive mode, which can accurately adjust the height of the working machine, has higher control accuracy and higher energy efficiency.
[0004] Another object of the present invention is to provide a nonlinear control method.
[0005] The purpose of the present invention is achieved through the following technical solutions:
[0006] An electric suspension device for an operating tool comprises a base, a suspension frame, a control unit, a parallel linkage mechanism arranged between the base and the suspension frame, a connecting piece arranged on the parallel linkage mechanism, two electric push rods arranged between the base and the connecting piece, a linear sensor for measuring the telescopic length of each of the electric push rods, and an angle detection mechanism for measuring the swing angle of the parallel linkage mechanism; wherein one end of the parallel linkage mechanism is hinged to the base, and the other end of the parallel linkage mechanism is hinged to the suspension frame; one end of the electric push rod is connected to the base, and the other end of the electric push rod is connected to the connecting piece; the base is fixedly connected to a new energy electric tractor, and the suspension frame is connected to the operating tool; the electric push rod, the linear sensor and the angle detection mechanism are all electrically connected to the control unit.
[0007] The working principle of the above electric suspension device is:
[0008] When working, the two electric push rods realize precise synchronous telescopic movement through the linear sensor, thereby driving the parallel linkage mechanism to swing, thereby driving the lifting and lowering of the suspension frame, and the suspension frame is connected to the work tool, thereby realizing the lifting and lowering of the work tool; the angle detection mechanism can accurately detect the swing angle of the parallel linkage mechanism, thereby detecting the height of the current work tool; the control unit can control the extension and retraction of the electric push rod according to the information feedback from the linear sensor and the angle detection mechanism, lower the work tool to a specific angle during operation, and lift the work tool when turning in the field to avoid collision between the work tool and the field ridge, which is conducive to the intelligentization of paddy field operation.
[0009] In a preferred embodiment of the present invention, the linear sensor is a pull-wire displacement linear sensor, and two pull-wire displacement linear sensors are arranged in one-to-one correspondence with two electric push rods; the pull-wire displacement linear sensor is fixed on the electric push rod, and the rope head measurement end of the pull-wire displacement linear sensor is connected to the telescopic end of the electric push rod. By arranging two pull-wire displacement linear sensors, the two electric push rods can be detected respectively, and the telescopic length of the electric push rod can be measured in real time.
[0010] Furthermore, the measurement range of the pull-wire displacement linear sensor is 0-1000mm, the waterproof level is IP68 waterproof and dustproof level, and the pull-wire displacement linear sensor communicates with the control unit by using the CANopen communication protocol. A threshold is set for the detection length interval, and the pull-wire displacement linear sensor is used to determine whether the two electric push rods act synchronously within the set working interval. If yes, the electric push rods act according to the originally set task; if not, the electric push rods act according to the synchronization algorithm.
[0011] Preferably, the parallel linkage mechanism includes two groups of parallel linkage assemblies, each group of parallel linkage assemblies includes two connecting rods that are parallel to each other and are arranged vertically and horizontally, one end of the connecting rod is hinged to the base, and the other end of the connecting rod is hinged to the suspension frame; the connecting member is arranged on the connecting rod. In the above structure, the parallel linkage mechanism, the base and the suspension frame constitute a parallel four-bar linkage mechanism, and the connecting member is used to optimize the load-bearing capacity of the electric push rod. The electric push rod is hinged to the connecting member, so that the movement of the electric push rod can drive the movement of the connecting member. Since the connecting member is located between the base and the suspension frame, when the connecting member moves, the suspension frame also moves, driving the movement of the working machine.
[0012] Furthermore, the position of the connecting part is selected through multiple tests. The connecting part can optimize the load force distribution of the entire electric suspension device, so that the electric push rod can reach the maximum load-bearing capacity within the tolerable rated range. The final test determined that when the distance between the connecting part and the base is 300mm, the load-bearing performance of the electric push rod is optimal, and the stability of the structure is in the best state, which effectively avoids dangerous accidents such as deformation of structural parts or jamming of the electric push rod under heavy loads.
[0013] Preferably, the angle detection mechanism includes an angle sensor disposed on the base and a transmission assembly disposed between the angle sensor and the connecting rod, wherein the angle sensor is connected to the control unit; the transmission assembly includes a first rotating rod and a second rotating rod, wherein one end of the first rotating rod is fixedly connected to the axis of the angle sensor; the other end of the first rotating rod is connected to one end of the second rotating rod, and the other end of the second rotating rod is connected to the connecting rod. By setting the above mechanism, as the connecting rod moves, the second rotating rod will be driven to move, and then the first rotating rod will be driven to rotate, so that the axis of the angle sensor rotates, thereby detecting the movement of the parallel linkage mechanism, and then calculating the current angle of the parallel linkage mechanism.
[0014] Furthermore, the input voltage of the angle sensor is 5V, the output voltage Hall value is 0-5V, and the angle detection range of the angle sensor is 360°. A threshold is set for the detection angle, and the angle sensor is used to determine whether the parallel linkage mechanism is moving within the set working range. If yes, the electric push rod does not move, and if not, the electric push rod moves according to the movement signal.
[0015] A nonlinear control method is applied to the electric suspension device, and the nonlinear control method comprises the following steps:
[0016] (1) Before the electric suspension device starts operating for the first time, it is necessary to calibrate the two electric push rods and the two linear sensors, and the control unit stores the calibration values obtained by the calibration operation in the internal storage space;
[0017] (2) The electric suspension device starts to operate normally:
[0018] (2.1) The control unit reads the calibration value of the internal storage space; the control unit pushes the electric push rod to the reference position determined during calibration according to the calibration value, and checks the output value of the linear sensor;
[0019] (2.2) Detecting the real-time position of the electric push rod, reading the output values of the two linear sensors through the control unit, and detecting whether there is a position deviation between the two electric push rods;
[0020] (2.3) If there is a position deviation between the two electric push rods, the direction operation strategy of each electric push rod is determined according to the positive and negative values of the position error;
[0021] (2.4) According to the direction operation strategy, the dual electric push rod synchronization algorithm is used to determine the specific speeds of the two electric push rods;
[0022] (2.5) Check whether the two electric actuators are in a synchronized state after adjustment using the dual electric actuator synchronization algorithm.
[0023] Preferably, in step (1), the specific process of the calibration operation is as follows: a reference position needs to be determined as the initial synchronization state of the two electric push rods; the reference position is a fixed position value; after the electric push rods are pushed to the reference position, the two linear sensors are calibrated, and the output values of the two linear sensors are the calibration values, and the control unit stores the calibration values as the reference values of the linear sensors. The purpose is to ensure that the two electric push rods maintain a synchronization state at the initial position, which serves as the reference value of the linear sensor, so as to ensure the stability and accuracy of the output values of the linear sensor later.
[0024] Preferably, in step (1), the position where the telescopic length of the electric push rod is the shortest is taken as the reference position, in order to facilitate rapid calibration and make the reference more accurate.
[0025] Preferably, in step (2.1), the specific steps of checking the output value of the linear sensor are: checking whether the output value of the linear sensor is correct; if correct, entering the initialization success state; if wrong, entering the initialization failure state.
[0026] Preferably, in step (2.3), the specific steps of determining the directional operation strategy of each electric push rod according to the positive and negative values of the position error are: if the position of the left electric push rod is ahead of the position of the right electric push rod, the extension and retraction speed of the left electric push rod is slowed down, and the extension and retraction speed of the right electric push rod is accelerated; if the position of the right electric push rod is ahead of the position of the left electric push rod, the extension and retraction speed of the right electric push rod is slowed down, and the extension and retraction speed of the left electric push rod is accelerated.
[0027] Preferably, in step (2.5), the specific steps of checking whether the two electric push rods adjusted using the dual electric push rod synchronization algorithm are in a synchronized state are: by reading the output values of the two linear sensors, if the two output values indicate that the two electric push rods are in a synchronized state, repeat step (2.2); if the two output values indicate that the two electric push rods are in an unsynchronized state, repeat step (2.4); if an unsynchronized state still occurs after more than three checks, it is judged that the electric suspension device is faulty and enters a faulty state, and the staff is notified to pay attention to the status of the two electric push rods and perform maintenance.
[0028] Compared with the prior art, the present invention has the following beneficial effects:
[0029] 1. The electric suspension device of the present invention is driven by an electric push rod. The power source is electricity. It can be directly driven by electric energy to reduce energy loss. Compared with the hydraulic mechanism of a traditional tractor, it has higher energy efficiency. The energy conversion efficiency of the electric drive system can reach more than 80%, while the efficiency of the hydraulic system is relatively low, usually around 60%.
[0030] 2. The electric suspension device of the present invention has a simple structure and does not require complicated hydraulic components such as pipelines and valves in the hydraulic mechanism; the electric suspension device of the present invention has excellent control performance and fast control response speed, and can achieve more precise speed and torque control.
[0031] 3. The electric suspension device of the present invention adopts two electric push rods to provide multiple parallel and far-apart force fulcrums, which is conducive to the smooth lifting and lowering of the working machine.
[0032] 4. The electric suspension device in the present invention realizes the precise synchronous telescopic movement of the two electric push rods by setting a linear sensor, thereby ensuring the synchronous operation of the two electric push rods and avoiding damage to the electric suspension device; and the angle detection mechanism can accurately detect the swing angle of the parallel linkage mechanism, thereby detecting the height of the current operating tool, and can accurately control the lifting or lowering height, and realize precise adjustment of the height of the operating tool with higher control accuracy; it realizes intelligent tool operation, makes the operating tool fit the ground, and improves operating efficiency.
[0033] 5. A nonlinear control method in the present invention overcomes the nonlinear characteristic problem of the electric push rod, so as to realize the precise motion control of the electric suspension device and the synchronous control of the multi-electric push rod structure.
[0034] 6. A nonlinear control method in the present invention can ensure that the movement of the electric push rod is adjusted quickly, stably and accurately; synchronous control can avoid structural pulling and damage, and ensure the stable operation of the electric suspension device with a multi-electric push rod structure; it has made contributions to the electrification, intelligence and energy saving of tractors. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 It is a schematic diagram of the three-dimensional structure of one specific embodiment of an electric suspension device for a working tool in the present invention.
[0036] Figure 2 It is a top view of the electric suspension device in the present invention.
[0037] Figure 3 It is a front view of the electric suspension device in the present invention.
[0038] Figure 4 for Figure 3 A partial enlarged view of point A in the middle.
[0039] Figure 5 This is a calibration workflow diagram of the nonlinear control method in the present invention.
[0040] Figure 6 This is a normal operation flow chart of the nonlinear control method in the present invention. DETAILED DESCRIPTION
[0041] In order to enable those skilled in the art to better understand the technical solution of the present invention, the present invention is further described below in conjunction with embodiments and drawings, but the embodiments of the present invention are not limited thereto.
[0042] Example 1
[0043] See also Figure 1-Figure 3 The present embodiment discloses an electric suspension device for an operating tool, comprising a base 1, a suspension frame 2, a control unit, a parallel linkage mechanism 3 arranged between the base 1 and the suspension frame 2, a connecting piece 4 arranged on the parallel linkage mechanism 3, two electric push rods 5 arranged between the base 1 and the connecting piece 4, a linear sensor 6 for measuring the telescopic length of each of the electric push rods 5, and an angle detection mechanism 7 for measuring the swing angle of the parallel linkage mechanism 3; wherein one end of the parallel linkage mechanism 3 is hinged to the base 1, and the other end of the parallel linkage mechanism 3 is hinged to the suspension frame 2; one end of the electric push rod 5 is connected to the base 1, and the other end of the electric push rod 5 is connected to the connecting piece 4; the base 1 is fixedly connected to a new energy electric tractor, and the suspension frame 2 is connected to the operating tool; the electric push rod 5, the linear sensor 6 and the angle detection mechanism 7 are all electrically connected to the control unit.
[0044] One end of the electric push rod 5 in this embodiment is connected to the base 1 through a pin shaft, and the other end is hinged to the connecting member 4.
[0045] See also Figure 1-Figure 3In this embodiment, the two electric push rods 5 are two electric push rods 5 of the same model, specification and electrical parameters, and are arranged in parallel with each other. The control unit is an ECU, which is arranged on a new energy electric tractor, and the working tool is a paddy field working tool, which can be one of a rice transplanter, a weeding wheel, and a fertilizer applicator.
[0046] See also Figure 1-Figure 3 The linear sensor 6 is a high-resolution pull-wire displacement linear sensor, and two pull-wire displacement linear sensors are arranged one by one with two electric push rods 5; the pull-wire displacement linear sensor is fixed on the electric push rod 5, and the rope head measuring end of the pull-wire displacement linear sensor is connected to the telescopic end of the electric push rod 5. By setting two pull-wire displacement linear sensors, the two electric push rods 5 can be detected respectively, and the telescopic length of the electric push rod 5 can be measured in real time.
[0047] See also Figure 1-Figure 3 The measurement range of the pull-wire displacement linear sensor is 0-1000mm, the waterproof level is IP68 waterproof and dustproof level, and the pull-wire displacement linear sensor communicates with the control unit by using the CANopen communication protocol. A threshold is set for the detection length interval, and the length interval is from the electric push rod 5 extending to the longest length to the electric push rod 5 shortening to the shortest length; when the electric push rod 5 is extended to the longest length or shortened to the shortest length, the output value (reading) corresponding to the pull-wire displacement linear sensor is the threshold; the pull-wire displacement linear sensor is used to determine whether the two electric push rods 5 act synchronously within the set working interval (length interval). If yes, the electric push rod 5 acts according to the originally set task; if not, the electric push rod 5 acts according to the synchronization algorithm.
[0048] See also Figure 1-Figure 3 The parallel linkage mechanism 3 includes two groups of parallel linkage assemblies, each group of parallel linkage assemblies includes two parallel linkages 3-1 arranged vertically and horizontally, one end of the linkage 3-1 is hinged to the base 1, and the other end of the linkage 3-1 is hinged to the suspension frame 2; the connecting member 4 is arranged on the linkage 3-1. In the above structure, the parallel linkage mechanism 3, the base 1 and the suspension frame 2 constitute a parallel four-bar linkage mechanism, and the connecting member 4 is used to optimize the load-bearing capacity of the electric push rod 5. The electric push rod 5 is hinged to the connecting member 4, so that the movement of the electric push rod 5 can drive the movement of the connecting member 4. Since the connecting member 4 is located between the base 1 and the suspension frame 2, when the connecting member 4 moves, the suspension frame 2 also moves, driving the movement of the working machine.
[0049] The connecting member 4 of this embodiment can be hinged on the connecting rod 3-1, or the connecting member 4 can be fixed on the connecting rod 3-1 at the upper end.
[0050] See also Figure 1-Figure 3 There are two bases 1, two sets of parallel connecting rod assemblies are arranged one by one with the two bases 1, and two electric push rods 5 are respectively connected with the two bases 1. There can also be one base 1, and two electric push rods 5 are respectively connected with the two sides of the base 1.
[0051] See also Figure 1-Figure 3 The position of the connecting member 4 is selected through multiple tests. The connecting member 4 can optimize the load force distribution of the entire electric suspension device, so that the electric push rod 5 can reach the maximum load-bearing capacity within the tolerable rated range. The final test determines that when the distance between the connecting member 4 and the base 1 is 300mm, the load-bearing performance of the electric push rod 5 reaches the best, and the stability of the structure reaches the best state, which effectively avoids the occurrence of dangerous accidents such as deformation of structural parts or jamming of the electric push rod 5 under heavy load.
[0052] See also Figure 1-Figure 4 The angle detection mechanism 7 includes an angle sensor 7-1 disposed on the base 1 and a transmission assembly disposed between the angle sensor 7-1 and the connecting rod 3-1, wherein the angle sensor 7-1 is connected to the control unit; the transmission assembly includes a first rotating rod 7-2 and a second rotating rod 7-3, wherein one end of the first rotating rod 7-2 is fixedly connected to the axis of the angle sensor 7-1; the other end of the first rotating rod 7-2 is connected to one end of the second rotating rod 7-3, and the other end of the second rotating rod 7-3 is connected to the connecting rod 3-1. By setting the above mechanism, as the connecting rod 3-1 moves, the second rotating rod 7-3 will be driven to move, and then the first rotating rod 7-2 will be driven to rotate, so that the axis of the angle sensor 7-1 rotates, thereby detecting the movement of the parallel linkage mechanism 3, and then calculating the current angle of the parallel linkage mechanism 3.
[0053] See also Figure 1-Figure 4 , the input voltage of the angle sensor 7-1 is 5V, the output voltage Hall value is 0~5V, and the corresponding angle detection range of the angle sensor 7-1 is 360°. A threshold is set for the detection angle. When the electric push rod 5 is extended to the longest or shortened to the shortest, the reading of the angle sensor 7-1 is the threshold; the threshold is only used as a limit to avoid damage to the working tool. The angle sensor 7-1 is used to determine whether the parallel linkage mechanism 3 is operating within the set working range. If yes, the electric push rod 5 does not operate. If not, the electric push rod 5 operates according to the movement signal.
[0054] See also Figure 1-Figure 4 , the working principle of the above electric suspension device is:
[0055] During operation, the two electric push rods 5 realize precise synchronous telescopic movement through the linear sensor 6, thereby driving the parallel linkage mechanism 3 to swing, thereby driving the lifting and lowering of the suspension frame 2, and the suspension frame 2 is connected with a working machine, thereby realizing the lifting and lowering of the working machine; the angle detection mechanism 7 can accurately detect the swing angle of the parallel linkage mechanism 3, thereby detecting the height of the current working machine; the control unit can control the extension and retraction of the electric push rod 5 according to the information feedback from the linear sensor 6 and the angle detection mechanism 7, lower the working machine to a specific angle during operation, and lift the working machine when turning in the field to avoid collision between the working machine and the field ridge, which is conducive to the intelligentization of paddy field operation.
[0056] Example 2
[0057] See also Figure 1 , the electric linear actuator 5 will show nonlinear characteristics, especially the electric linear actuator 5 with large load capacity, whose nonlinear characteristics are more prominent. The main reasons why the electric linear actuator 5 shows nonlinear characteristics are as follows:
[0058] 1. The electric push rod 5 is usually driven by a DC motor or a stepper motor, and these motors themselves have nonlinearity in torque-speed characteristics.
[0059] 2. There is also the geometric nonlinearity of the parallel four-bar linkage. The kinematic equation of the parallel four-bar linkage needs to be described with the help of nonlinear relationships such as trigonometric functions, which is one of the sources of the nonlinearity of the overall behavior.
[0060] 3. When the force / torque load applied externally to the parallel four-bar linkage changes, due to the geometric topological structure of the mechanism and the coupling relationship between the links 3-1, the internal force on each link 3-1 will show an obvious nonlinear change pattern.
[0061] In order to solve the above problems, this embodiment discloses a nonlinear control method to facilitate the precise motion control of the electric suspension device and the synchronous control of the multi-electric push rod 5 structure. It has good adaptability to the nonlinear characteristics of various types of electric push rods 5 such as brushed DC motors and stepper motors, effectively copes with different working conditions of the electric push rod 5 in different motion ranges, and overcomes the nonlinear characteristic problem of the electric push rod 5. It also has the advantages of strong anti-interference ability and low economic cost of algorithm deployment.
[0062] See also Figure 1 and Figure 5-Figure 6 , the nonlinear control method is applied to the electric suspension device, and the nonlinear control method includes the following steps:
[0063] (1) Before the electric suspension device starts to operate for the first time, it is necessary to calibrate the two electric push rods 5 (referred to as push rods) and the two linear sensors 6. Once calibrated once, no calibration is required in the normal operation thereafter. The control unit stores the calibration values obtained by the calibration operation in the internal storage space;
[0064] (2) The electric suspension device starts normal operation (in normal operation, no calibration operation is required):
[0065] (2.1) Initialization: At the beginning of initialization, the control unit reads the calibration value of the internal storage space; the control unit pushes the electric push rod 5 to the reference position determined during calibration according to the calibration value, and checks the output value of the linear sensor 6;
[0066] (2.2) Detect the real-time position of the electric push rod 5, read the output values of the two linear sensors 6 through the control unit, and detect whether the two electric push rods 5 have position deviation; specifically, the control unit reads the output value of the pull-wire displacement linear sensor in real time through the CANopen protocol, and performs data fusion of the pull-wire displacement linear sensor based on the characteristics of the pull-wire displacement linear sensor (such as resolution, range, etc.), while considering factors such as the installation error and nonlinear error of the pull-wire displacement linear sensor, and converts the collected digital position signal (output value) into the actual displacement of the electric push rod 5 to ensure the accuracy of the position calculation;
[0067] (2.3) If there is a position deviation between the two electric push rods 5, the direction operation strategy of each electric push rod 5 is determined according to the positive and negative values of the position error;
[0068] (2.4) According to the direction operation strategy, the dual electric push rod 5 synchronization algorithm is used to determine the specific speeds of the two electric push rods 5;
[0069] (2.5) Check whether the two electric push rods 5 are in a synchronous state after adjustment using the dual electric push rod 5 synchronization algorithm.
[0070] See also Figure 1 and Figure 5 In step (1), the specific process of the calibration operation is as follows: a reference position needs to be determined as the initial synchronization state of the two electric push rods 5; the reference position is a fixed position value; after the electric push rods 5 are pushed to the reference position, the two linear sensors 6 are calibrated, and the output values of the two linear sensors 6 are the calibration values at this time, and the control unit stores the calibration values as the reference values of the linear sensors 6. The purpose is to ensure that the two electric push rods 5 maintain a synchronization state when they are in the initial position, which serves as the reference value of the linear sensors 6, so as to ensure the stability and accuracy of the output values of the linear sensors 6 later.
[0071] See also Figure 1 and Figure 5 In step (1), the position where the telescopic length of the electric push rod 5 is the shortest is taken as the reference position. The purpose is to facilitate rapid calibration and make the reference more accurate.
[0072] See also Figure 1 and Figure 6 In step (2.1), the specific steps of checking the output value of the linear sensor 6 are: checking whether the output value of the linear sensor 6 is correct; if correct, entering the initialization success state; if wrong, entering the initialization failure state.
[0073] See also Figure 1 and Figure 6 In step (2.3), the specific steps of determining the directional operation strategy of each electric push rod 5 according to the positive and negative values of the position error are: if the position of the left electric push rod 5 is ahead of the position of the right electric push rod 5, the extension and retraction speed of the left electric push rod 5 is slowed down, and the extension and retraction speed of the right electric push rod 5 is accelerated; if the position of the right electric push rod 5 is ahead of the position of the left electric push rod 5, the extension and retraction speed of the right electric push rod 5 is slowed down, and the extension and retraction speed of the left electric push rod 5 is accelerated.
[0074] In step (2.3), the direction in which the push rod extends forward is set as the positive direction, and the direction in which the push rod retracts is set as the negative direction; if the error is a positive number, it means that the length of the left electric push rod 5 is greater than the length of the right electric push rod 5. At this time, the direction of the left electric push rod 5 is set to negative, and the direction of the right electric push rod 5 is set to positive, so that the two electric push rods 5 can be quickly synchronized, and the direction strategy is thus determined; if the error is a negative number, it means that the length of the right electric push rod 5 is greater than the length of the left electric push rod 5. At this time, the direction of the right electric push rod 5 is set to negative, and the direction of the left electric push rod 5 is set to positive, so that the two electric push rods 5 can be quickly synchronized, and the direction strategy is thus determined.
[0075] See also Figure 1 and Figure 6 In step (2.5), the specific steps of checking whether the two electric push rods 5 adjusted by the dual electric push rod 5 synchronization algorithm are in a synchronous state are as follows: by reading the output values of the two linear sensors 6, if the two output values indicate that the two electric push rods 5 are in a synchronous state, repeat step (2.2); if the two output values indicate that the two electric push rods 5 are in an asynchronous state, repeat step (2.4); if the asynchronous state still occurs after more than three checks, it is determined that the electric suspension device is faulty and enters a faulty state, and the staff is notified to pay attention to the status of the two electric push rods 5 and perform maintenance.
[0076] See also Figure 1 and Figure 6 In step (2.4), since the movement characteristics of the electric push rod 5 are different in different movement ranges, the system exhibits nonlinear characteristics. Therefore, it is necessary to adopt a dual electric push rod 5 synchronization algorithm to control the pushing speed of the push rod. The dual electric push rod 5 synchronization algorithm is an adaptive algorithm. The dual electric push rod 5 synchronization algorithm of this embodiment adopts a control that integrates a neural network and a nonlinear mathematical model of the electric push rod 5, which effectively adapts to the nonlinear characteristics of the system and improves the control accuracy, thereby making the synchronization process more stable and rapid.
[0077] See also Figure 1 and Figure 6 In the actual control system application of the electric push rod 5, directly using a neural network for end-to-end modeling and control has problems such as high computational complexity and strong data dependence. Therefore, this embodiment adopts an adaptive decision control method based on the fusion of a neural network and a nonlinear mathematical model of the electric push rod 5. The nonlinear mathematical model can provide system state prediction, while the neural network controller can compensate for model errors and enhance the overall control performance. This fusion method gives full play to the advantages of the two technologies and has significant improvements in accuracy, robustness, and computational efficiency.
[0078] See also Figure 1 and Figure 6 The steps of the adaptive decision-making method for solving nonlinear problems by integrating neural network with the nonlinear mathematical model of electric linear actuator 5 are as follows:
[0079] Step 1: Establish a nonlinear mathematical model of the electric push rod 5. Model and analyze each part of the electric push rod 5 system, including the motor, reducer, electric push rod 5 and other subsystems. The motor model includes voltage equations and torque equations, as well as nonlinear relationships such as back electromotive force. The reducer model includes parameters such as gear ratio and efficiency. The electric push rod 5 model needs to establish a rigid body dynamics model of the electric push rod 5, including parameters such as the mass and length of the electric push rod 5. The nonlinear sub-models of the motor, reducer and electric push rod 5 are coupled and integrated to form a complete nonlinear mathematical model of the electric push rod 5.
[0080] Step 2: Design a neural network controller. According to the dynamic characteristics of the electric push rod 5 system, select the appropriate neural network topology, including feedforward network, recurrent neural network, etc. Determine the input and output variables of the network, such as position, velocity, acceleration, etc. Determine the network weights, the number of hidden layers, the number of nodes, and the bias parameters to enable it to have the ability of nonlinear approximation and adaptive adjustment. Design a suitable loss function based on the control goal of minimizing the position tracking error.
[0081] Step 3: Train the neural network controller. Using the aforementioned nonlinear model of the electric push rod 5, a large number of simulation training data sets are generated. The data sets include input and output data under various working conditions, covering the entire operating range of the system, and the training data are normalized to improve the generalization ability of the neural network. The back propagation algorithm and other efficient optimization methods are used as a multi-layer neural network learning algorithm with highly nonlinear mapping capabilities to iteratively train the weights and biases of the neural network. According to the training effect, the network structure, hyperparameters, etc. are appropriately adjusted to improve the training convergence speed and control performance. In addition, technologies such as transfer learning can be used to further optimize the existing pre-trained models.
[0082] Step 4: Implement control that integrates the neural network with the nonlinear mathematical model of the electric linear actuator 5. Integrate the trained neural network controller and the nonlinear mathematical model into the actual electric linear actuator 5 control system, and use a high-performance microcontroller or embedded processor to complete the real-time calculation task of the neural network. The nonlinear model provides a prediction of the system state, while the neural network controller is used to compensate for the model error. The adaptive mechanism is used to monitor the modeling error and control performance during the operation of the system, and the weight ratio of the two is dynamically adjusted, which can flexibly balance the model accuracy and network generalization performance.
[0083] Step 5: Performance verification and optimization. Through simulation or actual experiments, verify the performance of the neural network control method in terms of suppressing nonlinearity, tracking accuracy, robustness, etc. Analyze the control effect and optimize the structure and training method of the neural network if necessary to further improve the control performance. Evaluate the computational complexity of the neural network controller to ensure that it can meet the requirements of real-time control.
[0084] The neural network is integrated with the nonlinear mathematical model of the electric linear actuator 5 to form a hybrid control architecture. The nonlinear model can provide system state prediction, while the neural network controller can compensate for the model error, which has significant improvements in accuracy, robustness, and computational efficiency. The nonlinear mathematical model of the electric linear actuator 5 can generate a large amount of simulation data, which can be used for the training and optimization of the neural network to improve the generalization ability and convergence speed of the network. By utilizing the nonlinear fitting ability of the neural network, some relationships in the nonlinear model that are difficult to establish analytical formulas can be modeled; and the use of nonlinear models for system analysis and simulation can provide guidance for the structural selection and parameter optimization of the neural network controller.
[0085] The nonlinear control based on the fusion of neural network and nonlinear mathematical model of electric push rod 5 can ensure the fast, stable and accurate movement adjustment of electric push rod 5; the synchronous nonlinear control of multiple electric push rods 5 can avoid structural pulling and damage, and ensure the stable operation of the electric suspension device of multiple electric push rods 5. It has made contributions to the electrification, intelligence and energy saving of tractors.
[0086] The above is a preferred embodiment of the present invention, but the embodiment of the present invention is not limited to the above content. Any other changes, modifications, substitutions, combinations, and simplifications made without departing from the spirit and principles of the present invention should be equivalent replacement methods and are included in the protection scope of the present invention.
Claims
1. An electric suspension device for a work tool, characterized in that: It includes a base, a suspension frame, a control unit, a parallel linkage mechanism arranged between the base and the suspension frame, a connecting piece arranged on the parallel linkage mechanism, two electric push rods arranged between the base and the connecting piece, a linear sensor for measuring the telescopic length of each electric push rod, and an angle detection mechanism for measuring the swing angle of the parallel linkage mechanism; wherein one end of the parallel linkage mechanism is hinged to the base, and the other end of the parallel linkage mechanism is hinged to the suspension frame; one end of the electric push rod is connected to the base, and the other end of the electric push rod is connected to the connecting piece; the base is fixedly connected to the new energy electric tractor, and the suspension frame is connected to the working tool; the electric push rod, the linear sensor and the angle detection mechanism are all electrically connected to the control unit.
2. An electric suspension device for a work tool according to claim 1, characterized in that: The linear sensor is a pull-wire displacement linear sensor, and two pull-wire displacement linear sensors are arranged in one-to-one correspondence with two electric push rods; the pull-wire displacement linear sensor is fixed on the electric push rod, and the rope head measuring end of the pull-wire displacement linear sensor is connected to the telescopic end of the electric push rod.
3. The electric suspension device for a working tool according to claim 1, characterized in that: The parallel linkage mechanism includes two groups of parallel linkage assemblies, each group of parallel linkage assemblies includes two connecting rods that are parallel to each other and distributed vertically, one end of the connecting rod is hinged to the base, and the other end of the connecting rod is hinged to the suspension frame; the connecting member is arranged on the connecting rod.
4. An electric suspension device for a working tool according to claim 3, characterized in that: The angle detection mechanism includes an angle sensor arranged on the base and a transmission assembly arranged between the angle sensor and the connecting rod, and the angle sensor is connected to the control unit; the transmission assembly includes a first rotating rod and a second rotating rod, one end of the first rotating rod is fixedly connected to the axis of the angle sensor; the other end of the first rotating rod is connected to one end of the second rotating rod, and the other end of the second rotating rod is connected to the connecting rod.
5. A nonlinear control method, characterized in that: The nonlinear control method is applied to the electric suspension device according to any one of claims 1 to 4, and the nonlinear control method comprises the following steps: (1) Before the electric suspension device starts operating for the first time, it is necessary to calibrate the two electric push rods and the two linear sensors, and the control unit stores the calibration values obtained by the calibration operation in the internal storage space; (2) The electric suspension device starts to operate normally: (2.1) The control unit reads the calibration value of the internal storage space; the control unit pushes the electric push rod to the reference position determined during calibration according to the calibration value, and checks the output value of the linear sensor; (2.2) Detecting the real-time position of the electric push rod, reading the output values of the two linear sensors through the control unit, and detecting whether there is a position deviation between the two electric push rods; (2.3) If there is a position deviation between the two electric push rods, the direction operation strategy of each electric push rod is determined according to the positive and negative values of the position error; (2.4) According to the direction operation strategy, the dual electric push rod synchronization algorithm is used to determine the specific speeds of the two electric push rods; (2.5) Check whether the two electric actuators are in a synchronized state after adjustment using the dual electric actuator synchronization algorithm.
6. A nonlinear control method according to claim 5, characterized in that: In step (1), the specific process of the calibration operation is as follows: a reference position needs to be determined as the initial synchronization state of the two electric push rods; the reference position is a fixed position value; after the electric push rods are pushed to the reference position, the two linear sensors are calibrated, at which time the output values of the two linear sensors are the calibration values, and the control unit stores the calibration values as the reference values of the linear sensors.
7. A nonlinear control method according to claim 6, characterized in that: In step (1), the position where the telescopic length of the electric push rod is the shortest is taken as the reference position.
8. A nonlinear control method according to claim 5, characterized in that: In step (2.1), the specific steps of checking the output value of the linear sensor are: checking whether the output value of the linear sensor is correct; if correct, entering the initialization success state; if wrong, entering the initialization failure state.
9. A nonlinear control method according to claim 5, characterized in that: In step (2.3), the specific steps of determining the directional operation strategy of each electric push rod according to the positive and negative values of the position error are as follows: if the position of the left electric push rod is ahead of the position of the right electric push rod, the extension and retraction speed of the left electric push rod is slowed down, and the extension and retraction speed of the right electric push rod is accelerated; if the position of the right electric push rod is ahead of the position of the left electric push rod, the extension and retraction speed of the right electric push rod is slowed down, and the extension and retraction speed of the left electric push rod is accelerated.
10. A nonlinear control method according to claim 5, characterized in that: In step (2.5), the specific steps for checking whether the two electric push rods adjusted using the dual electric push rod synchronization algorithm are in a synchronized state are: by reading the output values of the two linear sensors, if the two output values indicate that the two electric push rods are in a synchronized state, repeat step (2.2); if the two output values indicate that the two electric push rods are in an unsynchronized state, repeat step (2.4); if the unsynchronized state still occurs after more than three checks, it is judged that the electric suspension device is faulty and enters a faulty state, and the staff is notified to pay attention to the status of the two electric push rods and perform maintenance.
Citation Information
Patent Citations
Electric tractor suspension system based on electrohydraulic push rod, and control method
CN111771443A
Loading method, evaluation method and loading device for simulating tractor force adjustment control
CN113092138A
Edge-ploughing type vertical turnover plow
CN113498635A
Large rice direct seeding operation unit control device and method based on Beidou system
CN113597851A
Robot chassis for multifunctional operation in paddy field and agricultural robot
CN114223339A
