Robot and method for planning path of the same
First Claim
1. A method comprising:
- setting a respective cell of a plurality of cells configuring a space in which a robot moves as a base cell, and storing coordinates of the base cell in a queue structure;
searching for and setting cells adjacent to the base cell as scan cells;
for each scan cell,calculating, by a computer, a movement direction of the robot from the base cell to the scan cell,wherein the movement direction includes a primary movement direction for moving the robot from the base cell to the scan cell, and a secondary movement direction for moving the robot from a cell preceding the base cell to the base cell,calculating, by the computer, a movement cost of the scan cell according to the calculated movement direction,comparing, by the computer, the calculated movement cost and a movement cost previously stored in the scan cell,determining, by the computer, based on said comparing, whether or not coordinates of the scan cell are to be stored in the queue structure and,storing, by the computer, the coordinates of the scan cell in the queue structure if it is determined by said determining that the coordinates are to be stored;
for each cell having coordinates stored in the queue structure,setting the respective cell as a base cell and,performing said searching and setting, said calculating a movement direction, said calculating a movement cost, said comparing, said determining and said storing, to thereby build a map of the space;
calculating, by the computer, a movement path of the robot based on the built map; and
configuring the robot to move along the calculated movement path.
1 Assignment
0 Petitions
Accused Products
Abstract
A robot and a method for planning a path of the robot. The method includes storing coordinates of a base cell in a queue structure, setting a plurality of cells adjacent to the base cell as scan cells, calculating a movement direction of the robot from the base cell to each of the scan cells, calculating movement cost of each of the scan cells according to the calculated movement direction, comparing the calculated movement cost and movement cost previously stored in each of the scan cells and determining whether or not coordinates of each of the scan cells are stored in the queue structure, and repeatedly performing a process of recording the movement direction and the movement cost in each of the scan cells and building a map of the movement space of the robot if the coordinates of each of the scan cells are stored in the queue structure.
5 Citations
21 Claims
-
1. A method comprising:
-
setting a respective cell of a plurality of cells configuring a space in which a robot moves as a base cell, and storing coordinates of the base cell in a queue structure; searching for and setting cells adjacent to the base cell as scan cells; for each scan cell, calculating, by a computer, a movement direction of the robot from the base cell to the scan cell, wherein the movement direction includes a primary movement direction for moving the robot from the base cell to the scan cell, and a secondary movement direction for moving the robot from a cell preceding the base cell to the base cell, calculating, by the computer, a movement cost of the scan cell according to the calculated movement direction, comparing, by the computer, the calculated movement cost and a movement cost previously stored in the scan cell, determining, by the computer, based on said comparing, whether or not coordinates of the scan cell are to be stored in the queue structure and, storing, by the computer, the coordinates of the scan cell in the queue structure if it is determined by said determining that the coordinates are to be stored; for each cell having coordinates stored in the queue structure, setting the respective cell as a base cell and, performing said searching and setting, said calculating a movement direction, said calculating a movement cost, said comparing, said determining and said storing, to thereby build a map of the space; calculating, by the computer, a movement path of the robot based on the built map; and configuring the robot to move along the calculated movement path. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12)
-
-
13. A robot comprising:
-
a driving unit configured to move the robot along a movement path; a sensor configured to sense an obstacle near the robot driven by the driving unit; a map builder configured to set a respective cell of a plurality of cells configuring a space in which the robot moves as a base cell, and store coordinates of the base cell in a queue structure, search for and set a plurality of cells adjacent to the base cell as scan cells, for each scan cell, calculate a movement direction of the robot from the base cell to the scan cell, wherein the movement direction of the robot further comprises a primary movement direction for moving the robot from the base cell to the scan cell, and a secondary movement direction for moving the robot from a cell preceding the base cell to the base cell, calculate movement cost of the scan cell according to the calculated movement direction, compare the calculated movement cost and a movement cost previously stored in the scan cell, determine, based on a result of said compare, whether or not coordinates of the scan cell are to be stored in the queue structure and, store the coordinates of the scan cell in the queue structure when it is determined that the coordinates are to be stored, and for each respective cell having coordinates stored in the queue structure, set the respective scan cell as a base cell and, perform said search and set, said calculate a movement direction, said calculate movement cost, said compare, said determine and said store to thereby build a map of the space of the robot; a movement calculator configured to calculate a movement path of the robot based on the map built by the map builder; and the robot configured to move along the movement path calculated by the movement path calculator. - View Dependent Claims (14, 15, 16, 17, 18, 19, 20, 21)
-
Specification