A control method and system for unmanned tractor agricultural implement unit based on posture coupling
Through the control method based on posture coupling, the problem that traditional navigation systems cannot accurately adjust the position and posture of unmanned tractors and agricultural tools in complex agricultural environments is solved, and efficient coordinated operation of unmanned tractors and agricultural tools units is realized, and the operation accuracy is improved. and efficiency, suitable for complex terrain.
Patent Information
- Application Number
- CN202410781054.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-18
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-06-18
AI Technical Summary
Traditional navigation systems are difficult to accurately adjust the relative position and posture of unmanned tractors and agricultural tools in complex or changeable agricultural environments, resulting in insufficient operational accuracy and adaptability, lack of dynamic coupling and real-time feedback mechanisms, and cannot respond efficiently to terrain changes.
Using a control method based on posture coupling, input operation parameters through the central console, deploy sensor monitoring data, collect operation terrain data, plan the operation route of unmanned tractors, adjust the optimal coordinated position of unmanned tractors and agricultural equipment units in real time, and use The PID controller performs real-time pose adjustments and generates job reports.
It improves the operating accuracy and efficiency of unmanned tractors and agricultural tool units, is suitable for a variety of complex operating terrain, realizes efficient control of coordinated positioning, enhances the applicability and safety of operations, and reduces equipment wear and failure rates.
Smart Images

Figure CN118605130B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent control of agricultural machinery, and in particular to a method and system for controlling an unmanned tractor agricultural implement unit based on posture coupling. Background Art
[0002] In the field of modern agricultural technology, the automated control technology of unmanned tractors and their agricultural implements is developing rapidly to cope with the rising labor costs and the need to improve work efficiency and accuracy. Among them, automatic navigation and optimal control of mechanical operation parameters are one of the key technologies. Existing technologies include navigation control based on the global positioning system (GPS) and the integrated application of various sensors and actuators, which enable unmanned tractors to operate autonomously in the field and reduce dependence on manpower. In addition, the application of intelligent algorithms enables tractors to adjust their operating strategies under different terrains and crop types, optimize operating trajectories and agricultural implement use strategies, but existing control methods still have shortcomings. In complex or changeable agricultural environments, traditional navigation systems find it difficult to accurately adjust the relative position and posture of unmanned tractors and agricultural implements, which limits the accuracy and adaptability of operations. There is a lack of dynamic coupling and real-time feedback mechanisms in collaborative posture adjustment, making it impossible to respond to terrain changes efficiently. Summary of the invention
[0003] In view of the problems existing in the above-mentioned existing unmanned tractor agricultural implement unit control method and system based on posture coupling, the present invention is proposed.
[0004] Therefore, the problem to be solved by the present invention is that in a complex or changeable agricultural environment, it is difficult for traditional navigation systems to accurately adjust the relative position and posture of the unmanned tractor and agricultural implements, which limits the accuracy and adaptability of the operation. There is a lack of dynamic coupling and real-time feedback mechanism in the coordinated posture adjustment, making it impossible to respond to terrain changes efficiently.
[0005] In order to solve the above technical problems, the present invention provides the following technical solutions: a control method for an unmanned tractor and an implement group based on posture coupling, which comprises: a central control console inputs operating parameters of the unmanned tractor and the implement group to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and the implement group; collects operating terrain data, and plans the operating route of the unmanned tractor based on the input parameters; obtains the optimal coordinated posture of the unmanned tractor and the implement group according to the operating terrain data, and uses posture coupling to adjust the posture coordination in real time; after the operation is completed, the unmanned tractor generates an operation report for storage.
[0006] As a preferred solution of the control method of the unmanned tractor and agricultural implement group based on posture coupling described in the present invention, wherein: the central control console inputs the operating parameters of the unmanned tractor and agricultural implement group to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and agricultural implement group, which means that the central control console sends a self-check command to the unmanned tractor and agricultural implement group to check the operation status before starting the operation, and the operator inputs the operating parameters of the unmanned tractor and agricultural implement group according to the operation content through the central control console and then starts the operation, and the unmanned tractor and agricultural implement group are deployed with multimodal sensors and terrain scanners for data collection, and after the multimodal sensors collect the data, they are transmitted to the central control console in real time through a wireless network.
[0007] As a preferred solution of the control method of the unmanned tractor agricultural implement unit based on posture coupling described in the present invention, wherein: the collection of working terrain data refers to the unmanned tractor arriving at the working site and scanning the working area in real time through a terrain scanner to collect terrain undulations and obstacle data based on the working parameters input by the operator, marking the boundaries of the working area and the positions of obstacles and sending them to the central control console, which divides the working area into grids of the same size and assigns coordinates to all nodes of the grids.
[0008] As a preferred solution of the unmanned tractor agricultural implement unit control method based on posture coupling of the present invention, wherein: the planning of the unmanned tractor operation route based on input parameters includes:
[0009] According to the collected operation terrain data, the operation area is formed into a network connection diagram, in which the network nodes are the feasible path points in the operation area, and the node edges are the feasible paths between the feasible path points;
[0010] Mark the operation start point and operation end point of the unmanned tractor in the network connection diagram, create an open node list and a closed node list, and add all nodes in the network connection diagram to the open node list;
[0011] Initialize the moving cost of the job start point to 0, and the moving costs of all other nodes to infinity, and recalculate and update the moving costs of adjacent nodes starting from the job start point:
[0012] ;
[0013]
[0014] in is the updated movement cost, f(n) is the movement cost from the previous node to the nth node, which is initially 0, and h(n) is the movement cost from the nth node to the end point. is the coordinate of the end point of the operation, is the coordinate of node n;
[0015] Select the node with the lowest moving cost in the open node list as the access node, move the access node from the open node list to the closed node list, update the moving cost for all adjacent nodes of the access node, and continue to select the node with the lowest moving cost in the open node list as the next access node;
[0016] Repeat the node visit until the operation end point is added to the closed node list, start the node backtracking from the operation end point, complete the path reconstruction, and use the reconstructed path as the unmanned tractor operation path.
[0017] As a preferred solution of the control method of the unmanned tractor and agricultural implement group based on posture coupling of the present invention, wherein: the optimal coordinated posture of the unmanned tractor and the agricultural implement group is obtained according to the working terrain data, which means that the unmanned tractor operates according to the planned working path, and the optimal coordinated posture of the unmanned tractor and the agricultural implement group is analyzed in real time through the working terrain data during the operation:
[0018] Define the real-time position of the tractor as , the real-time direction is , the real-time position of the agricultural implement unit is , the real-time direction is , calculate the real-time posture difference data x, y and :
[0019]
[0020] Construct a terrain suitability function:
[0021]
[0022] Where h is the terrain height where the unmanned tractor and farm implement unit are located. is the soil hardness at the location, and is the regulating factor;
[0023] The constraint function is defined as:
[0024]
[0025] in is the obstacle position, is the minimum distance to the obstacle;
[0026] Define the optimization target as maxT and g≤0, and construct the optimization function as:
[0027]
[0028] in is the Lagrange multiplier;
[0029] For optimization function Find partial derivatives:
[0030]
[0031] The above partial derivative values are set to 0 to form a nonlinear equation system, and the optimal parameters are obtained by numerical method. The obtained parameters are used to form the optimal collaborative posture difference parameters between the unmanned tractor and the agricultural implement group.
[0032] As a preferred solution of the control method of the unmanned tractor agricultural implement group based on posture coupling of the present invention, wherein: the use of posture coupling to adjust the posture coordination in real time refers to obtaining the optimal coordinated posture difference parameters between the unmanned tractor and the agricultural implement group and then collecting the current posture difference parameters between the unmanned tractor and the agricultural implement group through the sensor in real time , calculate the error between the current pose difference and the optimal pose difference in real time:
[0033]
[0034] where e p is the position error, e d is the orientation error;
[0035] The obtained position error and orientation error are input into the unmanned tractor and agricultural implement group, and the unmanned tractor and agricultural implement group are adjusted based on the PID controller:
[0036]
[0037] Where u is the input of the PID controller for the posture adjustment of the unmanned tractor and agricultural implement unit, e n Including e p and e d , K p , K i and K d They are the proportional gain, integral gain and differential gain of the PID controller respectively, and t is the integral variable.
[0038] As a preferred solution of the unmanned tractor agricultural implement group control method based on posture coupling described in the present invention, wherein: after the operation is completed, the unmanned tractor generates a job report for storage, which means that the unmanned tractor and the agricultural implement group operate according to the planned operation path, and collect posture data in real time during the operation to perform posture coordinated adjustment. After the operation is completed, the unmanned tractor detaches from the operation area and returns under the remote control of the operator. The unmanned tractor generates a job report based on the data collected during the operation and the posture adjustment operation and sends it to the central control console for the operator to view. After the operator confirms, a timestamp is added to the operation report for storage.
[0039] Another object of the present invention is to provide an unmanned tractor agricultural implement unit control system based on posture coupling, which comprises:
[0040] A central control module is used to input the operating parameters of the unmanned tractor and the agricultural implement unit and control the unmanned tractor and the agricultural implement unit to perform the operation;
[0041] A data collection module, used to collect the operation data of the unmanned tractor and agricultural implements and the terrain data of the operation area;
[0042] A path planning module is used to plan the unmanned tractor's operating path based on the collected terrain data of the operating area;
[0043] The posture control module is used to calculate the optimal collaborative posture parameters based on the posture data between the unmanned tractor and the agricultural implement group and the terrain data of the working area collected in real time, and use the PID controller to perform real-time posture control;
[0044] The record storage module is used to generate and store job reports after the job is completed.
[0045] A computer device comprises: a memory and a processor; the memory stores a computer program, and the processor implements the steps of the above-mentioned unmanned tractor agricultural implement group control method based on posture coupling when executing the computer program.
[0046] A computer-readable storage medium stores a computer program, which, when executed by a processor, implements the steps of the above-mentioned unmanned tractor agricultural implement group control method based on posture coupling.
[0047] The beneficial effects of the present invention are as follows: the present invention remotely controls the operation of the unmanned tractor and the agricultural implement group and collects the operation data and the operation area data, performs the operation path planning of the unmanned tractor, synchronously calculates the optimal coordinated posture of the unmanned tractor and the agricultural implement group, and performs real-time adjustment control of the posture of the unmanned tractor and the agricultural implement group, thereby effectively controlling the coordinated posture of the unmanned tractor and the agricultural implement group, improving the applicability of the control method, improving the operation accuracy and efficiency, and being suitable for a variety of complex operation terrains. BRIEF DESCRIPTION OF THE DRAWINGS
[0048] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the accompanying drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the accompanying drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other accompanying drawings can be obtained based on these accompanying drawings without paying creative work.
[0049] Figure 1 The figure is a flow chart of the control method of the unmanned tractor implement unit based on posture coupling.
[0050] Figure 2 Schematic diagram of the implementation of posture control of unmanned tractor implement units.
[0051] Figure 3 It is a structural schematic diagram of the control system of the unmanned tractor agricultural implement unit based on posture coupling. DETAILED DESCRIPTION
[0052] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific embodiments of the present invention are described in detail below in conjunction with the accompanying drawings.
[0053] In the following description, many specific details are set forth to facilitate a full understanding of the present invention, but the present invention may also be implemented in other ways different from those described herein, and those skilled in the art may make similar generalizations without violating the connotation of the present invention. Therefore, the present invention is not limited to the specific embodiments disclosed below.
[0054] Secondly, the term "one embodiment" or "embodiment" as used herein refers to a specific feature, structure, or characteristic that may be included in at least one implementation of the present invention. The term "in one embodiment" that appears in different places in this specification does not necessarily refer to the same embodiment, nor is it a separate or selective embodiment that is mutually exclusive with other embodiments.
[0055] Example 1
[0056] Reference Figure 1 and Figure 2 , which is the first embodiment of the present invention, and which provides an unmanned tractor agricultural implement group control method based on posture coupling. The unmanned tractor agricultural implement group control method based on posture coupling includes:
[0057] S1. The central control console inputs the operating parameters of the unmanned tractor and the agricultural implement group to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and the agricultural implement group;
[0058] Specifically, the central control console inputs the operating parameters of the unmanned tractor and agricultural implement group to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and agricultural implement group. The central control console sends a self-check command to the unmanned tractor and agricultural implement group to check the operation status before starting the operation. The operator inputs the operating parameters of the unmanned tractor and agricultural implement group according to the operation content through the central console and then starts the operation. The unmanned tractor and agricultural implement group are deployed with multimodal sensors and terrain scanners for data collection. After the multimodal sensors collect the data, they are transmitted to the central control console in real time via the wireless network.
[0059] Before the operation, the operator inputs the operating parameters of the unmanned tractor and agricultural implement group through the central console, and issues a self-check command to check the operating status. The key innovation of this step is the integrated self-check function to ensure that the operating status of the unmanned group meets the preset conditions before the operation begins, thereby preventing possible failures or non-optimal operating conditions that may cause operating efficiency and quality problems. For example, if the sensor function is abnormal or the mechanical parts are not in the best condition, the operator can adjust or repair them in time to avoid failures during the operation. Multimodal sensors and terrain scanners are used to comprehensively monitor the operating environment. These devices can collect a variety of data including soil moisture, crop growth conditions, terrain undulations, etc. This information is crucial for optimizing the operation path and adjusting the operation parameters. The collected data is transmitted to the central console in real time via the wireless network. This step ensures that the operator can obtain the operation status in real time and adjust the operation parameters or operation strategy based on the real-time data. The introduction of real-time data transmission significantly improves the adaptability and flexibility of the operation, allowing the unmanned tractor to adjust the operation strategy in real time when encountering emergencies, such as sudden changes in terrain or crop diseases, to ensure the continuity and effectiveness of the operation.
[0060] S2, collect operating terrain data and plan the unmanned tractor operating route based on input parameters;
[0061] Specifically, collecting working terrain data means that according to the working parameters input by the operator, after the unmanned tractor arrives at the working site, it uses a terrain scanner to scan the working area in real time to collect terrain undulations and obstacle data, marks the boundaries of the working area and the positions of obstacles, and sends them to the central control console. The central control console divides the working area into grids of the same size and assigns coordinates to all nodes in the grid.
[0062] Real-time scanning allows unmanned tractors to respond quickly to immediate terrain changes, thereby adapting to the ever-changing operating environment. This not only improves the accuracy of machine operations, but also greatly reduces accidents and mechanical damage caused by unfamiliar terrain. It is suitable for changeable agricultural terrain, especially those fields with complex terrain or multiple obstacles, such as hilly areas or areas frequently distributed with obstacles such as stones and tree roots. By marking key locations, it can ensure that unmanned tractors avoid entering non-operating areas or dangerous areas during operations, improving the safety and efficiency of operations. The key lies in preventing potential risks and errors in the operation process, optimizing the design of operation paths, and reducing invalid or repeated operations. The operation area is divided into grids and coordinates are assigned to all nodes of the grid to make operation planning more refined and orderly. Through precise grid division, unmanned tractors can efficiently complete operation tasks according to preset paths, maximizing coverage of each area without omissions. It is particularly suitable for large-scale uniform operations, such as large farms or plant protection operations. Grid processing helps to achieve fine management and improve operation quality and coordination capabilities.
[0063] Further, planning the unmanned tractor operation route based on the input parameters includes:
[0064] According to the collected operation terrain data, the operation area is formed into a network connection diagram, in which the network nodes are the feasible path points in the operation area, and the node edges are the feasible paths between the feasible path points;
[0065] Mark the operation start point and operation end point of the unmanned tractor in the network connection diagram, create an open node list and a closed node list, and add all nodes in the network connection diagram to the open node list;
[0066] Initialize the moving cost of the job start point to 0, and the moving costs of all other nodes to infinity, and recalculate and update the moving costs of adjacent nodes starting from the job start point:
[0067]
[0068]
[0069] in is the updated moving cost, f(n) is the moving cost from the previous node to the nth node, which is initially 0, and h(n) is the moving cost from the nth node to the end point. is the coordinate of the end point of the operation, is the coordinate of node n;
[0070] Select the node with the lowest moving cost in the open node list as the access node, move the access node from the open node list to the closed node list, update the moving cost for all adjacent nodes of the access node, and continue to select the node with the lowest moving cost in the open node list as the next access node;
[0071] Repeat the node visit until the operation end point is added to the closed node list, start the node backtracking from the operation end point, complete the path reconstruction, and use the reconstructed path as the unmanned tractor operation path.
[0072] By converting complex terrain data into a network connection diagram, the path planning problem of the operating area can be processed and analyzed more intuitively, and the ability to handle terrain complexity is improved. It is particularly suitable for farmland with complex terrain and dense obstacles, so that unmanned tractors can find the optimal operating path. By setting the starting cost to 0 and the other node costs to infinity, and gradually updating these costs, it can ensure that the lowest cost path from the starting point to the end point is found. This method optimizes resource use, reduces unnecessary path exploration, and improves the accuracy and efficiency of path planning. It is suitable for large-scale farms that require fine management and high-efficiency operations. Completing the path reconstruction ensures that the unmanned tractor travels along the expected optimal path in actual operations, reducing operation time and cost, and improving the overall efficiency and safety of the operation. It is crucial to ensure the optimization of the operation path, especially in agricultural scenarios where the operating environment changes greatly or the operation requires extremely precise operation.
[0073] S3, deriving the optimal coordinated posture of the unmanned tractor and the agricultural implement group according to the operating terrain data, and adjusting the posture coordination in real time by using posture coupling;
[0074] Specifically, the optimal coordinated posture of the unmanned tractor and the agricultural implement group is obtained according to the operating terrain data, which means that the unmanned tractor operates according to the planned operating path, and the optimal coordinated posture of the unmanned tractor and the agricultural implement group is analyzed in real time through the operating terrain data during the operation:
[0075] Define the real-time position of the tractor as , the real-time direction is , the real-time position of the agricultural implement unit is , the real-time direction is , calculate the real-time posture difference data x, y and :
[0076]
[0077] Construct a terrain suitability function:
[0078]
[0079] Where h is the terrain height where the unmanned tractor and farm implement unit are located. is the soil hardness at the location, and is the regulating factor;
[0080] The constraint function is defined as:
[0081]
[0082] in is the obstacle position, is the minimum distance to the obstacle;
[0083] Define the optimization target as maxT and g≤0, and construct the optimization function as:
[0084]
[0085] in is the Lagrange multiplier;
[0086] For optimization function Find partial derivatives:
[0087]
[0088] The above partial derivative values are set to 0 to form a nonlinear equation system, and the optimal parameters are obtained by numerical method. The obtained parameters are used to form the optimal collaborative posture difference parameters between the unmanned tractor and the agricultural implement group.
[0089] By real-time monitoring and adjusting the position and direction of the unmanned tractor and agricultural implement group, the operation efficiency and accuracy can be significantly improved. In addition, this method can reduce physical conflicts between equipment and mechanical wear during operation. It is particularly suitable for farmlands with complex or changeable terrain, such as hilly areas, wetlands, etc., ensuring that drones and agricultural implement groups can work together smoothly, so that the unmanned tractor and agricultural implement group can adjust its operation strategy according to the current terrain conditions, thereby adapting to different soil hardness and terrain undulations, improving the adaptability of the machinery to the terrain and the reliability of the operation. It is especially important for precise operations in areas with large changes in soil hardness and terrain height, such as farmlands with different cultivated soil textures. By optimizing calculations, the operation efficiency and equipment safety are maximized, the operation time is reduced and potential equipment damage is prevented. In complex operating environments, such as large farms with multiple obstacles, this method can ensure the coordinated operation of unmanned tractors and agricultural implement groups to avoid accidents during operations.
[0090] Furthermore, the posture coupling is used to adjust the posture coordination in real time to obtain the optimal coordinated posture difference parameters between the unmanned tractor and the agricultural implement group, and then the current posture difference parameters between the unmanned tractor and the agricultural implement group are collected through sensors. , calculate the error between the current pose difference and the optimal pose difference in real time:
[0091]
[0092] where e p is the position error, e d is the orientation error;
[0093] The obtained position error and orientation error are input into the unmanned tractor and agricultural implement group, and the unmanned tractor and agricultural implement group are adjusted based on the PID controller:
[0094]
[0095] Where u is the input of the PID controller for the posture adjustment of the unmanned tractor and agricultural implement unit, e n Including e p and e d , K p , K i and K d They are the proportional gain, integral gain and differential gain of the PID controller respectively, and t is the integral variable.
[0096] Real-time monitoring and adjustment of the posture of unmanned tractors and agricultural implements can respond to terrain changes and the presence of obstacles in real time, thereby optimizing the operation path and method. This dynamic adjustment significantly improves the operation efficiency and quality, and is suitable for farmlands with complex terrain and multiple obstacles, ensuring the continuity and safety of operations, avoiding accidents caused by terrain or obstacles, and adjusting equipment according to different terrain characteristics through adjustment factors to make operations more efficient and accurate. This not only improves the adaptability of agricultural machinery, but also reduces the additional costs caused by terrain incompatibility. It is particularly suitable for areas with large changes in soil hardness and terrain height, optimizing the performance of unmanned tractors and agricultural implements, improving the accuracy and reliability of operations, and accurately calculating the optimal parameters under specific operating conditions through mathematical optimization technology. Such calculation results ensure maximum efficiency and minimum risk of operations, and are suitable for high-tech agricultural scenarios that require precise control of operation paths and operation strategies, especially in modern agricultural production with a high degree of automation.
[0097] S4. After the operation is completed, the unmanned tractor generates an operation report for storage;
[0098] Specifically, after the operation is completed, the unmanned tractor generates an operation report for storage, which means that the unmanned tractor and the agricultural implement group operate according to the planned operation path, and collect posture data in real time during the operation to perform coordinated posture adjustment. After the operation is completed, the unmanned tractor detaches from the operation area and returns under the remote control of the operator. The unmanned tractor generates an operation report with the data collected during the operation and the posture adjustment operation and sends it to the central control console for the operator to view. After the operator confirms, a timestamp is added to the operation report for storage.
[0099] The collection of real-time data and the coordinated adjustment of posture can instantly correct deviations in operations and improve operation accuracy and efficiency. This process also helps to reduce equipment wear and failure rates and extend the service life of equipment. It is suitable for modern agriculture that requires high-precision operations, such as precision planting, fertilization or spraying. Through automatically generated detailed operation reports, operators can obtain comprehensive operation data analysis, which is of great significance for improving the planning and execution of future operations. The automation of reports reduces human errors and the workload of data entry. It is particularly suitable for large-scale agricultural operations and can help management monitor and evaluate operation results, optimize resource allocation and operation plans. The operator's confirmation and timestamp storage of the report provide reliability for the verification and audit of the operation report. The timestamp ensures the timeliness and non-tamperability of the data, and enhances the legal and management value of the operation data.
[0100] Example 2
[0101] Reference Figure 3 , which is the second embodiment of the present invention, and which is different from the previous embodiment, provides an unmanned tractor agricultural implement unit control system based on posture coupling, which includes:
[0102] A central control module is used to input the operating parameters of the unmanned tractor and the agricultural implement unit and control the unmanned tractor and the agricultural implement unit to perform the operation;
[0103] A data collection module, used to collect the operation data of the unmanned tractor and agricultural implements and the terrain data of the operation area;
[0104] A path planning module is used to plan the unmanned tractor's operating path based on the collected terrain data of the operating area;
[0105] The posture control module is used to calculate the optimal collaborative posture parameters based on the posture data between the unmanned tractor and the agricultural implement group and the terrain data of the working area collected in real time, and use the PID controller to perform real-time posture control;
[0106] The record storage module is used to generate and store job reports after the job is completed.
[0107] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions to enable a computer device (which can be a personal computer, server, or network device, etc.) to perform all or part of the steps of the methods described in various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc., which can store program codes.
[0108] The logic and / or steps represented in the flowchart or otherwise described herein, for example, can be considered as an ordered list of executable instructions for implementing logical functions, and can be embodied in any computer-readable medium for use by an instruction execution system, device or apparatus (such as a computer-based system, a system including a processor, or other system that can fetch instructions from an instruction execution system, device or apparatus and execute instructions), or in conjunction with such instruction execution systems, devices or apparatuses. For the purposes of this specification, "computer-readable medium" can be any device that can contain, store, communicate, propagate or transmit a program for use by an instruction execution system, device or apparatus, or in conjunction with such instruction execution systems, devices or apparatuses.
[0109] More specific examples of computer-readable media (a non-exhaustive list) include the following: an electrical connection with one or more wires (electronic device), a portable computer disk case (magnetic device), a random access memory (RAM), a read-only memory (ROM), an erasable and programmable read-only memory (EPROM or flash memory), an optical fiber device, and a portable compact disk read-only memory (CDROM). In addition, the computer-readable medium may even be a paper or other suitable medium on which the program is printed, since the program may be obtained electronically, for example, by optically scanning the paper or other medium, followed by editing, deciphering or, if necessary, processing in another suitable manner, and then stored in a computer memory.
[0110] It should be understood that the various parts of the present invention can be implemented by hardware, software, firmware or a combination thereof. In the above embodiments, multiple steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit with a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit with a suitable combination of logic gate circuits, a programmable gate array (PGA), a field programmable gate array (FPGA), etc.
[0111] It should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solutions of the present invention may be modified or replaced by equivalents without departing from the spirit and scope of the technical solutions of the present invention, which should all be included in the scope of the claims of the present invention.
Claims
1. A control method for an unmanned tractor agricultural implement unit based on posture coupling, characterized in that: include, The central control console inputs the operating parameters of the unmanned tractor and agricultural implements to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and agricultural implements; Collect operating terrain data and plan the unmanned tractor operating route based on input parameters; The optimal coordinated posture of the unmanned tractor and the agricultural implement group is obtained based on the operating terrain data, and the posture coordination is adjusted in real time using posture coupling; After the operation is completed, the unmanned tractor generates an operation report for storage; The central control console inputs the operating parameters of the unmanned tractor and the farm implement group to control the operation, and deploys sensors to monitor the operating data of the unmanned tractor and the farm implement group. The central control console sends a self-check command to the unmanned tractor and the farm implement group to check the operation status before starting the operation. The operator inputs the operating parameters of the unmanned tractor and the farm implement group according to the operation content through the central control console and then starts the operation. The unmanned tractor and the farm implement group are deployed with multimodal sensors and terrain scanners for data collection. After the multimodal sensors collect the data, they are transmitted to the central control console in real time through a wireless network; The collecting of the working terrain data means that according to the working parameters input by the operator, after the unmanned tractor arrives at the working site, it scans the working area in real time through the terrain scanner to collect the terrain undulations and obstacle data, marks the boundaries of the working area and the positions of the obstacles, and sends them to the central control console, which divides the working area into grids of the same size and assigns coordinates to all the nodes of the grids; The planning of the unmanned tractor operation route based on the input parameters includes: According to the collected operation terrain data, the operation area is formed into a network connection diagram, in which the network nodes are the feasible path points in the operation area, and the node edges are the feasible paths between the feasible path points; Mark the operation start point and operation end point of the unmanned tractor in the network connection diagram, create an open node list and a closed node list, and add all nodes in the network connection diagram to the open node list; Initialize the moving cost of the job start point to 0, and the moving costs of all other nodes to infinity, and recalculate and update the moving costs of adjacent nodes starting from the job start point: f'(n)=f(n)+h(n) Where f''(n) is the updated movement cost, f(n) is the movement cost from the previous node to the nth node, which is initially 0, h(n) is the movement cost from the nth node to the end point, (x T ,y T ) is the coordinate of the end point of the operation, (x n ,y n ) is the coordinate of node n; Select the node with the lowest moving cost in the open node list as the access node, move the access node from the open node list to the closed node list, update the moving cost for all adjacent nodes of the access node, and continue to select the node with the lowest moving cost in the open node list as the next access node; Repeat the node visit until the operation end point is added to the closed node list, start the node backtracking from the operation end point, complete the path reconstruction, and use the reconstructed path as the unmanned tractor operation path; The said obtaining the optimal coordinated posture of the unmanned tractor and the agricultural implement group according to the working terrain data means that the unmanned tractor operates according to the planned working path, and the optimal coordinated posture of the unmanned tractor and the agricultural implement group is analyzed in real time through the working terrain data during the operation: Define the real-time position of the tractor as (x', y'), the real-time orientation as θ', the real-time position of the agricultural implement as (x'', y''), and the real-time orientation as θ'', and calculate the real-time position difference data x, y, and θ between the unmanned tractor and the agricultural implement: x=x'-x'', y=y'-y'', θ=θ'-θ'' Construct a terrain suitability function: Where h is the terrain height where the unmanned tractor and farm implement unit are located, s(x, y) is the hardness of the ground soil at the location, and α and γ are adjustment factors; The constraint function is defined as: Where (x i ,y i ) is the obstacle position, d min is the minimum distance to the obstacle; Define the optimization target as maxT and g≤0, and construct the optimization function as: Where λ is the Lagrange multiplier; For optimization function Find partial derivatives: The above partial derivative values are set to 0 to form a nonlinear equation system, and the optimal parameters (x c ,y c ,θ c ), and the obtained parameters are used to form the optimal collaborative posture difference parameters between the unmanned tractor and the agricultural implement group.
2. The unmanned tractor agricultural implement unit control method based on posture coupling according to claim 1, characterized in that: The method of adjusting the posture coordination in real time by using posture coupling refers to obtaining the optimal coordinated posture difference parameters between the unmanned tractor and the agricultural implement group, collecting the current posture difference parameters (x, y, θ) between the real-time unmanned tractor and the agricultural implement group through sensors, and calculating the error between the current posture difference and the optimal posture difference in real time: e d =|θ c -θ| where e p is the position error, e d is the orientation error; The obtained position error and orientation error are input into the unmanned tractor and agricultural implement group, and the unmanned tractor and agricultural implement group are adjusted based on the PID controller: Where u is the input of the PID controller for the posture adjustment of the unmanned tractor and agricultural implement unit, e n Including e p and e d , K p , K i and K d They are the proportional gain, integral gain and differential gain of the PID controller respectively, and t is the integral variable.
3. The unmanned tractor agricultural implement control method based on posture coupling according to claim 2, characterized in that: After the operation is completed, the unmanned tractor generates an operation report for storage, which means that the unmanned tractor and the agricultural implement group operate according to the planned operation path, and collect posture data in real time during the operation to coordinate the posture. After the operation is completed, the unmanned tractor detaches from the operation area and returns under the remote control of the operator. The unmanned tractor generates an operation report with the data collected during the operation and the posture adjustment operation and sends it to the central control console for the operator to view. After the operator confirms, a timestamp is added to the operation report for storage.
4. An unmanned tractor agricultural implement control system based on posture coupling, adopting the control method according to any one of claims 1 to 3, characterized in that: include, A central control module is used to input the operating parameters of the unmanned tractor and the agricultural implement unit and control the unmanned tractor and the agricultural implement unit to perform the operation; A data collection module, used to collect the operation data of the unmanned tractor and agricultural implements and the terrain data of the operation area; A path planning module is used to plan the unmanned tractor's operating path based on the collected terrain data of the operating area; The posture control module is used to calculate the optimal collaborative posture parameters based on the posture data between the unmanned tractor and the agricultural implement group and the terrain data of the working area collected in real time, and use the PID controller to perform real-time posture control; The record storage module is used to generate and store job reports after the job is completed.
5. A computer device comprising: Memory and processor; The memory stores a computer program, characterized in that: when the processor executes the computer program, the steps of the unmanned tractor agricultural implement unit control method based on posture coupling described in any one of claims 1 to 3 are implemented.
6. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the unmanned tractor agricultural implement unit control method based on posture coupling according to any one of claims 1 to 3 are implemented.
