CN118857326A - A robot vision positioning and navigation method - Google Patents

Abstract

The invention relates to the technical field of robot vision positioning navigation, and discloses a robot vision positioning navigation method, which comprises the following steps: determining the position of the robot and the position of the destination, collecting road information between the two positions of the robot, making an overall route according to the collected road information, dividing the overall route into a plurality of local road sections according to road nodes, scanning the local road sections by using an infrared sensor and a camera of the robot equipment, establishing a two-dimensional plane coordinate system in an electronic map, marking obstacle coordinates in the two-dimensional plane coordinate system, acquiring a moving track of the obstacle coordinates, finally acquiring an obstacle region, controlling the robot to run in the non-obstacle region, and executing temporary route adjustment when encountering road blockage until the robot runs to the destination position; the robot vision positioning navigation method improves autonomous navigation capability of the robot in dynamic and complex environments, reduces collision risk, and enhances flexibility and accuracy of route planning.

Description

A robot vision positioning and navigation method

Technical Field

The present invention relates to the technical field of robot vision positioning and navigation, and in particular to a robot vision positioning and navigation method.

Background Art

With the growing demand for automation and intelligence, robot visual positioning and navigation technology has found wide applications in manufacturing, logistics, home services, healthcare, agriculture, and military. For example, autonomous delivery robots, unmanned warehouses, and intelligent guide robots all place higher demands on precise visual positioning and navigation.

The development background of robot visual positioning and navigation technology is rooted in the intersection of multiple key fields and technological advances, including computer vision, sensor technology, artificial intelligence, pattern recognition, machine learning and big data processing. Therefore, for some robots with limited computing power, how to use a limited platform to achieve all of the above functions is a key issue.

During the robot navigation process, route planning has high requirements on the robot's computing power. Therefore, a simple route planning method can not only quickly and effectively obtain a route that meets actual needs, but also improve the robot's navigation efficiency and reduce the demand for the robot's computing power during the actual driving process of the robot.

Apart from route planning, the key to avoiding obstacles during the actual driving of the robot lies in predicting the movement trajectory of the obstacles. Therefore, a fast and effective method is needed to determine the movement trajectory of the obstacles, and this method can provide continuous and real-time movement trajectory prediction.

Summary of the invention

The present invention provides a robot vision positioning and navigation method for facilitating solving the problems mentioned in the above background technology.

The present invention provides the following technical solution: a robot visual positioning and navigation method,

An optional robot visual positioning and navigation method is characterized by comprising:

Input the robot's current location information and destination location information.

Retrieve and collect in real time the road information between the robot's location and the destination in the database. All roads are straight lines, and un-drivable sections are marked and removed.

The non-drivable road section refers to a road section that is closed due to construction or accidents and is therefore not drivable.

The overall route is formulated based on the drivable road sections, the number of road nodes included in the overall route is determined based on the road information stored in the database, and the overall route is divided into several local sections based on the road nodes.

Use the robot's infrared sensors and cameras to scan and photograph local road sections, mark obstacles and obtain obstacle information.

The obstacle is specifically a physical object existing on a local road section.

Analyze the movement trajectory of obstacles in the local road section, and obtain the obstacle movement area based on the obstacle movement trajectory.

Remove the obstacle area, control the robot to travel in the non-obstacle area and avoid obstacles.

If a section of the road ahead of the robot is blocked while the robot is driving, a temporary route adjustment will be performed until the robot reaches the destination.

Optional: The road information between the robot's location and the destination location is retrieved and collected in real time from the database, all roads are straight lines, and un-drivable sections are marked and removed, specifically:

S1, collect the road information between the robot's location and the destination location,

The road information is road infrastructure information and dynamic information related to real-time traffic operation.

Road infrastructure information mainly includes road geometry, traffic signs and markings, roadside facilities and environmental conditions along the way. Dynamic information mainly includes traffic flow, road congestion, traffic incidents, and meteorological environment information.

S2. If there is an un-drivable section between the robot's location and the destination location, delete the information of the un-drivable section from the collected road information.

Optionally, the overall route is formulated according to the drivable road sections, the number of road nodes included in the overall route is determined according to the road information stored in the database, and the overall route is divided into a number of local sections according to the road nodes, specifically:

S3, generate an electronic map, input the drivable road section information collected in steps S1-S2 into the electronic map,

S4: The robot's location is the starting point, and the destination's location is the ending point.

S5. Mark the road where the starting point is located, and mark the road where the ending point is located.

S6. If the road where the starting point is located and the road where the end point is located have an intersection, the intersection of the road where the starting point is located and the road where the end point is located is recorded as the road intersection.

S7, the road between the starting point and the road intersection, and the road between the end point and the road intersection, the two sections of road constitute the overall route;

S8. If there is no intersection between the road where the starting point is located and the road where the end point is located, determine whether there is an auxiliary road, specifically:

S9. Connect the starting point and the ending point. If there is a road, and the line segment where the road is located has an intersection with the line segment between the starting point and the ending point, and the road has an intersection with the road where the starting point is located and the road where the ending point is located, then record this road as an auxiliary road, record the intersection of the road where the starting point is located and the auxiliary road as the first auxiliary intersection, and record the intersection of the road where the ending point is located and the auxiliary road as the second auxiliary intersection.

S10: The road between the starting point and the first auxiliary intersection, the road between the first auxiliary intersection and the second auxiliary intersection, and the road between the second auxiliary intersection and the end point constitute the overall route.

S11. If the number of auxiliary roads is greater than 1, obtain the distance of the overall route formed by each auxiliary road, and select the auxiliary road corresponding to the minimum distance.

S12. If there is no auxiliary road, mark the roads that intersect both the road where the starting point is located and the road where the end point is located, obtain the distances between all marked roads and the starting point respectively, and compare them one by one, select the marked road with the smallest distance from the starting point, record the intersection point of the road where the starting point is located and the marked road as the first road node, record the intersection point of the road where the end point is located and the marked road as the second road node,

The road node is specifically the intersection of two or more roads.

S13: The road between the starting point and the first road node, the road between the first road node and the second road node, and the road between the second road node and the end point constitute an overall route, and this overall route is recorded as the first route.

S14, respectively obtain the distances between all marked roads and the end point, compare them one by one, select the marked road with the smallest distance to the end point, record the intersection of the road where the end point is located and the marked road as the third road node, record the intersection of the road where the end point is located and the marked road as the fourth road node,

S15, the road between the end point and the third road node, the road between the third road node and the fourth road node, and the road between the fourth road node and the start point, the three sections of road constitute an overall route, and this overall route is recorded as the second route.

S16. Compare the distances of the first route and the second route. If the distance of the first route is less than or equal to the distance of the second route, select the first route; if the distance of the first route is greater than the distance of the second route, select the second route; and divide the overall route into sections according to the road nodes, specifically, the road between two adjacent road nodes is a local section.

Optionally, the infrared sensor and camera equipped by the robot are used to scan and photograph a local road section, mark obstacles and obtain obstacle information, specifically:

S17. Use the infrared sensor and camera equipped by the robot to scan the local road section to obtain the length, width and obstacle information of the local road section, wherein the obstacle information specifically includes the obstacle position, the straight-line distance of the obstacle from the robot and the moving speed of the obstacle. Based on the collected local road section information and obstacle information, a two-dimensional plane coordinate system is constructed with the plane where the ground of the local road section is located as the coordinate plane, and only the coordinates of the obstacle projected on the coordinate system are retained in the coordinate system.

Optional: The analyzing the obstacle movement trajectory in the local road section and obtaining the obstacle movement area according to the obstacle movement trajectory are specifically as follows:

S18, using the infrared sensor and camera equipped by the robot to capture the video of the local road section,

S19, in chronological order, according to step S17, the coordinates of the same obstacle at different frame numbers are obtained in the two-dimensional plane coordinate system. For the same obstacle, the first coordinate and the last coordinate obtained are connected, and a ray is drawn in the direction from the first coordinate to the last coordinate. The trajectory of the ray is the moving trajectory of the obstacle.

S20. Draw a circle with the coordinates on the ray as the center. This circle is called the trajectory circle. The area formed by all trajectory circles drawn according to the coordinates on the ray is the moving area of the obstacle. The radius of the trajectory circle is determined by the moving speed of the obstacle, specifically:

S21, obtain the distance that the obstacle moves in a certain period of time, and calculate the instantaneous speed of the obstacle based on the moving distance and moving time,

S22, repeat step S21 to obtain multiple instantaneous speeds of the obstacle, calculate the average value of all instantaneous speeds, and use the average value as the moving speed of the obstacle. The value of the moving speed of the obstacle is recorded as V, and the unit is m/s.

S23. If V≤50, the radius of the obstacle trajectory circle is (V/100) m.

S24, if V>50, the radius of the obstacle trajectory circle is 0.5m,

S25. Execute steps S18-S24 for all obstacles in the local road section to generate a moving area of all obstacles in the local road section, namely, an obstacle area.

Optional: removing the obstacle area, formulating a local route in the non-obstacle area, controlling the robot to avoid obstacles, and completing navigation and driving in this local section according to the local route, specifically:

S26, remove the obstacle area and control the robot to travel in the non-obstacle area.

S27. During driving, when there is an obstacle in front of the robot, obtain the moving direction of the obstacle.

S28. If the angle between the moving direction of the obstacle and the moving direction of the robot is less than 90°:

S29, obtaining the mapping speed of the obstacle in the moving direction of the robot. If the mapping speed of the obstacle in the moving direction of the robot is lower than the moving speed of the robot, the moving speed of the robot is reduced until the moving speed of the robot is equal to the mapping speed of the obstacle in the moving direction of the robot.

S30, if the mapping speed of the obstacle in the moving direction of the robot is higher than or equal to the moving speed of the robot, then maintaining the current moving direction and moving speed of the robot;

S31. If the angle between the moving direction of the obstacle and the moving direction of the robot is greater than or equal to 90°:

S32, obtain the ray made according to the coordinates of the obstacle, draw a straight line parallel to the ray on the side close to the robot, and the distance between the ray and the straight line is the radius of the obstacle trajectory circle,

S33, if the straight line where the robot moves in the direction of movement has an intersection with the drawn straight line, change the robot's moving direction until the straight line where the robot moves in the direction of movement has no intersection with the drawn straight line,

S34. If there is no intersection between the straight line where the robot's moving direction is located and the drawn straight line, the robot's moving direction and moving speed continue to be maintained.

Optional: If a partial road section ahead of the robot is blocked during the robot's driving process, a temporary route adjustment is performed until the robot reaches the destination, specifically:

If the road ahead of the robot is partially blocked during its driving, a temporary route adjustment will be performed.

The temporary route adjustments are as follows:

The robot stops driving and executes steps S1-S34 until it reaches the destination position.

The present invention has the following beneficial effects:

1. When formulating the overall route, the robot visual positioning and navigation method selects a road that intersects with the road where the starting point and the road where the end point are located as part of the overall route. This overall route planning method ensures that the robot does not make too many changes in driving direction during driving, reducing the probability of accidents caused by changes in driving direction.

2. The robot visual positioning and navigation method provides a fast and intuitive way to determine the movement trajectory of obstacles. It is suitable for scenarios where the robot is driving on a local road section. When an obstacle starts to move, even if only a small number of coordinate points are obtained, its movement trajectory can be immediately determined, allowing the robot to respond quickly and avoid potential collisions.

3. When predicting the moving trajectory of obstacles, the robot visual positioning and navigation method uses trajectory circles of different radii to represent the moving area of obstacles with different driving speeds. For high-speed moving obstacles, increasing the radius of the trajectory circle can provide the robot with a larger safety buffer zone and reduce the risk of collision. Conversely, for slow-moving obstacles, reducing the radius can avoid unnecessary excessive avoidance, thereby optimizing the route.

4. The robot visual positioning and navigation method has a higher priority for changing the robot's moving speed than changing the robot's moving direction when avoiding obstacles. This method can reduce the probability of accidents caused by changes in the robot's moving direction. If the moving direction changes, it is necessary to readjust the moving direction when avoiding obstacles, which increases the robot's calculation work and reduces the robot's navigation efficiency.

5. The robot visual positioning and navigation method selects the overall route with the shortest distance when choosing from multiple overall route plans. The shortest route often means that the robot can reach the destination in the shortest time.

BRIEF DESCRIPTION OF THE DRAWINGS

Figure 1 is a schematic diagram of a road intersection.

Figure 2 is a schematic diagram of the auxiliary road.

Figure 3 is a schematic diagram of a non-auxiliary road.

DETAILED DESCRIPTION

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.

Embodiment 1, a robot visual positioning and navigation method, characterized by comprising:

Input the robot's current location information and destination location information.

Retrieve and collect in real time the road information between the robot's location and the destination in the database. All roads are straight lines, and non-drivable sections are marked and removed. Removing non-drivable sections can prevent the robot from entering dangerous areas, avoid collisions between the robot and obstacles or construction equipment, and reduce the occurrence of safety accidents. Removing non-drivable sections helps the robot choose the shortest, fastest or most economical route.

The non-drivable road section refers to a road section that is closed due to construction or accidents and is therefore not drivable.

The overall route is formulated according to the drivable road sections, and the number of road nodes contained in the overall route is determined according to the road information stored in the database. The overall route is divided into several local sections according to the road nodes. Dividing the overall route into several local sections can decompose the complex overall route planning problem into a series of smaller and easier to handle sub-problems. Each local section can be planned independently, which reduces the difficulty and calculation amount of the overall route planning.

Use the robot's infrared sensors and cameras to scan and photograph local sections of the road, mark obstacles and obtain obstacle information. The infrared sensor can detect obstacles ahead, and the camera can provide detailed visual information to help the robot identify specific landmarks or features, help the robot adjust its navigation strategy in real time, adapt to dynamic environments, and avoid unnecessary stops or detours.

The obstacle is specifically a physical object existing on a local road section.

Analyze the movement trajectory of obstacles in the local road section, and obtain the obstacle movement area based on the obstacle movement trajectory.

Remove the obstacle area, control the robot to travel in the non-obstacle area and avoid obstacles.

If a section of the road ahead of the robot is blocked while the robot is driving, a temporary route adjustment will be performed until the robot reaches the destination.

The road information between the robot's location and the destination location is retrieved and collected in real time in the database. All roads are straight lines, and untravelable sections are marked and removed. Specifically:

S1, collect the road information between the robot's location and the destination location,

The road information is road infrastructure information and dynamic information related to real-time traffic operation.

Road infrastructure information mainly includes road geometry, traffic signs and markings, roadside facilities and environmental conditions along the way. Dynamic information mainly includes traffic flow, road congestion, traffic incidents, and meteorological environment information.

S2. If there is an un-drivable section between the robot's location and the destination location, delete the information of the un-drivable section from the collected road information.

The overall route is formulated according to the drivable road sections, the number of road nodes included in the overall route is determined according to the road information stored in the database, and the overall route is divided into several local sections according to the road nodes, specifically:

S3, generate an electronic map, input the drivable road section information collected in steps S1-S2 into the electronic map,

S4: The robot's location is the starting point, and the destination's location is the ending point.

S5. Mark the road where the starting point is located, and mark the road where the ending point is located.

S6. Referring to FIG. 1 , if there is an intersection between the road where the starting point is located and the road where the end point is located, the intersection between the road where the starting point is located and the road where the end point is located is recorded as the road intersection.

S7, the road between the starting point and the road intersection, and the road between the end point and the road intersection, the two sections of road constitute the overall route, and the specific driving is driving from the location of the starting point to the location of the road intersection, and then driving from the location of the road node to the location of the end point;

S8. If there is no intersection between the road where the starting point is located and the road where the end point is located, determine whether there is an auxiliary road, specifically:

S9. Referring to FIG. 2, the starting point and the ending point are connected. If there is a road, and the line segment where the road is located has an intersection with the line segment between the starting point and the ending point, it means that there is a road between the location of the starting point and the location of the ending point, and this road has an intersection with the road where the starting point is located and the road where the ending point is located. Then, this road is recorded as an auxiliary road, and the intersection of the road where the starting point is located and the auxiliary road is recorded as the first auxiliary intersection, and the intersection of the road where the ending point is located and the auxiliary road is recorded as the second auxiliary intersection.

S10, the road between the starting point and the first auxiliary intersection, the road between the first auxiliary intersection and the second auxiliary intersection, and the road between the second auxiliary intersection and the end point, the three sections of road constitute the overall route, the specific driving is driving from the location of the starting point to the location of the first auxiliary intersection, then driving from the location of the first auxiliary intersection to the location of the second auxiliary intersection, and finally driving from the location of the second auxiliary intersection to the location of the end point,

S11. If the number of auxiliary roads is greater than 1, obtain the distance of the overall route formed by each auxiliary road, and select the auxiliary road corresponding to the minimum distance.

S12, referring to FIG. 3, if there is no auxiliary road, that is, there is no road between the location of the starting point and the location of the end point, then mark the road that intersects both the road where the starting point is located and the road where the end point is located, obtain the distances between all marked roads and the starting point respectively, and compare them one by one, select the marked road with the smallest distance from the starting point, record the intersection of the road where the starting point is located and the marked road as the first road node, and record the intersection of the road where the end point is located and the marked road as the second road node,

The road node is specifically the intersection of two or more roads.

S13, the road between the starting point and the first road node, the road between the first road node and the second road node, and the road between the second road node and the end point, the three sections of road constitute the overall route, the specific driving is driving from the location of the starting point to the location of the first road node, then driving from the location of the first road node to the location of the second road node, and finally driving from the location of the second road node to the location of the end point, and this overall route is recorded as the first route,

S14, respectively obtain the distances between all marked roads and the end point, compare them one by one, select the marked road with the smallest distance to the end point, record the intersection of the road where the end point is located and the marked road as the third road node, record the intersection of the road where the end point is located and the marked road as the fourth road node,

S15, the road between the end point and the third road node, the road between the third road node and the fourth road node, and the road between the fourth road node and the starting point, the three sections of road constitute the overall route, the specific driving is driving from the location of the end point to the location of the third road node, then driving from the location of the third road node to the location of the fourth road node, and finally driving from the location of the fourth road node to the location of the starting point, and this overall route is recorded as the second route,

S16. Compare the distances of the first route and the second route. If the distance of the first route is less than or equal to the distance of the second route, select the first route. If the distance of the first route is greater than the distance of the second route, select the second route. The route with the shortest distance often means that the robot can reach the destination in the shortest time, which is crucial for time-sensitive applications such as emergency rescue, express delivery or industrial automation production. The overall route is segmented according to the road nodes. Specifically, the road between two adjacent road nodes is a local section.

The infrared sensor and camera equipped by the robot are used to scan and photograph the local road section, mark obstacles and obtain obstacle information, specifically:

S17, using the infrared sensor and camera equipped by the robot to scan the local section, obtain the length, width and obstacle information of the local section, the obstacle information specifically includes the position of the obstacle, the straight-line distance of the obstacle from the robot and the moving speed of the obstacle, and construct a two-dimensional plane coordinate system based on the plane of the ground of the local section as the coordinate plane according to the collected local section information and obstacle information, and only retain the coordinates of the obstacle projected on the coordinate system in the coordinate system. Establishing a unified coordinate system can ensure that all obstacles are in the same reference frame, which is convenient for data integration and processing. Marking the obstacle position in the coordinate system can provide the robot with accurate obstacle coordinate information, and help the robot accurately obtain obstacle information, so as to carry out effective obstacle avoidance planning.

The analysis of the obstacle movement trajectory in the local road section and the acquisition of the obstacle movement area according to the obstacle movement trajectory are specifically as follows:

S18, using the infrared sensor and camera equipped by the robot to capture the video of the local road section,

S19, in chronological order, according to step S17, the coordinates of the same obstacle at different frame numbers are obtained in the two-dimensional plane coordinate system. For the same obstacle, the first coordinate and the last coordinate obtained are connected, and a ray is drawn in the direction from the first coordinate to the last coordinate. The trajectory of the ray is the moving trajectory of the obstacle. This method provides a fast and intuitive way to determine the moving trajectory of the obstacle, which is suitable for the scene where the robot is driving on a local road section. When the obstacle starts to move, even if only a small number of coordinate points are obtained, its moving trajectory can be immediately determined, allowing the robot to respond quickly to avoid potential collisions.

S20. Draw a circle with the coordinates on the ray as the center, and record this circle as the trajectory circle. The area formed by all trajectory circles drawn according to the coordinates on the ray is the moving area of the obstacle. The radius of the trajectory circle is determined by the moving speed of the obstacle. For high-speed moving obstacles, increasing the radius of the trajectory circle can provide a larger safety buffer for the robot and reduce the risk of collision. Conversely, for slow-moving obstacles, reducing the radius can avoid unnecessary excessive avoidance, thereby optimizing the route. Specifically:

S21, obtain the distance that the obstacle moves in a certain period of time, and calculate the instantaneous speed of the obstacle based on the moving distance and moving time,

S22, repeat step S21 to obtain multiple instantaneous speeds of the obstacle, calculate the average value of all instantaneous speeds, and use the average value as the moving speed of the obstacle. The value of the moving speed of the obstacle is recorded as V, and the unit is m/s.

S23. If V≤50, the radius of the obstacle trajectory circle is (V/100) m.

S24, if V>50, the radius of the obstacle trajectory circle is 0.5m,

S25. Execute steps S18-S24 for all obstacles in the local road section to generate a moving area of all obstacles in the local road section, namely, an obstacle area.

The obstacle area is removed, a local route is formulated in the non-obstacle area, the robot is controlled to avoid obstacles, and navigation and driving in the local section are completed according to the local route. Specifically,

S26, remove the obstacle area and control the robot to travel in the non-obstacle area.

S27. During driving, when there is an obstacle in front of the robot, obtain the moving direction of the obstacle.

S28. If the angle between the moving direction of the obstacle and the moving direction of the robot is less than 90°, it means that the robot and the obstacle are moving in the same direction:

S29, obtaining the mapping speed of the obstacle in the moving direction of the robot. If the mapping speed of the obstacle in the moving direction of the robot is lower than the moving speed of the robot, the moving speed of the robot is reduced until the moving speed of the robot is equal to the mapping speed of the obstacle in the moving direction of the robot.

S30, if the mapping speed of the obstacle in the moving direction of the robot is higher than or equal to the moving speed of the robot, then maintaining the current moving direction and moving speed of the robot;

S31. If the angle between the moving direction of the obstacle and the moving direction of the robot is greater than or equal to 90°, it means that the robot and the obstacle are moving towards each other:

S32, obtain the ray made according to the coordinates of the obstacle, draw a straight line parallel to the ray on the side close to the robot, and the distance between the ray and the straight line is the radius of the obstacle trajectory circle,

S33. If the straight line in the robot's moving direction intersects the drawn straight line, that is, the robot will collide with the obstacle during the driving process, the robot's moving direction is changed until the straight line in the robot's moving direction intersects the drawn straight line.

S34. If there is no intersection between the straight line where the robot's moving direction is located and the drawn straight line, the robot's moving direction and moving speed continue to be maintained.

If the robot is traveling and a partial road section in front of the robot is blocked, a temporary route adjustment is performed until the robot reaches the destination, specifically:

If the road ahead of the robot is partially blocked during its driving, a temporary route adjustment will be performed.

The temporary route adjustments are as follows:

The robot stops driving and executes steps S1-S34 until it reaches the destination position.

It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device.

The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the technical principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims (7)

1. A robot vision positioning navigation method is characterized in that: comprising the following steps:

the robot is input with its location information and destination location information,

Searching and collecting road information between the position of the robot and the destination position in the database in real time, marking and removing non-travelable road sections when all roads are straight lines,

The non-drivable road section, in particular, a road section which cannot be driven due to road closure caused by construction and accidents,

Setting an overall route according to the drivable road segments, determining the number of road nodes contained in the overall route according to the road information stored in the database, dividing the overall route into a plurality of local road segments according to the road nodes,

An infrared sensor and a camera equipped with the robot are used for scanning and shooting local road sections, marking obstacles and acquiring obstacle information,

The obstacle is in particular a physical object present on a local road segment,

Analyzing the moving track of the obstacle in the local road section, analyzing and obtaining the moving area of the obstacle according to the moving track of the obstacle,

Removing the obstacle region, controlling the robot to run in the non-obstacle region and avoiding the obstacle,

And if the road of the partial road section in front of the robot is blocked during the running process of the robot, executing temporary route adjustment until the robot runs to the destination position.

2. The method for positioning and navigating a robot vision according to claim 1, wherein: the method comprises the steps of searching and collecting road information between the position of the robot and the position of the destination in a database in real time, marking and removing non-travelable road sections, wherein all roads are straight lines, and the method specifically comprises the following steps:

S1, collecting road information between the position of the robot and the destination position,

The road information is dynamic information related to road infrastructure information and traffic real-time operation,

The road infrastructure information mainly comprises road geometric construction, traffic sign marks, road along-line facilities and along-road environment conditions, the dynamic information mainly comprises traffic flow, road congestion conditions, traffic events and meteorological environment information,

S2, if an undriven road section exists between the position of the robot and the position of the destination, deleting the information of the undriven road section from the collected road information.

3. The method for positioning and navigating a robot vision according to claim 1, wherein: the method comprises the steps of making an overall route according to a drivable road section, determining the number of road nodes contained in the overall route according to road information stored in a database, and dividing the overall route into a plurality of local road sections according to the road nodes, wherein the method specifically comprises the following steps:

S3, generating an electronic map, inputting the information of the drivable road sections collected in the steps S1-S2 into the electronic map,

S4, recording the position of the robot as a starting point, the position of the destination as an ending point,

S5, marking the road where the starting point is located, marking the road where the ending point is located,

S6, if the road where the starting point is located and the road where the ending point is located have an intersection point, the road where the starting point is located and the ending point are remembered the intersection point of the located roads is a road intersection point,

S7, a road between the starting point and the road intersection point, a road between the ending point and the road intersection point, and two sections of roads form an overall route;

s8, if the road where the starting point is located and the road where the ending point is located have no intersection point, judging whether an auxiliary road exists or not, specifically:

s9, connecting the starting point and the ending point, if a road exists, and if an intersection point exists between a line segment of the road and the starting point and the ending point, and if an intersection point exists between the road of the starting point and the road of the ending point, the road is recorded as an auxiliary road, the intersection point of the road of the starting point and the auxiliary road is recorded as a first auxiliary intersection point, the intersection point of the road of the ending point and the auxiliary road is recorded as a second auxiliary intersection point,

S10, a road between a starting point and a first auxiliary intersection point, a road between the first auxiliary intersection point and a second auxiliary intersection point, a road between the second auxiliary intersection point and a termination point, three sections of roads form an overall route,

S11, if the number of the auxiliary roads is greater than 1, obtaining the distance of the overall route formed by each auxiliary road, selecting the auxiliary road corresponding to the minimum distance,

S12, if no auxiliary road exists, marking the road intersected with the road where the starting point is located and the road where the ending point is located, respectively obtaining the distances between all marked roads and the starting point, comparing one by one, selecting the marked road with the smallest distance between the marked roads and the starting point, remembering the intersection point of the road where the starting point is located and the marked road as a first road node, remembering the intersection point of the road where the ending point is located and the marked road as a second road node,

The road node is specifically an intersection point of two or more roads,

S13, forming an overall route by the roads between the starting point and the first road node, the roads between the first road node and the second road node, the roads between the second road node and the ending point and the three sections of roads, recording the overall route as a first route,

S14, respectively obtaining the distances between all marked roads and the stop points, comparing the distances one by one, selecting the marked road with the smallest distance between the marked roads and the stop points, marking the intersection point of the road with the marked road as a third road node, marking the intersection point of the road with the marked road as a fourth road node,

S15, forming an overall route by the three sections of roads, namely the road between the ending point and the third road node, the road between the third road node and the fourth road node, the road between the fourth road node and the starting point, and recording the overall route as a second route,

S16, comparing the distance between the first route and the second route, if the distance between the first route and the second route is smaller than or equal to the distance between the first route and the second route, selecting the first route, and if the distance between the first route and the second route is larger than the distance between the first route and the second route, selecting the second route; the overall route is segmented according to road nodes, and particularly a road between two adjacent road nodes is a local road section.

4. The method for positioning and navigating a robot vision according to claim 1, wherein: the infrared sensor and the camera equipped by the robot are used for scanning and shooting local road sections, marking obstacles and acquiring obstacle information, and the method specifically comprises the following steps:

S17, scanning the local road section by using an infrared sensor and a camera which are equipped with the robot, and acquiring the length, the width and the obstacle information in the local road section, wherein the obstacle information is specifically the position of the obstacle, the linear distance of the obstacle from the robot and the moving speed of the obstacle, a two-dimensional plane coordinate system is built by taking the plane of the ground of the local road section as a coordinate plane according to the collected local road section information and the collected obstacle information, and only the projected coordinates of the obstacle on the coordinate system are reserved in the coordinate system.

5. The method for positioning and navigating a robot vision according to claim 1, wherein: analyzing the moving track of the obstacle in the local road section, and analyzing and acquiring the moving area of the obstacle according to the moving track of the obstacle, wherein the moving area of the obstacle is specifically as follows:

S18, capturing video of the local road section by using an infrared sensor and a camera which are equipped with the robot,

S19, taking time as a sequence, according to the step S17, acquiring the coordinates of the same obstacle under different frames in a two-dimensional plane coordinate system, connecting the acquired first coordinate with the last coordinate for the same obstacle, taking the direction of the first coordinate to the last coordinate as a ray, taking the track of the ray as the moving track of the obstacle,

S20, taking coordinates on a ray as a center to make a circle, recording the circle as a track circle, and determining the radius of the track circle as the moving area of the obstacle according to the area formed by all track circles made on the ray, wherein the radius of the track circle is determined by the moving speed of the obstacle, specifically:

s21, obtaining the moving distance of the obstacle in a certain time, calculating the instantaneous speed of the obstacle according to the moving distance and the moving time,

S22, repeating the step S21, obtaining a plurality of instantaneous speeds of the obstacle, calculating an average value of all the instantaneous speeds, taking the average value as the moving speed of the obstacle, recording the moving speed of the obstacle as V with the unit of m/S,

S23, if V is less than or equal to 50, the radius of the obstacle track circle is (V/100) m,

S24, if V is more than 50, the radius of the obstacle track circle is 0.5m,

S25, executing S18-S24 operation on all the obstacles in the local road section, and generating a moving area of all the obstacles in the local road section, namely, an obstacle area.

6. The method for positioning and navigating a robot vision according to claim 1, wherein: the obstacle removing area is used for making a local route in the non-obstacle area, controlling the robot to avoid the obstacle, and completing navigation driving in the local road section according to the local route, wherein the navigation driving comprises the following specific steps:

s26, removing the obstacle area, controlling the robot to run in the non-obstacle area,

S27, when an obstacle exists in the front area of the robot during running, acquiring the moving direction of the obstacle,

S28, if the included angle formed by the moving direction of the obstacle and the moving direction of the robot is smaller than 90 degrees:

S29, acquiring the mapping speed of the obstacle in the moving direction of the robot, if the mapping speed of the obstacle in the moving direction of the robot is lower than the moving speed of the robot, reducing the moving speed of the robot until the moving speed of the robot is equal to the mapping speed of the obstacle in the moving direction of the robot,

S30, if the mapping speed of the obstacle in the moving direction of the robot is higher than or equal to the moving speed of the robot, the current moving direction and the moving speed of the robot are maintained;

s31, if the included angle formed by the moving direction of the obstacle and the moving direction of the robot is larger than or equal to 90 degrees:

S32, acquiring rays made according to the coordinates of the obstacle, making a straight line on one side close to the robot and parallel to the rays, and making the distance between the rays and the straight line be the radius of the obstacle track circle,

S33, if the straight line in which the moving direction of the robot is located and the made straight line have an intersection point, changing the moving direction of the robot until the straight line in which the moving direction of the robot is located and the made straight line have no intersection point,

And S34, if the straight line in which the moving direction of the robot is located and the made straight line have no intersection point, continuously maintaining the moving direction and the moving speed of the robot.

7. The method for positioning and navigating a robot vision according to claim 1, wherein: if the road of the partial road section in front of the robot is blocked in the running process of the robot, the temporary route adjustment is executed until the robot runs to the destination position, specifically:

If the road is blocked at the front part of the robot during the running of the robot, the temporary route adjustment is performed,

The temporary route adjustment is specifically as follows:

the robot stops running and steps S1-S34 are performed until the robot runs to the destination position.