A plant protection robot autonomous navigation path planning system and method

Through the autonomous navigation path planning system of the plant protection robot, GPS and visual sensors are used to achieve accurate positioning and autonomous navigation of orchard operations, solving the problems of inaccurate positioning and weak obstacle avoidance capabilities, and improving the efficiency and safety of orchard spraying operations.

CN118707961BActive Publication Date: 2024-11-15JIANGSU COCON TECH +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411200889.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-29
Publication Date
2024-11-15
Estimated Expiration
2044-08-29

AI Technical Summary

Technical Problem

The existing plant protection robots have problems such as inaccurate positioning, weak obstacle avoidance ability and low operation efficiency in orchard operations.

Method used

Adopt the autonomous navigation path planning system of the plant protection robot, including the path planning unit, the autonomous navigation unit and the automatic obstacle avoidance unit, and obtain global location and environmental data through GPS terminals and visual sensors, calculate the optimal spray path, and identify and real-time during the operation process. Avoid obstacles and adjust the direction and speed of travel.

Benefits of technology

It improves the efficiency and accuracy of orchard spraying operations, realizes the precise positioning and autonomous navigation of the robot in the orchard, enhances obstacle avoidance capabilities, and ensures the stability and safety of the operation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118707961B_ABST
    Figure CN118707961B_ABST
Patent Text Reader

Abstract

The invention discloses an autonomous navigation path planning system and method for a plant protection robot, and relates to the technical field of plant protection robots. In order to solve the problems of inaccurate positioning, weak obstacle avoidance ability, and low operating efficiency of existing plant protection robots when performing orchard operations; an autonomous navigation path planning system for a plant protection robot includes a path planning unit, an autonomous navigation unit, an automatic obstacle avoidance unit, and a travel braking unit; the robot's operating path is accurately planned by the path planning unit, and a visual auxiliary device realizes autonomous navigation and intelligent obstacle avoidance, thereby improving the operating efficiency and safety of the plant protection robot; the autonomous navigation unit and the automatic obstacle avoidance unit enable the plant protection robot to operate according to the optimal path, further improving the operating efficiency; the travel braking unit makes the robot more stable and safe during the travel process, obtains the braking result in real time, and performs data feedback, thereby ensuring the control accuracy of the robot during the travel process.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of plant protection robots, and in particular to an autonomous navigation path planning system and method for a plant protection robot. Background Art

[0002] With the advancement of agricultural modernization, plant protection robots are increasingly used in orchard spraying operations. Regarding plant protection robots, a Chinese patent with publication number CN111784597A discloses a method for detecting an autonomous navigation path for a plant protection robot, which includes the following steps: collecting images; performing segmentation preprocessing on the images; dividing the ridges into regions, using morphological operations for noise reduction, extracting the ridge edges, and then using a dynamic area threshold noise reduction method for further noise reduction; using the mean method to extract feature point clusters, optimizing the feature point clusters, and obtaining the optimal feature point set; and using the least squares method combined with the RANSAC rejection algorithm to extract the navigation path.

[0003] Although the above patent improves detection accuracy by eliminating outliers through the RANSAC rejection algorithm, existing plant protection robots often have problems such as inaccurate positioning, weak obstacle avoidance capabilities, and low operating efficiency when performing orchard operations. Summary of the invention

[0004] The purpose of the present invention is to provide a plant protection robot autonomous navigation path planning system and method, which can achieve precise positioning and autonomous navigation in the orchard, and at the same time combine the path planning plan to realize automatic obstacle avoidance and autonomous operation, greatly improving the efficiency and accuracy of orchard spraying operations, so as to solve the problems raised in the above background technology.

[0005] To achieve the above object, the present invention provides the following technical solutions:

[0006] An autonomous navigation path planning system for a plant protection robot, comprising:

[0007] A path planning unit is used to obtain the global position information of the plant protection robot, calculate the optimal spraying path of the plant protection robot according to the global position information and fruit tree information, and generate a spraying operation plan for the plant protection robot;

[0008] An autonomous navigation unit, used to obtain a spraying operation plan of the plant protection robot, determine path planning data of the plant protection robot based on the spraying operation plan, and issue a travel instruction based on the real-time position information of the plant protection robot;

[0009] The automatic obstacle avoidance unit is used to obtain the orchard environment image where the plant protection robot is located according to the visual auxiliary device during the operation process, identify obstacles in the orchard environment image, determine the obstacle data based on the recognition result, and obtain the obstacle avoidance instruction;

[0010] The travel braking unit is used to adjust the travel direction and speed of the plant protection robot based on the travel instructions issued by the autonomous navigation unit, and to control the plant protection robot to bypass obstacles and continue working based on the obstacle avoidance instructions issued by the automatic obstacle avoidance unit, and to obtain the braking results in real time and provide data feedback.

[0011] Furthermore, the path planning unit comprises:

[0012] A positioning module is used to install a GPS terminal in the plant protection robot and obtain the global position information of the plant protection robot based on the GPS terminal;

[0013] A map construction module is used to construct an operation area map based on the acquired position information and sensor data, and to identify the position of each plant protection robot in the operation area map based on the global position information of the plant protection robot;

[0014] The plant protection operation planning module is used to obtain the information and operation requirements of each fruit tree in the operation area map, plan the plant protection tasks based on the information and operation requirements of each fruit tree, and generate a spraying operation plan.

[0015] Furthermore, the plant protection operation planning module generates a spraying operation plan, specifically:

[0016] Determine the spraying operation plan of the plant protection task planning based on the acquired information of each fruit tree and the operation requirements, wherein the spraying operation plan includes detailed information of the starting point, the end point, the path nodes, the spraying method, and the spraying amount;

[0017] Adding the spraying operation plan to the operation area map, displaying each starting point, end point and path node in the operation area map, and determining the plant protection operation route and maximum driving speed of the spraying operation plan;

[0018] Analyze the spraying operation plan on the spraying path, determine the priority of each plant protection task in the spraying operation plan, arrange the plant protection tasks based on the priority, and execute the plant protection tasks based on the plant protection task arrangement list;

[0019] When executing the plant protection task, the operation requirements corresponding to the plant protection task are determined based on the global position information of the plant protection robot, and the plant protection robot is matched based on the operation requirements, wherein there is at least one plant protection robot.

[0020] Furthermore, the autonomous navigation unit comprises:

[0021] The environmental perception module is used to read the spraying operation plan and extract key information, and obtain the environmental data around the plant protection robot through the sensors installed on the plant protection robot;

[0022] The positioning and navigation module is used to calculate the actual travel route of the plant protection robot based on the received spraying operation plan and environmental data, obtain the location information of the plant protection robot in real time, and provide travel instructions for the plant protection robot.

[0023] Furthermore, the automatic obstacle avoidance unit comprises:

[0024] The obstacle recognition module is used to obtain the orchard environment image where the plant protection robot is located, and to identify obstacles in the acquired environment image based on the data types of fruits, vegetables and obstacles;

[0025] An obstacle analysis module, used to determine obstacle features based on the recognition results, and determine whether the plant protection robot should avoid the obstacle based on the obstacle features;

[0026] The obstacle avoidance decision module is used to obtain the avoidance instruction uploaded by the obstacle recognition module, and determine the obstacle avoidance instruction of the plant protection robot based on the plant protection operation route and the maximum driving speed of the spraying operation plan.

[0027] Furthermore, the obstacle avoidance decision module also includes:

[0028] Controlling the obstacle avoidance travel angle of the plant protection robot, and correcting the travel angle of the plant protection robot based on the plant protection operation route after avoiding the obstacle;

[0029] Extracting historical data consistent with the current plant protection task from the historical pesticide spraying operation plan, and acquiring a historical travel speed list and a historical travel path list of the plant protection robot based on the historical data;

[0030] Generate a recommended travel speed range and a recommended travel path based on the historical travel speed list and historical travel path of the plant protection robot, and generate an obstacle avoidance plan;

[0031] And during the movement of the plant protection robot, it is analyzed whether the behavior of the plant protection robot conforms to the obstacle avoidance solution.

[0032] Furthermore, the obstacle avoidance decision module also includes:

[0033] A first obstacle information acquisition module is used to acquire the straight-line distance between the current plant protection robot and the obstacle as the first obstacle information after the plant protection robot recognizes the obstacle;

[0034] A second obstacle information acquisition module is used to acquire a direction angle between a traveling direction of the plant protection robot and a direction corresponding to a straight-line distance between the plant protection robot and an obstacle avoidance edge closest to the obstacle, as second obstacle information;

[0035] The third obstacle information acquisition module is used to acquire the current running speed and speed change rate of the plant protection robot as the third obstacle information;

[0036] An obstacle avoidance travel angle acquisition module is used to obtain an obstacle avoidance travel angle using the first obstacle information, the second obstacle information and the third obstacle information; wherein the obstacle avoidance travel angle is obtained by the following formula;

[0037]

[0038] Wherein, α represents the obstacle avoidance travel angle; α0 represents the direction angle between the travel direction of the plant protection robot and the direction corresponding to the straight-line distance between the obstacle avoidance edge closest to the plant protection robot and the obstacle; L represents the straight-line distance between the current plant protection robot and the obstacle; V d Indicates the current running speed of the plant protection robot; V max represents the maximum speed at which the plant protection robot can travel; p represents the average speed change rate of the plant protection robot;

[0039] The first travel angle adjustment module is used to adjust the travel angle of the plant protection robot according to the obstacle avoidance travel angle, wherein the adjustment direction of the travel angle is opposite to the position of the obstacle relative to the plant protection robot.

[0040] Furthermore, the obstacle avoidance decision module also includes:

[0041] An obstacle crossing judgment module is used to judge in real time whether the plant protection robot has crossed an obstacle;

[0042] A travel angle difference acquisition module, used to acquire the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot when the plant protection robot crosses an obstacle;

[0043] The travel angle adjustment gradient value acquisition module is used to obtain the travel angle adjustment gradient value of the plant protection robot according to the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot, wherein the travel angle adjustment gradient value of the plant protection robot is obtained by the following formula:

[0044]

[0045] Among them, α t Indicates the gradient value of the plant protection robot’s travel angle adjustment; V dc represents the running speed of the plant protection robot after the plant protection robot passes over the obstacle; α c Indicates the travel angle difference between the current driving direction of the plant protection robot and the planned path of the plant protection robot; αt0 Indicates the preset initial value of the travel angle adjustment gradient;

[0046] The second travel angle adjustment module is used to adjust the travel angle of the plant protection robot according to the travel angle adjustment gradient value of the plant protection robot according to one adjustment gradient per unit time, so that the travel angle of the plant protection robot is restored to the planned path, wherein the unit time is 1s.

[0047] Furthermore, the travel brake unit comprises:

[0048] The decision-making module is used to make real-time decisions and judgments based on the received information and data, and issue specific control instructions according to the decision results to guide the plant protection robot to move autonomously and spray pesticides according to the planned path;

[0049] The speed control module is used to obtain the control instructions of the decision-making module in real time, extract the target data in the control instructions to determine the moving speed and travel angle of the plant protection robot, and at the same time, obtain the data actively uploaded by the automatic obstacle avoidance unit to optimize the travel speed of the plant protection robot;

[0050] The position correction module is used to obtain the current position information of the plant protection robot in real time and compare the position with the planned path. When the comparison result deviates, the deviation value is compared with the preset threshold to determine whether it exceeds the preset threshold and make corrections in time;

[0051] The feedback module is used to obtain the braking results of the travel braking unit in real time, including the robot's current position, speed, whether it successfully avoids obstacles, spraying effect, etc., and feed back the obtained braking results to the decision module for decision-making and adjustment.

[0052] The present invention provides another technical solution, a method for autonomous navigation path planning of a plant protection robot, comprising the following steps:

[0053] Step 1: Install a GPS terminal and a visual sensor on the plant protection robot, turn on the GPS terminal to obtain the initial position information of the plant protection robot, turn on the visual sensor to capture the orchard environment image;

[0054] Step 2: Use image processing technology to identify obstacles and target crops, and calculate the optimal operation path based on the identification results and the path planning of the pesticide spraying operation plan based on the plant protection robot;

[0055] Step 3: The plant protection robot performs spraying operations according to the calculated optimal path, and during the operation, it updates the position and obstacle information in real time to achieve automatic obstacle avoidance and autonomous operation.

[0056] Compared with the prior art, the present invention has the following beneficial effects:

[0057] The path planning unit accurately plans the robot's operating path to improve operating efficiency. The visual assistance device realizes autonomous navigation and intelligent obstacle avoidance, which improves the operating efficiency and safety of the plant protection robot. The autonomous navigation unit and automatic obstacle avoidance unit enable the plant protection robot to operate according to the optimal path, further improving operating efficiency. At the same time, the travel braking unit makes the robot more stable and safe during travel, obtains braking results in real time and provides data feedback, ensuring the control accuracy of the robot during travel and detecting abnormal situations in a timely manner. BRIEF DESCRIPTION OF THE DRAWINGS

[0058] Figure 1 This is a module diagram of the plant protection robot autonomous navigation path planning system of the present invention;

[0059] Figure 2 This is a flow chart of the automatic obstacle avoidance unit of the present invention. DETAILED DESCRIPTION

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

[0061] In order to solve the technical problems of inaccurate positioning, weak obstacle avoidance and low operating efficiency of existing plant protection robots when performing orchard operations, please refer to Figure 1-Figure 2 , this embodiment provides the following technical solutions:

[0062] An autonomous navigation path planning system for a plant protection robot, comprising:

[0063] The path planning unit is used to obtain the global position information of the plant protection robot, provide basic data for path planning, calculate the optimal spraying path of the plant protection robot based on the global position information and fruit tree information, and generate a spraying operation plan for the plant protection robot;

[0064] The autonomous navigation unit is used to obtain the spraying operation plan of the plant protection robot, wherein the basic data includes the robot's surrounding environment data, travel route data, and travel speed data; the path planning data of the plant protection robot is determined based on the spraying operation plan; and a travel instruction is issued based on the real-time position information of the plant protection robot, including:

[0065] The environmental perception module is used to read the spraying operation plan and extract key information. It obtains the environmental data around the plant protection robot through the sensors installed on the plant protection robot, including the location, shape, size, terrain characteristics of obstacles, and other factors that may affect the robot's navigation;

[0066] The positioning and navigation module is used to calculate the actual travel route of the plant protection robot based on the received spraying operation plan and environmental data, obtain the location information of the plant protection robot in real time, and provide travel instructions for the plant protection robot;

[0067] The automatic obstacle avoidance unit is used to obtain the orchard environment image where the plant protection robot is located according to the visual auxiliary device during the operation process, identify obstacles in the orchard environment image, determine the obstacle data based on the recognition result, and obtain the obstacle avoidance instruction;

[0068] The travel braking unit is used to adjust the travel direction and speed of the plant protection robot based on the travel instructions issued by the autonomous navigation unit, and to control the plant protection robot to bypass obstacles and continue working based on the obstacle avoidance instructions issued by the automatic obstacle avoidance unit, and to obtain the braking results in real time and provide data feedback.

[0069] In this embodiment, the robot's operating path is accurately planned through the path planning unit to improve operating efficiency. The visual auxiliary device realizes autonomous navigation and intelligent obstacle avoidance, thereby improving the operating efficiency and safety of the plant protection robot. The autonomous navigation unit and the automatic obstacle avoidance unit enable the plant protection robot to operate according to the optimal path, further improving the operating efficiency. At the same time, the travel braking unit makes the robot more stable and safe during the movement process, obtains the braking results in real time and provides data feedback, thereby ensuring the control accuracy of the robot during the movement process and detecting abnormal situations in time.

[0070] In this embodiment, the path planning unit includes:

[0071] The positioning module is used to install a GPS terminal in the plant protection robot. Based on the GPS terminal, the global position information of the plant protection robot is obtained, so that the position of each plant protection robot in the operation area can be accurately known, providing basic data for subsequent path planning and operation;

[0072] The map construction module is used to construct a map of the operation area based on the acquired location information and sensor data, such as lidar, depth camera, etc., to represent information such as terrain, obstacles, and fruit tree distribution. In addition, the position of each plant protection robot is marked in the operation area map based on the global position information of the plant protection robot, which can reduce the blind movement of the robot when searching for a target or path, thereby improving the operation efficiency.

[0073] The plant protection operation planning module is used to obtain the information and operation requirements of each fruit tree in the operation area map, plan the plant protection tasks based on the information and operation requirements of each fruit tree, and generate a spraying operation plan, including detailed information such as the starting point, end point, path nodes, spraying method, and spraying amount;

[0074] In this embodiment, the plant protection operation planning module generates a spraying operation plan, specifically:

[0075] Determine the spraying operation plan of the plant protection task planning based on the acquired information of each fruit tree and the operation requirements, wherein the spraying operation plan includes detailed information of the starting point, the end point, the path nodes, the spraying method, and the spraying amount;

[0076] Adding the spraying operation plan to the operation area map, displaying each starting point, end point and path node in the operation area map, and determining the plant protection operation route and maximum driving speed of the spraying operation plan;

[0077] Analyzing the spraying operation plan on the spraying path and determining the priority of each plant protection task in the spraying operation plan can ensure that urgent or important tasks are processed first, further improving operation efficiency, and arranging the plant protection tasks based on the priority, and executing the plant protection tasks based on the plant protection task arrangement list can optimize the operation sequence and reduce conflicts and waiting time between robots;

[0078] When executing the plant protection task, the operation requirements corresponding to the plant protection task are determined based on the global position information of the plant protection robot, and the plant protection robot is matched based on the operation requirements, wherein there is at least one plant protection robot, and the corresponding plant protection robot is accurately matched to ensure that each robot can play its maximum role.

[0079] In this embodiment, by constructing a regional map to suit different orchard environments, an intuitive view of the work area can be provided to operators, which is convenient for task allocation and monitoring. A spraying operation plan is generated based on fruit tree information and operation requirements, which can ensure that each fruit tree is properly treated while avoiding unnecessary duplication or omissions, reducing manual intervention, improving operation efficiency, and ensuring the uniformity and accuracy of spraying operations. The spraying method and amount can be adjusted according to different fruit tree types, growth stages, and pest and disease conditions. It has high flexibility and customizability, realizes autonomous navigation and precise operation of the plant protection robot, greatly improves the efficiency and accuracy of orchard management, and provides strong technical support for modern agricultural production.

[0080] In this embodiment, the automatic obstacle avoidance unit includes:

[0081] The obstacle recognition module is used to obtain the orchard environment image where the plant protection robot is located, and to identify obstacles in the acquired environment image based on the data types of fruits, vegetables and obstacles;

[0082] The obstacle analysis module is used to determine the obstacle characteristics based on the recognition results, including the location, size, shape and other data of the obstacle, and judge whether the plant protection robot should avoid the obstacle based on the obstacle characteristics, and judge reference factors such as the distance, speed and current state of the robot;

[0083] The obstacle avoidance decision module is used to obtain the avoidance instruction uploaded by the obstacle recognition module, and determine the obstacle avoidance instruction of the plant protection robot based on the plant protection operation route and the maximum driving speed of the spraying operation plan;

[0084] In this embodiment, the obstacle avoidance decision module further includes:

[0085] Controlling the obstacle avoidance travel angle of the plant protection robot, and correcting the travel angle of the plant protection robot based on the plant protection operation route after avoiding the obstacle;

[0086] Extracting historical data consistent with the current plant protection task from the historical pesticide spraying operation plan, and acquiring a historical travel speed list and a historical travel path list of the plant protection robot based on the historical data;

[0087] Based on the historical travel speed list and historical travel path of the plant protection robot, a recommended travel speed range and a recommended travel path are generated, and an obstacle avoidance plan is generated. By analyzing historical data, past successful obstacle avoidance experience and strategies can be used for reference to provide a more reliable obstacle avoidance plan for the current task, which can better adapt to different orchard environments and obstacle conditions, and improve the accuracy and adaptability of obstacle avoidance decisions;

[0088] And during the movement of the plant protection robot, it is analyzed whether the behavior of the plant protection robot conforms to the obstacle avoidance solution.

[0089] In this embodiment, the obstacle recognition module is used to capture the orchard environment image in real time to ensure the immediate recognition of obstacles. By analyzing the various characteristics of obstacles, obstacles and fruits and vegetables can be accurately distinguished to reduce misjudgment, which can ensure that the robot chooses the safest path when avoiding obstacles. The intelligent obstacle avoidance function of the plant protection robot in the orchard environment is realized. After avoiding the obstacle, the robot's travel angle is corrected based on the original plant protection operation route, so that it can return to the original operation route as soon as possible, thereby ensuring the continuity and efficiency of the spraying operation. This not only improves the robot's operating efficiency and accuracy, but also enhances its safety and autonomy, providing strong support for the intelligent management of the orchard.

[0090] Specifically, the obstacle avoidance decision module also includes:

[0091] A first obstacle information acquisition module is used to acquire the straight-line distance between the current plant protection robot and the obstacle as the first obstacle information after the plant protection robot recognizes the obstacle;

[0092] A second obstacle information acquisition module is used to acquire a direction angle between a traveling direction of the plant protection robot and a direction corresponding to a straight-line distance between the plant protection robot and an obstacle avoidance edge closest to the obstacle, as second obstacle information;

[0093] The third obstacle information acquisition module is used to acquire the current running speed and speed change rate of the plant protection robot as the third obstacle information;

[0094] An obstacle avoidance travel angle acquisition module is used to obtain an obstacle avoidance travel angle using the first obstacle information, the second obstacle information and the third obstacle information; wherein the obstacle avoidance travel angle is obtained by the following formula;

[0095]

[0096] Wherein, α represents the obstacle avoidance travel angle; α0 represents the direction angle between the travel direction of the plant protection robot and the direction corresponding to the straight-line distance between the obstacle avoidance edge closest to the plant protection robot and the obstacle; L represents the straight-line distance between the current plant protection robot and the obstacle; V d Indicates the current running speed of the plant protection robot; V max represents the maximum speed at which the plant protection robot can travel; p represents the average speed change rate of the plant protection robot;

[0097] The first travel angle adjustment module is used to adjust the travel angle of the plant protection robot according to the obstacle avoidance travel angle, wherein the adjustment direction of the travel angle is opposite to the position of the obstacle relative to the plant protection robot.

[0098] The technical effects of the above technical solution are: Real-time obstacle information acquisition: The first and second obstacle information acquisition modules can obtain the straight-line distance and direction angle between the plant protection robot and the obstacle in real time, providing accurate data support for subsequent obstacle avoidance decisions. This real-time performance ensures the timeliness and accuracy of obstacle avoidance decisions. The third obstacle information acquisition module takes into account the current operating speed and speed change rate of the plant protection robot, which is an important factor that cannot be ignored when formulating obstacle avoidance strategies. Incorporating the robot's operating status into the decision-making process can ensure that the obstacle avoidance decision matches the robot's actual motion state, thereby improving the obstacle avoidance effect.

[0099] The obstacle avoidance travel angle acquisition module uses the acquired obstacle information and robot operation status information to calculate the obstacle avoidance travel angle through a specific formula. This calculation method based on comprehensive consideration of multiple factors can produce a more reasonable and effective obstacle avoidance strategy. The first travel angle adjustment module accurately adjusts the travel angle of the plant protection robot according to the calculated obstacle avoidance travel angle. The adjustment direction is in the opposite direction of the position of the obstacle relative to the plant protection robot, which helps the robot effectively avoid obstacles and ensure safe driving.

[0100] In summary, this technical solution achieves fast, accurate and effective obstacle avoidance decision-making when the plant protection robot encounters obstacles by acquiring obstacle information and robot operation status information in real time, combined with intelligent calculation and adjustment strategies. This can not only improve the working efficiency of the plant protection robot, but also reduce the risk of robot damage or mission failure caused by improper obstacle avoidance.

[0101] Specifically, the obstacle avoidance decision module also includes:

[0102] An obstacle crossing judgment module is used to judge in real time whether the plant protection robot has crossed an obstacle;

[0103] A travel angle difference acquisition module, used to acquire the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot when the plant protection robot crosses an obstacle;

[0104] The travel angle adjustment gradient value acquisition module is used to obtain the travel angle adjustment gradient value of the plant protection robot according to the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot, wherein the travel angle adjustment gradient value of the plant protection robot is obtained by the following formula:

[0105]

[0106] Among them, α t Indicates the gradient value of the plant protection robot’s travel angle adjustment; V dc represents the running speed of the plant protection robot after the plant protection robot passes over the obstacle; α c Indicates the travel angle difference between the current driving direction of the plant protection robot and the planned path of the plant protection robot; α t0 Indicates the preset initial value of the travel angle adjustment gradient;

[0107] The second travel angle adjustment module is used to adjust the travel angle of the plant protection robot according to the travel angle adjustment gradient value of the plant protection robot according to one adjustment gradient per unit time, so that the travel angle of the plant protection robot is restored to the planned path, wherein the unit time is 1s.

[0108] The technical effect of the above technical solution is: through the obstacle crossing judgment module, the plant protection robot can judge in real time whether it has successfully crossed the obstacle. This real-time judgment capability ensures that the robot can quickly make subsequent decisions after avoiding obstacles, and improves the robot's response speed and efficiency. After the plant protection robot crosses the obstacle, the travel angle difference acquisition module can obtain the travel angle difference between the current robot travel speed and the planned path. This information provides key data for the robot to return to the planned path. The second travel angle adjustment module accurately adjusts the robot's travel angle based on this information to ensure that the robot can quickly and accurately return to the planned path and continue to perform the scheduled task. The travel angle adjustment gradient value acquisition module can intelligently calculate the adjustment gradient value of the travel angle based on the robot's travel speed and travel angle difference. This dynamic adjustment strategy based on real-time data makes the robot's path recovery smoother and more efficient, and avoids path deviation or oscillation caused by excessive or too small angle adjustment. The travel angle adjustment module adjusts the robot's travel angle in a manner of one adjustment gradient per unit time (such as 1 second). This precise timing control ensures the continuity and stability of angle adjustments, helping the robot to smoothly and quickly return to the planned path.

[0109] In summary, this technical solution enables the plant protection robot to quickly and accurately restore its path after crossing an obstacle by judging the obstacle crossing status in real time, obtaining the travel angle difference, intelligently calculating the adjustment gradient value, and accurately controlling the adjustment time. This not only improves the robot's work efficiency and stability, but also reduces the risk of mission failure caused by path deviation.

[0110] In this embodiment, the travel brake unit includes:

[0111] The decision-making module is used to make real-time decisions and judgments based on the received information and data, and issue specific control instructions according to the decision results to guide the plant protection robot to move autonomously and spray pesticides according to the planned path;

[0112] The speed control module is used to obtain the control instructions of the decision-making module in real time, extract the target data in the control instructions to determine the moving speed and travel angle of the plant protection robot. When the robot needs to accelerate, decelerate or maintain the current speed, the speed control module will adjust the robot's power system to ensure that the robot can move at the required speed. At the same time, it obtains the data actively uploaded by the automatic obstacle avoidance unit, including factors such as terrain, obstacle density and pesticide application requirements, to optimize the travel speed of the plant protection robot to improve work efficiency and quality;

[0113] The position correction module is used to obtain the current position information of the plant protection robot in real time and compare the position with the planned path. When the comparison result deviates, the deviation value is compared with the preset threshold to determine whether it exceeds the preset threshold and make corrections in time. By adjusting the robot's direction and speed, the position correction module ensures that the robot can move along the planned path more accurately and reduce deviations and errors.

[0114] The feedback module is used to obtain the braking results of the travel braking unit in real time, including the robot's current position, speed, whether it successfully avoids obstacles, spraying effect, etc., and feed back the obtained braking results to the decision module for decision-making and adjustment.

[0115] In this embodiment, according to the current environment, task requirements and robot status, the decision-making module needs to determine whether it is necessary to adjust the travel direction, speed, or perform obstacle avoidance operations. The speed control module takes into account factors such as work requirements, terrain conditions, and robot performance to ensure that the robot maintains a stable speed during movement, or accelerates or decelerates as needed, and sends a speed control signal to the power system of the plant protection robot to adjust the robot's travel speed and perform real-time position correction of the plant protection robot. Based on the instructions of autonomous navigation and automatic obstacle avoidance, the travel direction and speed are accurately controlled. When encountering obstacles, it can avoid obstacles in a timely and effective manner to ensure the smooth progress of the spraying operation. At the same time, through real-time data feedback and optimization strategies, the performance and operation efficiency of the plant protection robot are continuously improved.

[0116] The present invention provides another technical solution, a method for autonomous navigation path planning of a plant protection robot, comprising the following steps:

[0117] Step 1: Install a GPS terminal and a visual sensor on the plant protection robot, turn on the GPS terminal to obtain the initial position information of the plant protection robot, turn on the visual sensor to capture the orchard environment image;

[0118] Step 2: Obstacles and target crops are identified through image processing technology. Based on the identification results and the path planning of the pesticide spraying operation plan based on the plant protection robot, the optimal operation path is calculated, which not only takes into account the operation efficiency, but also the safety and obstacle avoidance requirements;

[0119] Step 3: The plant protection robot performs spraying operations according to the calculated optimal path, and during the operation, it updates the position and obstacle information in real time to achieve automatic obstacle avoidance and autonomous operation. Based on the real-time updated information, the robot can independently decide whether to adjust the operation path. For example, if it is found that the distribution of target crops has changed or new obstacles have appeared, the robot will re-plan the path to adapt to these changes. It not only has a high level of autonomy and intelligence, but can also make real-time adjustments and optimizations according to actual conditions, thereby ensuring the smooth progress of spraying operations and the effectiveness of orchard management.

[0120] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.

Claims

1. An autonomous navigation path planning system for a plant protection robot, characterized in that: include: A path planning unit is used to obtain the global position information of the plant protection robot, calculate the optimal spraying path of the plant protection robot according to the global position information and fruit tree information, and generate a spraying operation plan for the plant protection robot; An autonomous navigation unit, used to obtain a spraying operation plan of the plant protection robot, determine path planning data of the plant protection robot based on the spraying operation plan, and issue a travel instruction based on the real-time position information of the plant protection robot; The automatic obstacle avoidance unit is used to obtain the orchard environment image where the plant protection robot is located according to the visual auxiliary device during the operation, identify obstacles in the orchard environment image, determine the obstacle data based on the recognition result, and obtain the obstacle avoidance instruction; A travel braking unit, used to adjust the travel direction and speed of the plant protection robot based on the travel instructions issued by the autonomous navigation unit, and to control the plant protection robot to bypass obstacles and continue working based on the obstacle avoidance instructions issued by the automatic obstacle avoidance unit, and to obtain the braking results in real time and provide data feedback; Automatic obstacle avoidance unit, including: The obstacle recognition module is used to obtain the orchard environment image where the plant protection robot is located, and to identify obstacles in the acquired environment image based on the data types of fruits, vegetables and obstacles; An obstacle analysis module, used to determine obstacle features based on the recognition results, and determine whether the plant protection robot should avoid the obstacle based on the obstacle features; The obstacle avoidance decision module is used to obtain the avoidance instruction uploaded by the obstacle recognition module, and determine the obstacle avoidance instruction of the plant protection robot based on the plant protection operation route and the maximum driving speed of the spraying operation plan; The obstacle avoidance decision module also includes: A first obstacle information acquisition module is used to acquire the straight-line distance between the current plant protection robot and the obstacle as the first obstacle information after the plant protection robot recognizes the obstacle; A second obstacle information acquisition module is used to acquire a direction angle between a traveling direction of the plant protection robot and a direction corresponding to a straight-line distance between the plant protection robot and an obstacle avoidance edge closest to the obstacle, as second obstacle information; The third obstacle information acquisition module is used to acquire the current running speed and speed change rate of the plant protection robot as the third obstacle information; An obstacle avoidance travel angle acquisition module is used to obtain an obstacle avoidance travel angle using the first obstacle information, the second obstacle information and the third obstacle information; wherein the obstacle avoidance travel angle is obtained by the following formula; ; Wherein, α represents the obstacle avoidance travel angle; α0 represents the direction angle between the travel direction of the plant protection robot and the direction corresponding to the straight-line distance between the obstacle avoidance edge closest to the plant protection robot and the obstacle; L represents the straight-line distance between the current plant protection robot and the obstacle; V d Indicates the current running speed of the plant protection robot; V max represents the maximum speed at which the plant protection robot can travel; p represents the average speed change rate of the plant protection robot; A first travel angle adjustment module, used to adjust the travel angle of the plant protection robot according to the obstacle avoidance travel angle, wherein the adjustment direction of the travel angle is opposite to the position of the obstacle relative to the plant protection robot; The obstacle avoidance decision module also includes: An obstacle crossing judgment module is used to judge in real time whether the plant protection robot has crossed an obstacle; A travel angle difference acquisition module is used to acquire the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot when the plant protection robot crosses an obstacle; The travel angle adjustment gradient value acquisition module is used to obtain the travel angle adjustment gradient value of the plant protection robot according to the current travel speed of the plant protection robot and the travel angle difference between the current travel direction of the plant protection robot and the planned path of the plant protection robot, wherein the travel angle adjustment gradient value of the plant protection robot is obtained by the following formula: ; Among them, α t Indicates the gradient value of the plant protection robot’s travel angle adjustment; V dc represents the running speed of the plant protection robot after the plant protection robot passes over the obstacle; α c Indicates the travel angle difference between the current driving direction of the plant protection robot and the planned path of the plant protection robot; α t0 Indicates the preset initial value of the travel angle adjustment gradient; The second travel angle adjustment module is used to adjust the travel angle of the plant protection robot according to the travel angle adjustment gradient value of the plant protection robot according to one adjustment gradient per unit time, so that the travel angle of the plant protection robot is restored to the planned path, wherein the unit time is 1s.

2. The autonomous navigation path planning system for a plant protection robot according to claim 1, characterized in that: Path planning unit, including: A positioning module is used to install a GPS terminal in the plant protection robot and obtain the global position information of the plant protection robot based on the GPS terminal; A map construction module is used to construct an operation area map based on the acquired position information and sensor data, and to identify the position of each plant protection robot in the operation area map based on the global position information of the plant protection robot; The plant protection operation planning module is used to obtain the information and operation requirements of each fruit tree in the operation area map, plan the plant protection tasks based on the information and operation requirements of each fruit tree, and generate a spraying operation plan.

3. The autonomous navigation path planning system for a plant protection robot according to claim 2, characterized in that: The plant protection operation planning module generates a spraying operation plan, specifically: Determine the spraying operation plan of the plant protection task planning based on the acquired information of each fruit tree and the operation requirements, wherein the spraying operation plan includes a starting point, an end point, a path node, a spraying method, and a spraying amount; Adding the spraying operation plan to the operation area map, displaying each starting point, end point and path node in the operation area map, and determining the plant protection operation route and maximum driving speed of the spraying operation plan; Analyze the spraying operation plan on the spraying path, determine the priority of each plant protection task in the spraying operation plan, arrange the plant protection tasks based on the priority, and execute the plant protection tasks based on the plant protection task arrangement list; When executing the plant protection task, the operation requirements corresponding to the plant protection task are determined based on the global position information of the plant protection robot, and the plant protection robot is matched based on the operation requirements, wherein there is at least one plant protection robot.

4. The autonomous navigation path planning system for a plant protection robot according to claim 3, characterized in that: Autonomous navigation unit, comprising: The environmental perception module is used to read the spraying operation plan and extract key information, and obtain the environmental data around the plant protection robot through the sensors installed on the plant protection robot; The positioning and navigation module is used to calculate the actual travel route of the plant protection robot based on the received spraying operation plan and environmental data, obtain the location information of the plant protection robot in real time, and provide travel instructions for the plant protection robot.

5. The autonomous navigation path planning system for a plant protection robot according to claim 4, characterized in that: The obstacle avoidance decision module also includes: Controlling the obstacle avoidance travel angle of the plant protection robot, and correcting the travel angle of the plant protection robot based on the plant protection operation route after avoiding the obstacle; Extracting historical data consistent with the current plant protection task from the historical pesticide spraying operation plan, and acquiring a historical travel speed list and a historical travel path list of the plant protection robot based on the historical data; Generate a recommended travel speed range and a recommended travel path based on the historical travel speed list and historical travel path of the plant protection robot, and generate an obstacle avoidance plan; And during the movement of the plant protection robot, it is analyzed whether the behavior of the plant protection robot conforms to the obstacle avoidance solution.

6. The autonomous navigation path planning system for a plant protection robot according to claim 5, characterized in that: Travel brake unit, comprising: The decision control module is used to make real-time decisions and judgments based on the received information and data, and issue specific control instructions according to the decision results to guide the plant protection robot to move autonomously and spray pesticides according to the planned path; The speed control module is used to obtain the control instructions of the decision-making module in real time, extract the target data in the control instructions to determine the moving speed and travel angle of the plant protection robot, and at the same time, obtain the data actively uploaded by the automatic obstacle avoidance unit to optimize the travel speed of the plant protection robot; The position correction module is used to obtain the current position information of the plant protection robot in real time and compare the position with the planned path. When the comparison result deviates, the deviation value is compared with the preset threshold to determine whether it exceeds the preset threshold and make corrections in time; The feedback module is used to obtain the braking results of the travel braking unit in real time, including the robot's current position, speed, whether it successfully avoids obstacles, and the effect of spraying, and feeds the obtained braking results back to the decision module for decision-making and adjustment.

7. A method for autonomous navigation path planning of a plant protection robot, implemented based on the system for autonomous navigation path planning of a plant protection robot according to claim 6, characterized in that: The following steps are involved: Step 1: Install a GPS terminal and a visual sensor on the plant protection robot, turn on the GPS terminal to obtain the initial position information of the plant protection robot, turn on the visual sensor to capture the orchard environment image; Step 2: Use image processing technology to identify obstacles and target crops, and calculate the optimal operation path based on the identification results and the path planning of the spraying operation plan based on the plant protection robot; Step 3: The plant protection robot performs spraying operations according to the calculated optimal path, and during the operation, it updates the position and obstacle information in real time to achieve automatic obstacle avoidance and autonomous operation.