Route setting method, program, and moving body
The objective of the present invention is to move appropriately along a set reference route. This route setting method includes: a step for acquiring information relating to a reference route, which is a route along which a moving body moves; a step for determining whether the moving body is positioned on the reference route; and a step for setting a return route, which is a route for arriving at a merging position on the reference route, if the moving body is not positioned on the reference route.
1 . A route setting method comprising:
a step of acquiring information of a reference route which is a route along which a moving body moves;
a step of determining whether or not the moving body is positioned on the reference route;
a step of setting a return route which is a route for reaching a merging position on the reference route in a case where the moving body is not positioned on the reference route; and
a step of moving the moving body along the return route to the merging position,
wherein in the step of setting the return route, a route including either a single linear route having a linear shape that approaches the merging position, a single arc route having an arc shape that approaches the merging position, or a combination of a single linear route having a linear shape that approaches the merging position and a single arc route having an arc shape that approaches the merging position is set as a first candidate route,
if it is determined that the first candidate route does not interfere with an obstacle, the first candidate route is set as the return route,
if it is determined that the first candidate route interferes with an obstacle, a portion of a second candidate route that does not interfere with an obstacle is set as the return route, the second candidate route including a turning route away from the merging position.
2 . The route setting method according to claim 1 ,
wherein in the step of setting the return route, the merging position is selected from among a plurality of candidate positions on the reference route, and the return route to the selected merging position is set.
3 . The route setting method according to claim 2 ,
wherein in the step of setting the return route, a candidate route to the candidate position is set for each of the candidate positions, and the return route is selected from among a plurality of the candidate routes.
4 . The route setting method according to claim 1 ,
wherein in the step of setting the return route, a turn radius of the arc route is set by a binary search in which a minimum turn radius set in advance is set as a minimum value and a maximum turn radius set in advance is set as a maximum value.
5 . The route setting method according to claim 1 ,
wherein in the step of setting the return route, the return route is set based on an approach route for approaching a target object in a case where the moving body is not positioned on the reference route because the moving body has moved along the approach route from the reference route.
6 . The route setting method according to claim 1 ,
wherein in the step of acquiring the information of the reference route, information of a plurality of the reference routes is acquired, and
in the step of setting the return route, the return route for reaching the merging position is set for each of the plurality of reference routes, and the reference route to be used for the movement of the moving body is selected from among the reference routes based on each of the return routes.
7 . The route setting method according to claim 1 , further comprising:
a step of setting a periphery of the return route to a prohibited region in which a movement of another moving body is not permitted, while the moving body is moving along the return route.
8 . The route setting method according to claim 1 ,
wherein in the step of setting the return route, a linear route that is away from the merging position is set as the turning route.
9 . The route setting method according to claim 1 ,
wherein in the step of setting the return route, in a case where there are a plurality of candidate routes that do not interfere with an obstacle from among candidate routes for the return route including the turning route, a candidate route in which a turn radius of the arc route is at its maximum is selected as the return route from among the plurality of candidate routes.
10 . A non-transitory computer-readable storage medium storing a program causing a computer to execute:
a step of acquiring information of a reference route which is a route along which a moving body moves;
a step of determining whether or not the moving body is positioned on the reference route;
a step of setting a return route which is a route for reaching a merging position on the reference route in a case where the moving body is not positioned on the reference route; and
a step of moving the moving body along the return route to the merging position,
wherein in the step of setting the return route, a route including either a single linear route having a linear shape that approaches the merging position, an single arc route having an arc shape that approaches the merging position, or a combination of a single linear route having a linear shape that approaches the merging position and an single arc route having an arc shape that approaches the merging position is set as a first candidate route,
if it is determined that the first candidate route does not interfere with an obstacle, the first candidate route is set as the return route,
if it is determined that the first candidate route interferes with an obstacle, a portion of a second candidate route that does not interfere with an obstacle is set as the return route, the second candidate route including a turning route away from the merging position.
11 . A moving body that automatically moves, comprising:
a non-transitory memory configured to store a program;
a processor configured to execute the program stored on the memory to cause the moving body to:
acquire information of a reference route which is a route for moving;
acquire a return route which is a route for reaching a merging position on the reference route in a case where the moving body is not positioned on the reference route; and
move the moving body along the return route to the merging position,
set a first candidate route in which is a route including either a single linear route having a linear shape that approaches the merging position, an single arc route having an arc shape that approaches the merging position, or a combination of a single linear route having a linear shape that approaches the merging position and an single arc route having an arc shape that approaches the merging position,
if it is determined that the first candidate route does not interfere with an obstacle, the first candidate route is set as the return route,
if it is determined that the first candidate route interferes with an obstacle, a portion of a second candidate route that does not interfere with an obstacle is set as the return route, the second candidate route including a turning route away from the merging position.