Control method for preventing lawn mowing robot from going out of bounds
Through sensor component detection and quadrilateral single grid optimization technology, the problem of mowing robots preventing out of boundaries in complex environments is solved, path planning and obstacle avoidance capabilities are improved, and the safety and efficiency of mowing operations are ensured.
Patent Information
- Application Number
- CN202411090191.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-09
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2044-08-09
AI Technical Summary
In order to prevent out-of-bounds, the mowing robot has problems such as insufficient positioning accuracy, poor environmental adaptability and insufficient algorithm optimization, which may cross the boundary or collide with obstacles.
Sensor components are used to detect boundary lines and obstacles, divide molecular areas and build quadrilateral single grids, adjust grid specifications according to terrain and obstacle conditions, optimize grid quality through formulas, monitor driving paths in real time, judge and prevent out of boundaries.
It improves the accuracy of path planning and obstacle avoidance capabilities of mowing robots in complex environments, reduces the risks of cross-border and collision, and ensures the safety and efficiency of mowing operations.
Smart Images

Figure CN118625813B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of algorithm analysis of lawn mowing robots, and in particular to a lawn mowing robot anti-out-of-bounds control method. Background Art
[0002] Algorithm analysis technology mainly focuses on aspects such as time and space complexity, stability, and correctness, and improves execution efficiency and resource utilization through optimization analysis. Algorithm analysis technology plays a vital role in lawn mowing robots, not only improving the intelligence and automation level of lawn mowing robots, but also significantly improving mowing efficiency and mowing effects.
[0003] With the continuous development of science and technology, algorithm analysis technology will continue to provide strong support for the progress and development of lawn mower robots in the application of lawn mower robots. However, the current lawn mower robots do have some defects in preventing out-of-bounds, including the following aspects: insufficient positioning accuracy, relying only on a single sensor to prevent out-of-bounds; poor environmental adaptability, the path planning and obstacle avoidance algorithms of lawn mower robots may not be fully adapted to complex environments, and may cross the boundary; insufficient algorithm optimization, some lawn mower robots' algorithms may be relatively simple or outdated, unable to cope well with complex environments and boundary changes, and may not be able to respond in time when encountering sudden obstacles, resulting in collisions with obstacles or crossing the boundary. Summary of the invention
[0004] The purpose of the present invention is to solve the problems in the background technology and to propose a method for preventing a lawn mowing robot from going out of bounds.
[0005] In order to achieve the above object, the present invention adopts the following technical solutions:
[0006] The method for preventing a lawn mowing robot from going out of bounds includes:
[0007] Step 1: Equip the lawn mowing robot with a sensor component for boundary line and obstacle detection; wherein the sensor component is composed of a boundary line sensor and an obstacle sensor;
[0008] Step 2: Implement sub-area division, segment the boundaries of the sub-areas and set working nodes, accurately measure the coordinates of the working nodes, and construct a quadrilateral grid;
[0009] Step 3: Based on the terrain and obstacles, the specifications of all quadrilateral cells are adjusted to obtain a minimized local grid; wherein the specifications of the quadrilateral cells include their shape and size, and the specification adjustment includes minimizing the variation of the quadrilateral shapes in the local grid, even if the shapes of all quadrilaterals are similar;
[0010] Step 4: Use the formula to optimize the quality of the minimized local grid and obtain the target area;
[0011] Step 5: Analyze the driving path of the mowing robot according to the target area, obtain abnormal signals, and further determine whether the mowing robot is out of bounds based on the abnormal signals.
[0012] It should be noted that the application object of the lawn mower robot anti-out-of-bounds control method proposed in the present invention can be widely set as monitoring and analysis of outdoor areas such as gardens, lawns, farmlands, etc. that require automated management. It can be used to monitor whether the working status of the lawn mower robot is normal, including its moving path and obstacle avoidance ability. Specifically, it can be through sensor technology and algorithm analysis, the real-time position, surrounding environment, obstacle distance and preset boundary line of the lawn mower robot for comprehensive monitoring and precise analysis, tracking the position of the lawn mower robot, detecting whether the robot is approaching or crossing the preset boundary, identifying boundary marks or obstacles, and intelligently judging whether the lawn mower robot is about to or has gone out of bounds. Once it is found that the lawn mower robot is at risk of going out of bounds or has actually gone out of bounds, measures are taken immediately according to the early warning prompts to intervene in time to ensure the safety and efficiency of the mowing operation.
[0013] Furthermore, the process of equipping the lawn mowing robot with a sensor assembly for boundary line and obstacle detection includes:
[0014] Select the boundary line sensor type according to the working area environment, i.e. electromagnetic wire sensor, visible light or infrared boundary line sensor: for outdoor environment, use electromagnetic wire sensor buried underground; for indoor or temporary scenes, use visible light or infrared boundary line sensor on the ground;
[0015] Arrange boundary lines on the boundaries of the working area, and determine the scope of the working area of the mowing robot by monitoring the boundary lines on the ground or buried underground: for electromagnetic wire sensors buried underground, dig trenches underground and lay electromagnetic wires; for boundary lines on the ground, directly arrange cables or stickers with sensors on the boundaries;
[0016] Calibrate the boundary line sensor, including setting the sensor sensitivity and adjusting the sensor detection range;
[0017] Select the type of obstacle sensor, ultrasonic or infrared, based on the type and characteristics of obstacles in the work area; ultrasonic sensors are used to detect most types of obstacles, while infrared sensors are used to detect transparent or highly reflective obstacles;
[0018] Install ultrasonic or infrared sensors in all potential obstacle areas around the robot mower;
[0019] Set the obstacle sensor's detection distance, detection angle, and sensitivity to obtain obstacle avoidance capabilities;
[0020] When the lawn mower robot is working, the sensor component detects the boundary line position and surrounding obstacles in real time, and the sensor component immediately transmits the detection results to the control module of the lawn mower robot; the control module determines whether it is necessary to adjust the moving path of the lawn mower robot or take other obstacle avoidance measures based on the detection results;
[0021] It is understandable that in the use of lawn mowing robots, choosing the sensor component sensors that best suit the current project needs to assist in detecting boundaries and obstacles is a decision-making process that comprehensively considers technical performance, cost-effectiveness, environmental adaptability, and user needs. It is necessary to find the best balance between multiple factors to ensure that the lawn mowing robot can both meet functional requirements and be economically feasible.
[0022] Furthermore, the process of implementing sub-area division, segmenting the boundaries of the sub-areas and setting working nodes, accurately measuring the coordinates of the working nodes, and constructing a quadrilateral grid includes:
[0023] Implement sub-area division based on the characteristics of the work area, and screen out the boundary lines of the sub-areas evenly or according to rules on the boundaries;
[0024] The boundary lines of the sub-areas are divided into straight segments or curved segments according to the characteristics of the terrain environment;
[0025] Set working nodes in each sub-area, use high-precision measuring tools or equipment to accurately obtain the coordinate information of each working node, and perform special processing or marking on working nodes at special positions on the boundary line, that is, locate the key points of the mowing robot out of bounds;
[0026] Construct a quadrilateral grid with four adjacent working nodes as vertices.
[0027] Furthermore, based on the terrain and obstacles, the specifications of all quadrilateral cells are adjusted to obtain the minimum local grid process including:
[0028] Step Z1: Combine the set vertex coordinates to extract all point sets in the two-dimensional space ;
[0029] Step Z2, set the center coordinates to ,
[0030] in, ;
[0031] Step Z3, measure compactness by the sum of the squares of the distances between the point set and its center:
[0032] ;
[0033] Where C represents the compactness target value; i represents the number of all points, i=1, 2, ..., n; n is a positive integer;
[0034] Step Z4, obtain the four side lengths of the quadrilateral h, which are ;
[0035] Step Z5, define the average side length of the quadrilateral h as:
[0036] ;
[0037] Step Z6: Achieve uniformity by minimizing the variance of the average side lengths of all quadrilaterals:
[0038] ;
[0039] Wherein, U represents the uniformity target value; N represents the number of quadrilateral cells; h represents the number of the quadrilateral cells; j represents the number of the four sides of the quadrilateral cells, j=1, 2, 3, 4; represents the weighted average of the lengths of all quadrilateral sides; The weight representing the length of the quadrilateral side;
[0040] Step Z7: Define a small moving vector , used to update the position of point i;
[0041] Step Z8: Adjust the position of each point through the iterative formula, and then adjust the specifications of the quadrilateral grid:
[0042] ;
[0043] In the formula, and Represents the original coordinates of the i-th point in the point set P; and Represents the new coordinates of the i-th point calculated by the iterative formula; Represents the learning rate, which is used to control the step size of the iteration; and represents the partial derivatives of the uniformity U with respect to the a and b coordinates of point i; and represents the partial derivatives of the compactness C with respect to the a and b coordinates of point i;
[0044] Step Z9, repeat step Z8 to update the coordinates of each point until the stop criterion is met;
[0045] It can be understood that the stopping criterion may be reaching the maximum number of iterations, the change in uniformity and compactness being less than a certain threshold, etc. Each iteration is intended to make the point set closer to the ideal uniform and compact distribution;
[0046] Step Z10: Based on the new coordinates after iteration, determine the side length and angle of the quadrilateral single grid, and integrate them to form a minimized local grid.
[0047] Furthermore, the formula is used to optimize the quality of the minimized local grid, and the process of obtaining the target area includes:
[0048] Introduce a penalty term to minimize the local mesh quality:
[0049] ;
[0050] Where GEI represents the grid quality optimization index; The penalty term introduced is an indicator to measure the complexity of the mesh boundary, which is used to penalize meshes with irregular shapes or complex boundaries; and It represents the maximum and minimum values of the side length of a quadrilateral after iterative calculation, which is used to measure the difference in side length; k represents the side length difference adjustment factor, which is used to adjust the contribution of side length difference to shape regularity; v represents the angle difference adjustment factor, which is used to adjust the contribution of angle difference to shape regularity; Represents the interior angle of a single quadrilateral after iterative calculation; Represents the interior angles of an ideal shape; represents the sum of all interior angles;
[0051] Multiple quality-optimized minimized local meshes are merged into a large mesh set, and the integrated regional mesh fully represents the target area.
[0052] Furthermore, the driving path of the mowing robot is analyzed according to the target area, and the process of obtaining abnormal signals includes:
[0053] Organize the data of the target area into a format that can be automatically recognized by the mowing robot;
[0054] After receiving the optimized grid data, the mowing robot imports it into the control module;
[0055] Determine the target area G, G = ST (x, y) represents the state of the (x, y)th quadrilateral cell; x and y represent the indexes of the row and column; the value of ST (x, y) is: 0 represents an empty space, that is, the mowing robot can pass normally; 1 represents an obstacle; 2 represents the grass has been mowed;
[0056] Pre-process the target area G to identify all the quadrilateral cells where the boundaries and obstacles are located, and regard them as places that the mowing robot cannot reach;
[0057] Update the target area G and automatically skip the quadrilateral cells whose ST(x, y) value is 1;
[0058] Set the starting point Q and the target point E, which represent the initial position and the destination of the mowing robot respectively;
[0059] The shortest path from Q to E is calculated by the function f(g) = t(g) + q(g); where t(g) represents the actual cost from the starting point to the current quadrilateral cell g, and q(g) represents the estimated cost from the current quadrilateral cell to the target point;
[0060] It can be understood that q(g) is a heuristic function that is adjusted according to the unevenness of the terrain. When a quadrilateral cell is far from the nearest obstacle or the terrain is relatively flat, the q(g) value is low;
[0061] Through the function Calculate the minimum cost path from Q to each quadrilateral cell; where d(g) represents the minimum cost from the starting point to the current quadrilateral cell g, e(m, g) represents the cost of moving from quadrilateral cell m to g, M(g) represents the neighbor set of g, and d(m) represents the cost of moving from the starting point to quadrilateral cell m;
[0062] Combine the shortest path and the minimum cost path to generate the target path of the lawn mowing robot π(g) = f(g) + d(g);
[0063] The actual path of the mowing robot is compared with the target path: the deviation ratio is calculated using the formula PL=(Dis / TL)×100%, where PL represents the deviation ratio, Dis represents the total deviation distance between the actual path of the mowing robot and the target path, and TL represents the total length of the target path; a deviation threshold PL0 is defined. If PL is not less than PL0, an abnormal signal is generated, indicating that the actual path of the mowing robot deviates seriously from the target path; if PL is less than PL0, a normal signal is generated, indicating that the actual path of the mowing robot is close to the target path.
[0064] Furthermore, the process of further judging whether the mowing robot is out of bounds in combination with the abnormal signal includes:
[0065] In response to abnormal signals, a high-precision positioning system is used to capture the current position D and next position F of the mowing robot;
[0066] Extract the information of the known boundary quadrilateral cell: distinguish the coordinate positions of the four adjacent vertices of the boundary quadrilateral cell: ;
[0067] In the formula, Represents the coordinates of the upper right vertex of the boundary quadrilateral cell; Represents the coordinates of the lower right vertex of the boundary quadrilateral cell; Represents the coordinates of the upper left vertex of the boundary quadrilateral; Represents the coordinates of the lower left vertex of the boundary quadrilateral cell;
[0068] The preset safe distance L for the lawn mower robot is:
[0069] ;
[0070] In the formula, represents the minimum distance from point F to line segment 13, represents the minimum distance from point F to line segment 14, represents the minimum distance from point F to line segment 24, represents the minimum distance from point F to line segment 23, where Indicates the distance from point F to the line segment;
[0071] According to the early warning function B, the following judgment is made:
[0072] ;
[0073] When the minimum distance from point F to any line segment is less than the safety distance L, B(D, F) = 1, which means that the robot is approaching the boundary and sends out a warning signal; otherwise, B(D, F) = 0, which means that the robot is in the normal operating area and sends out an inquiry signal to further detect whether the mowing robot is out of bounds.
[0074] Investigate the reasons why the mowing robot went out of bounds based on the early warning signals;
[0075] Understandably, the following aspects can be used for troubleshooting: Check robot settings: check the robot's working range, motion trajectory and other settings to confirm whether the robot is out of bounds due to improper settings; analyze sensor data: analyze the robot's equipped sensor components to find possible reasons for the robot's out-of-bounds; check the software program: check the software program that controls the robot to see if there are any logical errors or program loopholes that cause the robot to behave abnormally.
[0076] Compared with the prior art, the advantages of the method for preventing a lawn mowing robot from going out of bounds provided by the present invention are:
[0077] 1. The present invention is equipped with a sensor component to detect boundaries and obstacles, detect and respond in time, reduce the collision between the robot and boundaries or obstacles, and protect the safety of the robot itself and the surrounding environment; by dividing a large working area into multiple small sub-areas, it is convenient to manage and optimize the mowing path; by segmenting the boundaries of the sub-areas and setting working nodes, a clear working area is provided for the mowing robot, the coordinates of the working nodes are accurately measured, the accuracy of path planning is ensured, errors are reduced, and a quadrilateral single grid is constructed as a basic working unit, which is convenient for subsequent grid optimization and path analysis;
[0078] 2. The present invention adjusts the specifications of all quadrilateral grids according to the terrain and obstacles to obtain the minimized local grid. According to the terrain undulations and obstacle distribution, the specifications of the quadrilateral grids are flexibly adjusted to make the grid layout more suitable for the actual working environment, reduce unnecessary path movement, and improve mowing efficiency. The quality of the minimized local grid is optimized through a formula to obtain the target area, ensure that the path planning is both efficient and reasonable, reduce repeated operations and idle driving time, and help the mowing robot to achieve precise operation and improve the operation quality.
[0079] 3. The present invention ensures that the lawn mower robot operates within a predetermined area by real-time monitoring of the driving path of the lawn mower robot. Once an abnormal signal is detected, an out-of-bounds judgment is immediately made. By responding in a timely manner based on the abnormal signal, it is quickly determined whether the lawn mower robot is out of bounds, and corresponding measures are taken to prevent further crossing of the boundary.
[0080] To sum up, the present invention can monitor and analyze the operating status of the lawn mower robot working in the outdoor area according to the actual situation, ensure that it operates within the predetermined area, avoid damage caused by crossing the boundary, and use sensor technology and algorithm analysis to intelligently determine whether the lawn mower robot is about to or has gone out of bounds, thereby achieving efficient and precise control of the lawn mower robot to prevent it from going out of bounds, and ensuring the normal implementation of the subsequent lawn mower robot's control method to prevent it from going out of bounds. BRIEF DESCRIPTION OF THE DRAWINGS
[0081] Figure 1 The present invention is a flowchart of the robot lawn mower preventing out-of-bounds control method. DETAILED DESCRIPTION
[0082] 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 implementation regulations described 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.
[0083] Reference Figure 1 , a control method for preventing a lawn mowing robot from going out of bounds, comprising:
[0084] Step 1: Equip the lawn mowing robot with a sensor component for boundary line and obstacle detection; wherein the sensor component is composed of a boundary line sensor and an obstacle sensor;
[0085] Step 2: Implement sub-area division, segment the boundaries of the sub-areas and set working nodes, accurately measure the coordinates of the working nodes, and construct a quadrilateral grid;
[0086] Step 3: Based on the terrain and obstacles, the specifications of all quadrilateral cells are adjusted to obtain a minimized local grid; wherein the specifications of the quadrilateral cells include their shape and size, and the specification adjustment includes minimizing the variation of the quadrilateral shapes in the local grid, even if the shapes of all quadrilaterals are similar;
[0087] Step 4: Use the formula to optimize the quality of the minimized local grid and obtain the target area;
[0088] Step 5: Analyze the driving path of the mowing robot according to the target area, obtain abnormal signals, and further determine whether the mowing robot is out of bounds based on the abnormal signals.
[0089] It should be noted that the application object of the lawn mower robot anti-out-of-bounds control method proposed in the present invention can be widely set as monitoring and analysis of outdoor areas such as gardens, lawns, farmlands, etc. that require automated management. It can be used to monitor whether the working status of the lawn mower robot is normal, including its moving path and obstacle avoidance ability. Specifically, it can be through sensor technology and algorithm analysis, the real-time position, surrounding environment, obstacle distance and preset boundary line of the lawn mower robot for comprehensive monitoring and precise analysis, tracking the position of the lawn mower robot, detecting whether the robot is approaching or crossing the preset boundary, identifying boundary marks or obstacles, and intelligently judging whether the lawn mower robot is about to or has gone out of bounds. Once it is found that the lawn mower robot is at risk of going out of bounds or has actually gone out of bounds, measures are taken immediately according to the early warning prompts to intervene in time to ensure the safety and efficiency of the mowing operation.
[0090] See also Figure 1 The present invention provides a method for preventing a lawn mower robot from going out of bounds. In step 1, the step of equipping the lawn mower robot with a sensor component to detect boundaries and obstacles includes:
[0091] Step 101, select the type of boundary line sensor according to the working area environment, that is, electromagnetic wire sensor, visible light or infrared boundary line sensor: for outdoor environment, use the electromagnetic wire sensor buried underground; for indoor or temporary scenes, use the visible light or infrared boundary line sensor on the ground;
[0092] Step 102: Arrange boundary lines on the boundaries of the working area, and determine the scope of the working area of the mowing robot by monitoring the boundary lines on the ground or the boundary lines buried underground: for electromagnetic wire sensors buried underground, dig trenches underground and lay electromagnetic wires; for boundary lines on the ground, directly arrange cables or stickers with sensors on the boundaries;
[0093] Step 103, calibrating the boundary line sensor, including setting the sensitivity of the sensor and adjusting the detection range of the sensor;
[0094] Step 104: Select the type of obstacle sensor, i.e., ultrasonic or infrared sensor, according to the type and characteristics of obstacles appearing in the working area; ultrasonic sensors are used to detect most types of obstacles, while infrared sensors are used to detect transparent or highly reflective obstacles;
[0095] Step 105: Install ultrasonic or infrared sensors in all potential obstacle areas around the lawn mowing robot;
[0096] Step 106: Set the detection distance, detection angle, and sensitivity of the obstacle sensor to obtain obstacle avoidance capability;
[0097] Step 107: When the lawn mower robot is working, the sensor component detects the boundary line position and surrounding obstacles in real time, and the sensor component immediately transmits the detection result to the control module of the lawn mower robot; the control module determines whether to adjust the moving path of the lawn mower robot or take other obstacle avoidance measures according to the detection result;
[0098] In steps 101-107, in the actual application process, comprehensive consideration is given to multiple factors such as budget constraints, working environment characteristics, sensor performance and cost control, post-maintenance and upgrades, and technical maturity and reliability, and the sensor component that best suits the current project needs is selected to assist the mowing robot in boundary detection and obstacle avoidance. Therefore, it is necessary to find the best balance between multiple factors to ensure that the mowing robot can meet functional requirements and be economically feasible.
[0099] See also Figure 1 The present invention provides a method for preventing a lawn mowing robot from going out of bounds. In the second step, the steps of implementing sub-area division, performing boundary segmentation and working node setting on the sub-area, accurately measuring the coordinates of the working nodes, and constructing a quadrilateral grid include:
[0100] Step 201: divide the sub-regions based on the characteristics of the working region, and screen out the boundary lines of the sub-regions evenly or according to rules on the boundaries;
[0101] Step 202: dividing the boundary line of the sub-region into straight line segments or curved line segments according to the terrain environment characteristics;
[0102] Step 203: set a working node in each sub-area, use a high-precision measuring tool or device to accurately obtain the coordinate information of each working node, and perform special processing or marking on the working nodes at special positions on the boundary line, that is, locate the out-of-bounds key points of the mowing robot;
[0103] Step 204: construct a quadrilateral grid with four adjacent working nodes as vertices.
[0104] See also Figure 1The present invention provides a method for preventing a lawn mowing robot from going out of bounds. In step 3, the specifications of all quadrilateral grids are adjusted based on the terrain and obstacles to obtain a minimized local grid, which includes:
[0105] Step 301: Combine the set vertex coordinates to extract all point sets in the two-dimensional space. ;
[0106] Step 302: Set the center coordinates to ,
[0107] in, ;
[0108] Step 303: Measure compactness by the sum of the squares of the distances between the point set and its center:
[0109] ;
[0110] Where C represents the compactness target value; i represents the number of all points, i=1, 2, ..., n; n is a positive integer;
[0111] Step 304: Get the lengths of the four sides of the quadrilateral h, which are ;
[0112] Step 305: define the average side length of the quadrilateral h as:
[0113] ;
[0114] Step 306: uniformity is achieved by minimizing the variance of the average side lengths of all quadrilaterals:
[0115] ;
[0116] Wherein, U represents the uniformity target value; N represents the number of quadrilateral cells; h represents the number of the quadrilateral cells; j represents the number of the four sides of the quadrilateral cells, j=1, 2, 3, 4; represents the weighted average of the lengths of all quadrilateral sides; The weight representing the length of the quadrilateral side;
[0117] Step 307: Define a small moving vector , used to update the position of point i;
[0118] Step 308: Adjust the position of each point through an iterative formula, thereby adjusting the specifications of the quadrilateral grid:
[0119] ;
[0120] In the formula, and Represents the original coordinates of the i-th point in the point set P; and Represents the new coordinates of the i-th point calculated by the iterative formula; Represents the learning rate, which is used to control the step size of the iteration; and represents the partial derivatives of the uniformity U with respect to the a and b coordinates of point i; and represents the partial derivatives of the compactness C with respect to the a and b coordinates of point i;
[0121] Step 309, repeat step 308 to update the coordinates of each point until the stop criterion is met;
[0122] In step 309, the stopping criterion may be reaching the maximum number of iterations, the change in uniformity and compactness being less than a certain threshold, etc. Each iteration is intended to make the point set closer to an ideal uniform and compact distribution;
[0123] Step 310: Based on the iterated new coordinates, determine the side lengths and angles of the quadrilateral cells, and integrate them to form a minimized local grid.
[0124] See also Figure 1 The present invention provides a method for preventing a lawn mowing robot from going out of bounds. In the fourth step, the formula is used to optimize the quality of the minimized local grid, and the step of obtaining the target area includes:
[0125] Step 401: Introduce a penalty term to optimize the quality of the minimized local grid:
[0126] ;
[0127] Where GEI represents the grid quality optimization index; The penalty term introduced is an indicator to measure the complexity of the mesh boundary, which is used to penalize meshes with irregular shapes or complex boundaries; and It represents the maximum and minimum values of the side length of a quadrilateral after iterative calculation, which is used to measure the difference in side length; k represents the side length difference adjustment factor, which is used to adjust the contribution of side length difference to shape regularity; v represents the angle difference adjustment factor, which is used to adjust the contribution of angle difference to shape regularity; Represents the interior angle of a single quadrilateral after iterative calculation; Represents the interior angles of an ideal shape; represents the sum of all interior angles;
[0128] Step 402: merge multiple quality-optimized minimized local grids into a large grid set, and the integrated regional grid completely represents the target area.
[0129] See also Figure 1 The present invention provides a method for preventing a lawn mower robot from going out of bounds. In step 5, the driving path of the lawn mower robot is analyzed according to the target area, an abnormal signal is obtained, and the step of further determining whether the lawn mower robot is out of bounds based on the abnormal signal includes:
[0130] Step 501: Arrange the data of the target area into a format that can be automatically recognized by the lawn mowing robot;
[0131] Step 502: After receiving the optimized grid data, the mowing robot imports it into the control module;
[0132] Step 503: determine the target area G, where G=ST(x, y) represents the state of the (x, y)th quadrilateral cell; x and y represent the indexes of the row and column; the value of ST(x, y) is: 0 represents an empty space, that is, the mowing robot can pass normally; 1 represents an obstacle; 2 represents that the grass has been mowed;
[0133] Step 504: pre-process the target area G, identify all quadrilateral cells where boundaries and obstacles are located, and regard them as locations that are inaccessible to the lawn mowing robot;
[0134] Step 505, update the target area G, and automatically skip the quadrilateral cells whose ST (x, y) value is 1;
[0135] Step 506: Set the starting point Q and the target point E, which represent the initial position and the destination of the mowing robot respectively;
[0136] Step 507, calculate the shortest path from Q to E by using the function f(g)=t(g)+q(g); wherein t(g) represents the actual cost from the starting point to the current quadrilateral cell g, and q(g) represents the estimated cost from the current quadrilateral cell to the target point;
[0137] In step 507, q(g) is a heuristic function that is adjusted according to the unevenness of the terrain. When a quadrilateral cell is far from the nearest obstacle or the terrain is relatively flat, the q(g) value is low.
[0138] Step 508: Through the function Calculate the minimum cost path from Q to each quadrilateral cell; where d(g) represents the minimum cost from the starting point to the current quadrilateral cell g, e(m, g) represents the cost of moving from quadrilateral cell m to g, M(g) represents the neighbor set of g, and d(m) represents the cost of moving from the starting point to quadrilateral cell m;
[0139] Step 509: Combine the shortest path and the minimum cost path to generate the target path π(g)=f(g)+d(g) of the lawn mowing robot;
[0140] Step 510: Compare and analyze the actual path of the mowing robot with the target path: calculate the deviation ratio using the formula PL=(Dis / TL)×100%, where PL represents the deviation ratio, Dis represents the total deviation distance between the actual path of the mowing robot and the target path, and TL represents the total length of the target path; define a deviation threshold PL0, if PL is not less than PL0, generate an abnormal signal, indicating that the actual path of the mowing robot seriously deviates from the target path; if PL is less than PL0, generate a normal signal, indicating that the actual path of the mowing robot is close to the target path;
[0141] Step 511: for abnormal signals, use a high-precision positioning system to capture the current position D and the next position F of the mowing robot;
[0142] Step 512, extract the information of the known boundary quadrilateral cell: distinguish the coordinate positions of the four adjacent vertices of the boundary quadrilateral cell: ;
[0143] In the formula, Represents the coordinates of the upper right vertex of the boundary quadrilateral cell; Represents the coordinates of the lower right vertex of the boundary quadrilateral cell; Represents the coordinates of the upper left vertex of the boundary quadrilateral; Represents the coordinates of the lower left vertex of the boundary quadrilateral cell;
[0144] Step 513: Preset the safe distance L for the lawn mowing robot to run, then:
[0145] ;
[0146] In the formula, represents the minimum distance from point F to line segment 13, represents the minimum distance from point F to line segment 14, represents the minimum distance from point F to line segment 24, represents the minimum distance from point F to line segment 23, where Indicates the distance from point F to the line segment;
[0147] Step 514: Make a judgment based on the warning function B so as to take immediate measures to prevent the robot from going out of bounds:
[0148] ;
[0149] When the minimum distance from point F to any line segment is less than the safety distance L, B(D, F) = 1, which means that the robot is approaching the boundary and sends out a warning signal; otherwise, B(D, F) = 0, which means that the robot is in the normal operating area and sends out an inquiry signal to further detect whether the mowing robot is out of bounds.
[0150] Step 515: based on the warning signal, check the reason why the lawn mowing robot is out of bounds, so as to improve the working efficiency and accuracy of the robot;
[0151] In step 515, the following aspects can be used for troubleshooting: Check robot settings: check the robot's working range, motion trajectory and other settings to confirm whether the robot is out of bounds due to improper settings; analyze sensor data: analyze the sensor components equipped with the robot to find out the possible reasons for the robot to be out of bounds; check the software program: check the software program that controls the robot to see if there are any logical errors or program loopholes that cause the robot to behave abnormally.
[0152] In the embodiment of the present invention, by configuring boundary line sensors and obstacle sensors, the lawn mowing robot senses and identifies boundary lines and obstacles, which is the basis for the lawn mowing robot to prevent going out of bounds. The boundary line sensor helps the robot identify and follow the preset boundary line, while the obstacle sensor ensures that the robot can avoid or take other measures in time when encountering obstacles. By sub-area division and quadrilateral single grid construction, the robot can divide its working area into smaller and easier-to-manage parts, which can more effectively control the robot's range of motion and path, reduce the possibility of repeated work and missed areas, and adjust the grid specifications according to the terrain and obstacle conditions to obtain a minimized local grid. The quadrilateral single grid that is initially divided is optimized to adapt to the actual terrain and obstacles. By adjusting the specifications of the single grid, it can ensure that the robot can still work effectively when encountering complex terrain or a large number of obstacles, while reducing unnecessary paths and energy consumption. By using the formula to optimize the quality of the minimized local grid, the target area is obtained, the quality and efficiency of the grid are improved, and the optimized grid is more in line with the working requirements of the robot, improving work efficiency and accuracy. According to the optimized grid and target area, the robot's driving path is monitored and analyzed in real time. Once an abnormal signal (such as deviation from the preset path or crossing the boundary line) is found, measures are taken immediately to prevent the robot from going out of bounds. In summary, the example of the present invention involves data processing, comprehensive analysis and decision-making for optimized operations, which solves the technical problem that the existing solution does not accurately analyze the environmental adaptability and driving path of the mowing robot, resulting in poor out-of-bounds control effect. In actual situations, more data and context information may be needed to make specific decisions and optimization plans.
[0153] In addition, the formulas involved in the above are all calculated by removing dimensions and taking their numerical values. They are a formula that is closest to the actual situation obtained by collecting a large amount of data and performing software simulation. The proportional coefficient in the formula and the various preset thresholds in the analysis process are set by technical personnel in this field according to actual conditions or obtained by simulating a large amount of data; the size of the proportional coefficient is to quantify each parameter to obtain a specific value for subsequent comparison. The size of the proportional coefficient depends on the amount of sample data and the preliminary setting of the corresponding processing coefficient for each group of sample data by technical personnel in this field; as long as it does not affect the proportional relationship between the parameter and the quantized value.
[0154] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the device embodiment, since it is basically based on the method embodiment, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.
[0155] For the convenience of description, the above device is described in various units according to their functions. Of course, when implementing the present application, the functions of each unit can be implemented in the same or multiple software and / or hardware.
[0156] It will be appreciated by those skilled in the art that embodiments of the present invention may be provided as methods, systems, or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Furthermore, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0157] The present invention is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0158] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0159] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0160] Secondly: In the drawings of the embodiments disclosed in the present invention, only the structures related to the embodiments disclosed in the present invention are involved, and other structures can refer to the general design. In the absence of conflict, the same embodiment and different embodiments of the present invention can be combined with each other;
[0161] Finally: 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. A method for preventing a lawn mowing robot from going out of bounds, characterized in that: Step 1: Equip the lawn mowing robot with a sensor component for boundary line and obstacle detection; wherein the sensor component is composed of a boundary line sensor and an obstacle sensor; Step 2: Implement sub-area division, segment the boundaries of the sub-areas and set working nodes, accurately measure the coordinates of the working nodes, and construct a quadrilateral grid; Step 3: Based on the terrain and obstacles, adjust the specifications of all quadrilateral cells to obtain the minimum local grid; Step 4: Use the formula to optimize the quality of the minimized local grid and obtain the target area; Step 5: Analyze the driving path of the mowing robot according to the target area, obtain abnormal signals, and further determine whether the mowing robot is out of bounds based on the abnormal signals; The process of adjusting the specifications of all quadrilateral cells based on the terrain and obstacles to obtain the minimized local grid includes: Step Z1: Combine the vertex coordinates of the set quadrilateral grid to extract all the point sets in the two-dimensional space. ; Step Z2, set the center coordinates to , in, ; Step Z3, measure compactness by the sum of the squares of the distances between the point set and its center: ; Where C represents the compactness target value; i represents the number of all points, i=1, 2, ..., n; n is a positive integer; Step Z4, obtain the four side lengths of the quadrilateral h, which are ; Step Z5, define the average side length of the quadrilateral h as: ; Step Z6: Achieve uniformity by minimizing the variance of the average side lengths of all quadrilaterals: ; Wherein, U represents the uniformity target value; N represents the number of quadrilateral cells; h represents the number of the quadrilateral cells; j represents the number of the four sides of the quadrilateral cells, j=1, 2, 3, 4; represents the weighted average of the lengths of all quadrilateral sides; The weight representing the length of the quadrilateral side; Step Z7: Define a small moving vector , used to update the position of point i; Step Z8: Adjust the position of each point through the iterative formula, and then adjust the specifications of the quadrilateral grid: ; In the formula, and Represents the original coordinates of the i-th point in the point set P; and Represents the new coordinates of the i-th point calculated by the iterative formula; Represents the learning rate, which is used to control the step size of the iteration; and represents the partial derivatives of the uniformity U with respect to the a and b coordinates of point i; and represents the partial derivatives of the compactness C with respect to the a and b coordinates of point i; Step Z9, repeat step Z8 to update the coordinates of each point until the stop criterion is met; Step Z10: Based on the iterated new coordinates, determine the side length and angle of the quadrilateral single grid, and integrate them to form a minimized local grid; The fourth step, using the formula to optimize the quality of the minimized local grid, the process of obtaining the target area includes: Introduce a penalty term to minimize the local mesh quality: ; Where GEI represents the grid quality optimization index; The penalty term introduced is an indicator to measure the complexity of the mesh boundary, which is used to penalize meshes with irregular shapes or complex boundaries; and It represents the maximum and minimum values of the side length of a quadrilateral after iterative calculation, which is used to measure the difference in side length; k represents the side length difference adjustment factor, which is used to adjust the contribution of side length difference to shape regularity; v represents the angle difference adjustment factor, which is used to adjust the contribution of angle difference to shape regularity; Represents the interior angle of a single quadrilateral after iterative calculation; Represents the interior angles of an ideal shape; represents the sum of all interior angles; Multiple quality-optimized minimized local meshes are merged into a large mesh set, and the integrated regional mesh fully represents the target area.
2. The method for preventing a lawn mower robot from going out of bounds according to claim 1, characterized in that: In step 1, the process of equipping the lawn mowing robot with a sensor component to detect boundaries and obstacles includes: Select the boundary line sensor type according to the working area environment; Arranging boundary lines on the boundaries of the working area, and determining the scope of the working area of the mowing robot by monitoring the boundary lines on the ground or the boundary lines buried underground; Calibrate the boundary line sensor; Select the obstacle sensor type according to the type and characteristics of obstacles in the working area; Obstacle sensors are installed in all potential obstacle areas around the mowing robot to detect whether there are obstacles around that may interfere with the operation of the mowing robot; Set the obstacle sensor's detection distance, detection angle, and sensitivity to obtain the obstacle avoidance capability of the obstacle sensor; When the lawn mower robot is working, the sensor component detects the boundary line position and surrounding obstacles in real time, and transmits the detection results to the control module of the lawn mower robot.
3. The method for preventing a lawn mower robot from going out of bounds according to claim 1, characterized in that: In the step 2, the process of implementing sub-area division, segmenting the boundaries of the sub-areas and setting working nodes, accurately measuring the coordinates of the working nodes, and constructing a quadrilateral grid includes: Implement sub-area division based on the characteristics of the work area, and screen out the boundary lines of the sub-areas evenly or according to rules on the boundaries; The boundary lines of the sub-areas are divided into straight segments or curved segments according to the characteristics of the terrain environment; Set working nodes in each sub-area, use high-precision measuring tools or equipment to accurately obtain the coordinate information of each working node, and perform special processing or marking on working nodes at special positions on the boundary line, that is, locate the key points of the mowing robot out of bounds; Construct a quadrilateral grid with four adjacent working nodes as vertices.
4. The method for preventing a lawn mowing robot from going out of bounds according to claim 1, characterized in that: In step 5, the process of analyzing the driving path of the mowing robot according to the target area and obtaining the abnormal signal includes: Organize the data of the target area into a format that can be automatically recognized by the mowing robot; After receiving the optimized grid data, the mowing robot imports it into the control module; Determine the target area G, G = ST (x, y) represents the state of the (x, y)th quadrilateral cell; x and y represent the indexes of the row and column; the value of ST (x, y) is: 0 represents an empty space, that is, the mowing robot can pass normally; 1 represents an obstacle; 2 represents the grass has been mowed; Pre-process the target area G to identify all the quadrilateral cells where the boundaries and obstacles are located, and regard them as places that the mowing robot cannot reach; Update the target area G and automatically skip the quadrilateral cells whose ST(x, y) value is 1; Set the starting point Q and the target point E, which represent the initial position and the destination of the mowing robot respectively; The shortest path from Q to E is calculated by the function f(g) = t(g) + q(g); where t(g) represents the actual cost from the starting point to the current quadrilateral cell g, and q(g) represents the estimated cost from the current quadrilateral cell to the target point; Through the function Calculate the minimum cost path from Q to each quadrilateral cell; where d(g) represents the minimum cost from the starting point to the current quadrilateral cell g, e(m, g) represents the cost of moving from quadrilateral cell m to g, M(g) represents the neighbor set of g, and d(m) represents the cost of moving from the starting point to quadrilateral cell m; Combine the shortest path and the minimum cost path to generate the target path of the lawn mowing robot π(g) = f(g) + d(g); The actual path of the mowing robot is compared with the target path: the deviation ratio is calculated using the formula PL=(Dis / TL)×100%, where PL represents the deviation ratio, Dis represents the total deviation distance between the actual path of the mowing robot and the target path, and TL represents the total length of the target path; a deviation threshold PL0 is defined. If PL is not less than PL0, an abnormal signal is generated, indicating that the actual path of the mowing robot deviates seriously from the target path; if PL is less than PL0, a normal signal is generated, indicating that the actual path of the mowing robot is close to the target path.
5. The method for preventing a lawn mowing robot from going out of bounds according to claim 1, characterized in that: In step 5, the process of further determining whether the mowing robot is out of bounds in combination with the abnormal signal includes: In response to abnormal signals, a high-precision positioning system is used to capture the current position D and next position F of the mowing robot; Extract the information of the known boundary quadrilateral cell: distinguish the coordinate positions of the four adjacent vertices of the boundary quadrilateral cell: ; In the formula, Represents the coordinates of the upper right vertex of the boundary quadrilateral cell; Represents the coordinates of the lower right vertex of the boundary quadrilateral cell; Represents the coordinates of the upper left vertex of the boundary quadrilateral; Represents the coordinates of the lower left vertex of the boundary quadrilateral cell; The preset safe distance L for the lawn mower robot is: ; In the formula, represents the minimum distance from point F to line segment 13, represents the minimum distance from point F to line segment 14, represents the minimum distance from point F to line segment 24, represents the minimum distance from point F to line segment 23, where Indicates the distance from point F to the line segment; According to the early warning function B, the following judgment is made: ; When the minimum distance from point F to any line segment is less than the safety distance L, B(D, F) = 1, which means that the robot is approaching the boundary and sends out a warning signal; otherwise, B(D, F) = 0, which means that the robot is in the normal operating area and sends out an inquiry signal to further detect whether the mowing robot is out of bounds. Investigate the reasons why the mowing robot went out of bounds based on the early warning signals.
