A route planning device that is capable of comprehending, in advance, a route clearance at a pass-through point on a planned travel route, includes a global map acquisition unit arranged to generate a global map showing an obstacle area in which an obstacle exists, an extended area generation unit arranged to generate an extended obstacle area and three extended area by extending stepwise an outline of the obstacle area contained in the global map, an integrated map generation unit arranged to generate an integrated map by superposing for integration of the extended obstacle area with the three extended areas; a movable area extraction unit arranged to extract a movable area from the integrated map and thinning the same, and a route planning unit arranged to acquire a route clearance at a sub goal according to the extended areas on the integrated map to which the sub goal on the travel route belongs, upon planning the travel route from the thinned movable area.
Legal claims defining the scope of protection. Each claim is shown in both the original legal language and a plain English translation.
1. A route planning device for planning a travel route to be used by an autonomous mobile device, which travels along the travel route, before the autonomous mobile device travels autonomously, the device comprising: an environmental map acquisition unit arranged to acquire an environmental map showing an obstacle area in which an obstacle exists; a movable area extraction unit arranged to extract a movable area from the environmental map acquired by the environmental map acquisition unit and thinning the extracted movable area; a route planning unit arranged to plan a travel route from the thinned movable area extracted by the movable area extraction unit by searching for the shortest route to the destination; a linearization unit arranged to linearize the travel route planned by the route planning unit without interfering with the obstacle area; and a smoothing unit arranged to smooth the travel route linearized by the linearization unit without interfering with the obstacle area; wherein the smoothing unit extracts a point on the linearized travel route and two points on the linearized travel route sandwiching the point, connects the two points with a straight line, and, when the connected straight line does not interfere with the obstacle area, re-sets the straight line as a travel route which connects the two points; and the smoothing unit smoothes the travel route when an angle formed by the extracted three points is not greater than a certain value that is set forth according to mobility of the autonomous mobile device.
A route planning system designs paths for autonomous robots before they move. It starts by creating a map showing where obstacles are. Then, it finds the areas where the robot *can* move and simplifies these areas. To plan a route, it searches for the shortest path to the destination within these simplified movable areas. The planned route is then converted into a straight line path that avoids all obstacles, followed by a smoothing process. Smoothing works by picking three points along the path, connecting the outer two with a straight line, and replacing the original path with this straight line, so long as the new line doesn't hit any obstacles. This smoothing process is only performed if the angle formed by the three points is small enough based on the robot's movement capabilities.
2. The route planning device according to claim 1 , wherein the movable area extraction unit generates an extended obstacle area by extending the outline of the obstacle area on the environmental map in an amount corresponding to a radius of the autonomous mobile device, and extracts an area excluding the extended obstacle area as the movable area.
The route planning system described above creates a movable area by expanding the obstacle boundaries on the map. The expansion amount matches the autonomous mobile device's radius. This expanded area represents a "no-go" zone around each obstacle, ensuring the robot will not collide with anything. The movable area then consists of everything *outside* these expanded obstacle zones. This movable area is used when planning the shortest travel route to the destination, avoiding the extended obstacle areas.
3. An autonomous mobile device which travels along a planned travel route in an ambient environment, the autonomous mobile device comprising the route planning device according to claim 1 .
An autonomous mobile device navigates its environment using a pre-planned route generated by the route planning system described above. This system first creates a map showing where obstacles exist. Then, it finds and simplifies the areas where the robot *can* move. To plan a route, it searches for the shortest path to the destination within these simplified movable areas. The planned route is then converted into a straight line path that avoids all obstacles, followed by a smoothing process. Smoothing works by picking three points along the path, connecting the outer two with a straight line, and replacing the original path with this straight line if no obstacles are contacted. This smoothing process is only performed if the angle formed by the three points is small enough based on the robot's movement capabilities.
Cooperative Patent Classification codes for this invention. Click any code to explore related patents in that topic.
August 24, 2009
August 20, 2013
Browse 5M+ US patents with plain-English claim translations and AI-generated analysis.