A navigation and correction system for an orchard power platform that integrates positioning and logical operation

By integrating panoramic radar, blind spot radar, and visual cameras into the orchard power platform, and combining this with a self-learning iterative optimization program, the platform achieves precise positioning and high-precision correction, solving the problem of insufficient positioning and correction accuracy in existing technologies and improving operational stability and safety.

CN122858490BActive Publication Date: 2026-11-10FIRST TRACTOR
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202611358496.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2026-09-03
Publication Date
2026-11-10
Estimated Expiration
2046-09-03

AI Technical Summary

Technical Problem

Existing technologies are insufficient in terms of precise positioning and correction calculation of orchard power platforms, resulting in unstable operation, easy damage to machinery, and low correction accuracy.

Method used

The orchard power platform adopts a fusion positioning and logic operation navigation correction system. Through the combination of panoramic radar, blind spot radar, vision camera and industrial control computer, the system realizes the accurate positioning of the orchard power platform and the fusion logic operation of correction amount. By using self-learning iterative optimization program, the correction amount and operation speed are automatically adjusted to achieve high-precision correction.

Benefits of technology

It improves the positioning and correction accuracy of the orchard power platform, ensuring the stability and safety of operation, protecting the machinery, and improving the quality of operation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN122858490B_ABST
    Figure CN122858490B_ABST
Patent Text Reader

Abstract

This invention relates to the field of intelligent agricultural machinery autonomous driving, specifically to an orchard power platform fusion positioning and logic operation navigation correction system. The system includes an industrial control computer, a panoramic radar, a mode switch, a power platform controller, an orchard power platform, a blind spot radar, a right vision camera, and a left vision camera. The industrial control computer is connected to the panoramic radar, power platform controller, blind spot radar, right vision camera, left vision camera, and IoT controller. The mode switch and IoT controller are connected to the power platform controller. This correction system improves the positioning accuracy of the orchard power platform by automatically fusing logic operations through precise positioning. It also improves the accuracy of the correction output control quantity through fusion logic operations and self-learning iterative optimization programs. Based on different operating modes, it automatically assigns closed-loop dynamic correction control, achieving precise and stable correction of autonomous driving in complex shady orchard scenarios, meeting the requirements of efficient and high-quality operation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of intelligent agricultural machinery automatic driving, specifically to an orchard power platform fusion positioning and logic operation navigation correction system. Background Technology

[0002] With the rapid development of autonomous driving technology, its application in agricultural machinery has begun, but its use in orchards is still in the technological breakthrough stage. Currently, multi-sensor fusion technology has achieved accurate identification and positioning of fruit tree trunks, but there is still room for improvement in the accurate positioning and correction calculation of orchard power platforms. Different implements have different safe correction values ​​at different operating speeds; excessive deviation in correction value can easily cause large swaying during operation, unstable work quality, and even damage to the implements. To promote the application of autonomous driving technology for orchard power platforms, it is necessary to improve the platform's accurate positioning, precisely control the output correction value through self-learning optimization algorithms, improve correction accuracy, protect the implements, and enhance the operational quality of autonomous driving in orchards.

[0003] In the field of agricultural machinery automatic driving, relevant patent documents with application number 202311763779.8 and authorization announcement number CN120840731B have disclosed navigation technology. The invention patent with application number 202311763779.8, "Automatic Navigation System for Orchard Vehicles Based on Fusion of LiDAR and Machine Vision," discloses that the system includes an orchard vehicle, which includes a four-wheel differential chassis and a host computer, a slave controller, a 2D LiDAR, a CCD camera, a Hall encoder, a DC servo motor, and a swing mechanism mounted on the four-wheel differential chassis. 3D point cloud data is generated by using 2D laser point cloud data and angle data, and image data is fused to identify and locate tree rows, road obstacles, and fruit trees at the end of rows. This enables the fitting of tree row lines and navigation baselines, as well as the generation of obstacle avoidance paths and turning paths. The target speed is calculated using a trajectory tracking algorithm, and the four-wheel differential chassis is driven by a lower-level controller and motor driver to travel according to the obstacle avoidance path and turning path. This solves the problems of high cost and low accuracy of existing technologies. However, this solution does not address how to improve the positioning of the power platform and the fusion logic operation to improve the correction accuracy.

[0004] Patent CN120840731B, authorized by the patent, discloses another technology for improving navigation accuracy. This technology mainly utilizes the powerful computing capabilities of the onboard computer of the navigation system, and uses its independently developed correction output calculation formula to perform fast and accurate calculations, thereby improving the calculation accuracy of the correction amount and achieving high-precision correction. It also controls the differential steering mechanism through a servo valve to achieve smooth correction and zero-position steering. Although this solution improves the correction accuracy and stability, it does not address the issues of improving the positioning accuracy of the power platform or the improvement of correction accuracy through fusion logic operations.

[0005] Although the above-disclosed content has similarities to the present invention, it differs significantly from the present invention in that the orchard power platform uses precise positioning automatic fusion logic operation and self-learning iterative optimization correction operation program to improve the positioning accuracy and correction accuracy of the power platform, and effectively ensure the stability, safety and efficiency of the orchard power platform operation. Summary of the Invention

[0006] The main objective of this invention is to provide a navigation correction system for an orchard power platform that integrates positioning and logical operation. This correction system improves the positioning accuracy of the orchard power platform by automatically integrating logical operations through precise positioning. It also improves the accuracy of the correction output control quantity through self-learning iterative optimization of the program. The system automatically assigns correction quantity fusion calculations according to different operating modes and performs closed-loop dynamic correction control, thereby achieving precise positioning and smooth correction of the autonomous orchard power platform in complex shaded orchard scenarios, and meeting the requirements for efficient and high-quality operation.

[0007] To achieve the above objectives, the present invention adopts the following technical solution: A navigation and correction system for an orchard power platform that integrates positioning and logic operation includes an industrial control computer, a panoramic radar, a mode switch, a power platform controller, an orchard power platform, a blind spot radar, a right vision camera, and a left vision camera. The industrial control computer is connected to the panoramic radar, the power platform controller, the blind spot radar, the right vision camera, the left vision camera, and an Internet of Things (IoT) controller. The mode switch and the IoT controller are connected to the power platform controller. The industrial control computer is installed at the front end of the orchard power platform. The industrial control computer stores the relative coordinate data of the main trunk positions of each row of fruit trees in the orchard, which is received by the Internet of Things controller. The industrial control computer receives laser point cloud data collected by panoramic radar and blind spot radar, defines the position points of the main trunks of the fruit trees on the left and right sides based on the vertical layer point uniformity and point cloud curvature value, and calculates the relative coordinate values ​​of the position points of the main trunks of the fruit trees on the left and right sides. The industrial control computer calculates the distance between the orchard power platform and the main trunks of the fruit trees on the left and right sides using a built-in formula, based on the calculated relative coordinates of the main trunks. Then, it compares the calculated center coordinates of the main trunks with the coordinates of the existing main trunks. Based on different deviation ratios, it calculates a weight value. If the deviation is too large, it selects the main trunks of adjacent fruit trees as the benchmark for calculating the weight value. Based on the calculated weight value, it uses a built-in formula to calculate the relative lateral coordinates of the orchard power platform.

[0008] Furthermore, the industrial control computer calculates the coordinates P1 of the main trunk positions on the left and right sides by performing a horizontal weighted average of the main trunk positions to find the center. , P2 , The system compares the calculated coordinates of the main trunk of the fruit tree with the stored coordinates. Coordinates with an offset exceeding 30% are downweighted, and those with an offset exceeding 50% are treated as invalid. The system then continues to scan the main trunks of adjacent fruit trees and calculates their coordinates as the positioning reference for the orchard power platform.

[0009] Furthermore, the distances between the orchard power platform and the main trunks of the fruit trees on the left and right sides are as follows: =

[0010] =

[0011] in: The coordinates of the distance between the orchard power platform and the location of the main trunk of the fruit tree on the left; The coordinates of the distance between the orchard power platform and the location of the main trunk of the fruit tree on the right; The x-coordinate for the orchard power platform's distance measurement; The vertical coordinate of the orchard power platform is used for distance measurement.

[0012] The industrial control computer uses the following weighting formula:

[0013]

[0014] in: The coordinates of point P1 are the location of the main trunk of the fruit tree on the left side of the orchard power platform. , Weight values; The coordinates of point P2 are the locations of the main trunks of the fruit trees on the right side of the orchard power platform. , Weight values; The distance is a power of 1.5, and the weight value is automatically calculated. It is a very small positive number. The industrial control computer uses the horizontal coordinate fusion formula:

[0015] in The horizontal coordinate of the orchard power platform is calculated using the formula described above.

[0016] Furthermore, the industrial control computer removes invalid interference information such as weeds and small branches from the point cloud data collected by the panoramic radar and the blind spot radar, as well as the images collected by the right visual camera and the left visual camera, extracts the tree crown features, and calculates the coordinates Q1 of the innermost point of the tree crown. , Q2 , ),calculate Value, if In the formula H The maximum width of the orchard power platform and machinery indicates that the row spacing is significantly smaller than the passable width.

[0017] Furthermore, if the line spacing is normal, the industrial control computer uses the fusion formula: ,in To integrate and calculate the x-axis under different operating modes; l The pre-offset of the operation path is set for different modes. Based on the above calculations, the coordinates of the operation path of the orchard power platform are calculated, and the actual operation path travel line is fitted using the least squares method.

[0018] Furthermore, the industrial control computer calculates the correction amount based on the offset between the calculated horizontal coordinate of the orchard power platform and the stored standard operating path. Based on the correction amount, it automatically retrieves the corresponding maximum operating speed value from the internal storage and sends the operating speed value and the correction amount instruction to the power platform controller simultaneously. At the same time, in order to avoid frequent changes in the speed value and cause shock to the operation of the orchard power platform, no adjustment is made within a 10% deviation range of the speed value.

[0019] Furthermore, the power platform controller receives the correction command and the operating speed command from the industrial control computer. The power platform controller first executes the command to adjust the operating speed value, adjusting the operating speed of the orchard power platform to the operating speed value output by the industrial control computer, and then executes the correction data command to avoid excessive correction amplitude when the operating speed is too high.

[0020] Furthermore, during the correction process, the industrial control computer's self-learning iterative optimization program automatically records and calculates the correction value, and automatically retrieves the corresponding speed value based on the recorded correction value. This set of data is then sent to the power platform controller to calculate the lateral offset of the orchard power platform after correction. If the lateral offset is within the allowable range, the correction value and corresponding speed value in the storage unit remain unchanged. If the lateral offset exceeds the allowable range, the percentage of lateral offset exceeding the limit is automatically calculated, and the speed value corresponding to the correction value is corrected according to this percentage. The corrected speed value replaces the stored speed value, completing the self-learning iterative optimization.

[0021] The beneficial effects of the present invention are as follows: The orchard power platform fusion positioning and logic operation navigation correction system of the present invention has the following advantages when used: 1. This invention employs a novel fusion weighting core algorithm, which is adaptable to complex orchard scenarios. It uses automatic fusion logic operations to perform precise dynamic positioning and correction calculations in the orchard and introduces a pre-offset amount for the work path. l Compared with traditional algorithms, this method effectively avoids large deviations in the relative coordinate data of local fruit tree trunk locations, which can cause abnormal positioning errors and prevent excessive corrections, or even damage to fruit trees or operating equipment. 2. The industrial control computer in this invention imports data storage and automatically integrates calculation formulas, automatically optimizing the output data volume instructions for correction. While ensuring the operation speed, it can effectively reduce the correction frequency, improve the stability of the correction process, and effectively ensure operational safety and the quality of automated machine operation. When the speed corresponding to the correction amount is higher than the operation speed, the power platform controller adopts sequential control logic, first executing the industrial control computer's operation speed instruction and then executing the correction instruction. Through self-learning and iterative optimization, it achieves stable correction, ensuring the stability of operation quality and the safety of the machine, and has strong promotion and application value. Attached Figure Description

[0022] Figure 1 This is a left view of the orchard power platform fusion positioning and logic operation navigation correction system of the present invention; Figure 2 This is the main view of the orchard power platform fusion positioning and logic operation navigation correction system of the present invention; Figure 3 This is a flowchart of the orchard power platform fusion positioning and logic operation navigation correction system of the present invention; Figure 4 This is a flowchart of the industrial control computer process for the orchard power platform integrated positioning and logic operation navigation correction system of the present invention; Figure 5 This is a flowchart of the self-learning iterative optimization process of the orchard power platform fusion positioning and logic operation navigation correction system of the present invention; The following are the labels in the diagram: 1. Industrial PC; 2. Panoramic radar; 3. Mode switch; 4. Power platform controller; 5. Orchard power platform; 6. Blind spot radar; 7. Right vision camera; 8. Left vision camera; 9. Internet of Things controller. Detailed Implementation

[0023] Specific Embodiment 1: To enable those skilled in the art to better understand the technical solution of the present invention, the technical solution of the present invention will be clearly and completely described below in conjunction with embodiments. Obviously, the described embodiments are only some embodiments of the present invention, not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention. It should be noted that: In the present invention, unless otherwise specified, all embodiments and preferred methods mentioned herein can be combined to form new technical solutions. In the present invention, unless otherwise specified, all technical features and preferred features mentioned herein can be combined to form new technical solutions. The "scope" disclosed in the present invention can be in the form of a lower limit and an upper limit, and can be one or more lower limits and one or more upper limits, respectively. Unless otherwise stated, the technical and scientific terms used herein have the same meaning as those skilled in the art.

[0024] As per the instruction manual Figure 1 To the instruction manual Figure 5 As shown, the present invention provides an orchard power platform fusion positioning and logic operation navigation correction system. The system includes an industrial control computer 1, a panoramic radar 2, a mode switch 3, a power platform controller 4, an orchard power platform 5, a blind spot radar 6, a right vision camera 7, a left vision camera 8, and an Internet of Things controller 9. The industrial control computer 1 is connected to the panoramic radar 2, the power platform controller 4, the blind spot radar 6, the right vision camera 7, the left vision camera 8, and the Internet of Things controller 9. The mode switch 3 and the Internet of Things controller 9 are connected to the power platform controller 4.

[0025] An industrial control computer 1 is installed at the front end of the orchard power platform 5. The industrial control computer 1 internally stores the relative coordinate data of the main trunk positions of each row of fruit trees in the orchard, as well as the standard operating path, received by the IoT controller 9. The industrial control computer 1 receives laser point cloud data collected by the panoramic radar 2 and the blind spot radar 6, defines the main trunk positions of the fruit trees on the left and right sides based on the vertical layer uniformity and point cloud curvature, and calculates the relative coordinate values ​​of these main trunk positions using a built-in weighting formula. Based on the calculated relative coordinate values ​​of the main trunk positions, the industrial control computer 1 first calculates the coordinate distance between the orchard power platform 5 and the main trunk positions of the fruit trees on the left and right sides using the built-in formula. Then, it compares the calculated coordinate values ​​of the main trunk positions with the existing coordinate values ​​of the main trunk positions within the system. Based on different deviation ratios, it automatically calculates the weights. If the deviation is too large, it selects the adjacent main trunk position as the benchmark for calculating the weight value. Based on the finally confirmed weight value, it calculates the relative lateral coordinate value of the orchard power platform 5 using the built-in formula. The distance between the orchard power platform 5 and the location of the main trunk of the fruit tree is as follows: =

[0026] =

[0027] Industrial PC 1 calculates its weights using the following formula:

[0028]

[0029] The weight values ​​are automatically calculated. Industrial computer 1 calculates the weights based on the horizontal coordinate fusion formula: The horizontal coordinates of the orchard power platform 5 are calculated, and this process is called the automatic fusion calculation and positioning of the orchard power platform 5.

[0030] Simultaneously, the industrial control computer 1 receives point cloud data and images collected by the panoramic radar 2, blind spot radar 6, right vision camera 7, and left vision camera 8. It performs layered filtering of the point cloud data, dual noise reduction of the image data using attention-based semantic segmentation, removes invalid weeds and small branches, extracts the complete tree canopy outline, and determines the relative coordinates Q1 of the outermost point of the canopy. , Q2 , First, it calculates whether the orchard power platform 5 can pass. If it cannot pass, the industrial control computer 1 will send a stop command to the power platform controller 4 and send an abnormal information number to the Internet of Things controller 9. The Internet of Things controller 9 sends a message to the remote control platform to request manual handling.

[0031] If the industrial computer 1 calculates that the row spacing is sufficient for normal passage, it automatically extracts the pre-offset of the work path. l The system automatically runs the least squares fitting calculation formula to calculate the operation path. The lateral positioning coordinates of the orchard power platform 5 are compared with the stored standard operation path to calculate the offset value of the orchard power platform 5. If the offset value does not exceed the allowable range, the industrial control computer 1 does not issue a correction command. If the offset value exceeds the allowable range, the industrial control computer 1 will automatically retrieve the speed value corresponding to the correction value in its database and send the correction value and the corresponding speed value to the power platform controller 4. The power platform controller 4 first compares the received speed command value with the current operation speed value of the orchard power platform 5. If the deviation is within 10%, no adjustment is made. If the deviation exceeds 10%, the speed is adjusted to the command range before a correction command is issued to the orchard power platform 5. The orchard power platform 5 executes the correction command to complete the correction process.

[0032] The self-learning iterative optimization program stored in industrial computer 1 has the following workflow: Figure 5As shown, the industrial control computer 1 automatically records and stores the calculated correction value and the operating speed value during correction. This database data is automatically recorded by the industrial control computer 1. During the correction process, the self-learning iterative optimization program of the industrial control computer 1 automatically records and calculates the correction value, and automatically retrieves the speed value corresponding to the recorded correction value based on the correction value. This set of data is sent to the power platform controller 4 to calculate the lateral offset of the orchard power platform 5 after correction. If the lateral offset is within the allowable range, the correction value and the corresponding speed value in the storage unit remain unchanged. If the lateral offset exceeds the allowable range, the percentage of lateral offset exceeding the limit is automatically calculated, and the speed value corresponding to the correction value is corrected according to this percentage of exceeding the limit. The corrected corresponding speed value replaces the stored speed value, completing the self-learning iterative optimization.

[0033] In practical applications, under complex orchard conditions, panoramic radar 2, blind spot radar 6, right vision camera 7, and left vision camera 8 are used to collect data. A self-designed correction logic operation and self-learning iterative optimization program is built into the industrial control computer 1. Relying on powerful logic operation capabilities and self-learning iterative optimization, the orchard power platform 5 achieves precise positioning and high-precision correction calculation and output. This logic operation method introduces an alarm mechanism for stopping the machine under abnormal conditions, protecting the safety of the operation process. The introduction of a database corresponding to the speed value of the correction value ensures the stability of the operation and provides the possibility for self-learning iterative optimization, effectively ensuring that the orchard power platform 5 can operate efficiently, stably, and safely within the set speed range. In summary, this invention improves the stability, safety, and efficiency of the orchard power platform 5 under complex conditions. The above shows and describes the basic principles, main features, and advantages of this invention. Those skilled in the art should understand that this invention is not limited to the above embodiments. The embodiments and descriptions in the specification are only illustrative of the principles of this invention. Various changes and modifications can be made to this invention without departing from its spirit and scope, and all such changes and modifications fall within the scope of this invention as claimed.

Claims

1. A navigation and correction system for an orchard power platform that integrates positioning and logical operation, characterized in that, It includes an industrial control computer (1), a panoramic radar (2), a mode switch (3), a power platform controller (4), an orchard power platform (5), a blind spot radar (6), a right vision camera (7), and a left vision camera (8); the industrial control computer (1) is connected to the panoramic radar (2), the power platform controller (4), the blind spot radar (6), the right vision camera (7), the left vision camera (8), and the Internet of Things controller (9); the mode switch (3) and the Internet of Things controller (9) are connected to the power platform controller (4); The industrial control computer (1) is installed at the front end of the orchard power platform (5). The industrial control computer (1) stores the relative coordinate data of the main trunk positions of each row of fruit trees in the orchard and the standard operating path driving route received by the Internet of Things controller (9). The industrial control computer (1) receives laser point cloud data collected by the panoramic radar (2) and the blind spot radar (6), defines the position points of the main trunks of the fruit trees on the left and right sides based on the uniformity of the vertical layered points and the curvature of the point cloud, and calculates the relative coordinate values ​​of the position points of the main trunks of the fruit trees on the left and right sides. The industrial control computer (1) calculates the distance between the orchard power platform (5) and the main trunks of the fruit trees on the left and right sides using the built-in formula based on the calculated relative coordinate values ​​of the main trunks of the fruit trees. Then, it compares the calculated coordinate values ​​of the main trunks of the fruit trees with the coordinate values ​​of the main trunks of the fruit trees inside. Based on different deviation ratios, it calculates the weight value. If the deviation is too large, it selects the main trunks of the adjacent fruit trees as the basis for calculating the weight value. Based on the calculated weight value, it uses the built-in formula to calculate the relative lateral coordinate value of the orchard power platform (5). The industrial control computer (1) calculates the correction amount based on the calculated lateral coordinate value of the orchard power platform (5) and the offset of the stored standard operating path. Based on the correction amount, it automatically retrieves the corresponding maximum operating speed value stored internally and sends the operating speed value and correction amount instruction to the power platform controller (4) at the same time. Meanwhile, in order to avoid frequent changes in speed value and cause shock to the operation of the orchard power platform (5), it does not adjust within a speed value deviation range of 10%. During the correction process, the self-learning iterative optimization program of the industrial control computer (1) automatically records and calculates the correction value, and automatically retrieves the speed value corresponding to the recorded correction value based on the correction value. The set of correction value and corresponding speed value is sent to the power platform controller (4) to calculate the lateral offset of the orchard power platform (5) after correction. If the lateral offset is within the allowable range, the correction value and corresponding speed value in the storage unit are not changed. If the lateral offset exceeds the allowable range, the percentage of lateral offset exceeding the limit is automatically calculated, and the speed value corresponding to the correction value is corrected according to this percentage of exceeding the limit. The corrected corresponding speed value replaces the stored speed value to complete the self-learning iterative optimization.

2. The orchard power platform fusion positioning and logic operation navigation correction system according to claim 1, characterized in that, The industrial control computer (1) calculates the coordinates P1 of the main trunk positions on the left and right sides by performing a horizontal weighted calculation on the main trunk positions of the fruit trees to find the center. , P2 , The calculated coordinates of the main trunk of the fruit tree are compared with the stored coordinates of the main trunk of the fruit tree. The coordinate data with an offset of more than 30% is downweighted, and the coordinate data with an offset of more than 50% is treated as invalid information. The adjacent main trunk of the fruit tree is scanned and its coordinate value is calculated as the positioning calculation reference of the orchard power platform (5).

3. The orchard power platform fusion positioning and logic operation navigation correction system according to claim 2, characterized in that, The distances between the orchard power platform (5) and the main trunks of the fruit trees on the left and right sides are as follows: = = in: The coordinate distance between the orchard power platform (5) and the location of the main trunk of the fruit tree on the left; The coordinate distance between the orchard power platform (5) and the location of the main trunk of the fruit tree on the right; The lateral coordinate value for the distance measurement of the orchard power platform (5); The ordinate of the distance measurement for the orchard power platform (5); The industrial control computer (1) calculates the weights according to the following formula: in: The coordinates of the main trunk of the fruit tree on the left side of the orchard power platform (5) are P1( , Weight values; The coordinates of the main trunk of the fruit tree on the right side of the orchard power platform (5) are P2 ( , Weight values; The distance is a power of 1.5, and the weight value is automatically calculated. It is a very small positive number; the industrial control computer (1) uses the horizontal coordinate fusion formula: in For the orchard power platform (5), the horizontal coordinate values ​​are calculated. , The coordinates of point Q1, which is the innermost point of the tree canopy. , Q2 , The horizontal coordinates of the orchard power platform (5) are calculated according to the above formula.

4. The orchard power platform fusion positioning and logic operation navigation correction system according to claim 3, characterized in that, The industrial control computer (1) removes invalid interference information such as weeds and small branches from the point cloud data collected by the panoramic radar (2) and the blind spot radar (6) as well as the images collected by the right visual camera (7) and the left visual camera (8), extracts the tree crown features, and calculates the coordinates Q1 of the innermost point of the tree crown. , Q2 , ),calculate Value, if In the formula H The maximum width of the orchard power platform and machinery indicates that the row spacing is significantly smaller than the passable width.

5. The orchard power platform fusion positioning and logic operation navigation correction system according to claim 4, characterized in that, If the row spacing is normal, the industrial control computer (1) performs the fusion according to the formula: ,in To integrate and calculate the horizontal coordinate values ​​under different operating modes; l To determine the pre-offset of the work path under different modes, the coordinates of the work path of the orchard power platform (5) are calculated, and the actual work path driving line is fitted according to the least squares method.

6. The orchard power platform fusion positioning and logic operation navigation correction system according to claim 5, characterized in that, The power platform controller (4) receives the correction command and the operating speed command from the industrial control computer (1). The power platform controller (4) first executes the operation speed value adjustment command, first adjusts the operation speed of the orchard power platform (5) to the operation speed value output by the industrial control computer (1), and then executes the correction data command to avoid the correction amplitude being too large when the operation speed is too high.

Citation Information

Patent Citations

  • Orchard vehicle automatic navigation system based on laser radar and machine vision fusion

    CN117774708A

  • An orchard track power platform automatic navigation correction system

    CN120840731B

  • Navigation control method and device of agricultural machine, electronic equipment, medium and agricultural machine

    CN120871863A

  • Method and apparatus for lane recognition for a vehicle

    US20110040468A1