KR102009479B1 - Apparatus and method for controlling mobile robot - Google Patents
Apparatus and method for controlling mobile robot Download PDFInfo
- Publication number
- KR102009479B1 KR102009479B1 KR1020150081534A KR20150081534A KR102009479B1 KR 102009479 B1 KR102009479 B1 KR 102009479B1 KR 1020150081534 A KR1020150081534 A KR 1020150081534A KR 20150081534 A KR20150081534 A KR 20150081534A KR 102009479 B1 KR102009479 B1 KR 102009479B1
- Authority
- KR
- South Korea
- Prior art keywords
- mobile robot
- circle
- area
- error
- obstacle
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
A mobile robot control apparatus according to an embodiment of the present invention is a device for controlling a mobile robot region composed of at least one circle, wherein the error is an extra area in which the at least one circle is not placed. A user interface for receiving a user input for selecting a size and a mobile robot region, extracting a mobile robot skeleton at which the center point of the at least one circle is located within the mobile robot region, and placing it on the mobile robot skeleton And a controller configured to calculate the number and positions of the at least one circle and to compare at least one of a distance value of an obstacle included in a pixel including the center point of the at least one circle and a radius of the at least one circle.
Description
The present invention relates to a mobile robot control apparatus and method for generating a path plan of a mobile robot.
A mobile robot is a device that automatically performs a task or operation, and is used to replace or assist a human in various fields. It is important to control the movement of a mobile robot in order to perform a task or service given to the mobile robot. The most basic task of researching mobile robots is safe driving in a dynamic environment. Research is underway on a control algorithm that ensures the safe operation of a mobile robot in a dynamic environment where a dynamically moving obstacle exists or the target point of the mobile robot changes. One of the basic studies aimed at safe driving of such a mobile robot is path planning, which generates a connected path from a starting point to a target point.
In the path planning, the distance information between the mobile robot and the obstacle is important information for determining whether the mobile robot collides with the obstacle.
An object of the present invention is to provide a mobile robot control apparatus and method for generating a path plan of a mobile robot accurately and quickly. The problem to be solved by the embodiments of the present invention is not limited to the above problem, and further problems can be inferred from the following embodiments.
In a mobile robot control apparatus according to an embodiment of the present invention, the mobile robot control apparatus determines a path of a mobile robot using a distance between an obstacle and a mobile robot region having a first area. A user interface for receiving a user input for selecting a magnitude of an error that is a maximum size of a third area excluding the second area from the first area to fill with at least one circle having a second area smaller than one area; and Specify a mobile robot region, extract a mobile robot skeleton at which the center point of the at least one circle is located in the mobile robot region, and use the magnitude of the error to determine the at least one circle to be placed on the mobile robot skeleton; Calculate the number and position of the at least one circle; and And a controller for comparing the distance value between the obstacles with a radius of the at least one circle.
In the present embodiment, the mobile robot skeleton includes at least one main axis, the control unit on the main axis by using the maximum length of the first area, the minimum length of the first area and the size of the error. The number and position of the main circles to be placed in can be calculated.
In the present embodiment, the mobile robot skeleton includes at least one diagonal axis shorter than the main axis, and the controller is at least one to be placed on the diagonal axis using the position of the at least one main circle and the magnitude of the error. It is possible to calculate the number and position of diagonal circles in.
In the present embodiment, when the distance value is larger than the radius of the at least one circle, the controller may determine that the at least one circle does not collide with the obstacle.
In a mobile robot control method according to an embodiment of the present invention, in the mobile robot control method of determining a path of a mobile robot by using a distance between an obstacle and a mobile robot area having a first area, Receiving a user input for selecting a magnitude of an error that is a maximum size of the third area excluding the second area from the first area to fill with at least one circle having a second area smaller than one area, pre-moving Specifying a robot region, extracting a mobile robot skeleton in which the center point of the at least one circle is located in the mobile robot region, and using the magnitude of the error, the at least one circle to be placed on the mobile robot skeleton Calculating a number and positions of the pixels; and calculating the number and positions of the pixels; Comparing the distance value between the obstacles to the radius of the at least one circle and determining that the at least one circle does not collide with the obstacle if the distance value is greater than the radius of the at least one circle. do.
According to the embodiments described above, it is possible to provide a mobile robot control apparatus and method for generating a path plan of a mobile robot accurately and quickly.
1 is a block diagram of a mobile robot control apparatus according to an embodiment of the present invention.
2 is a flowchart illustrating a mobile robot control method according to an embodiment of the present invention.
3 to 7 are views for explaining a process of generating a two-dimensional modeling image of a mobile robot for controlling the mobile robot according to an embodiment of the present invention.
As the inventive concept allows for various changes and numerous embodiments, particular embodiments will be illustrated in the drawings and described in detail in the written description. However, this is not intended to limit the present invention to specific embodiments, it should be understood to include all transformations, equivalents, and substitutes included in the spirit and scope of the present invention. In the following description of the present invention, if it is determined that the detailed description of the related known technology may obscure the gist of the present invention, the detailed description thereof will be omitted.
Hereinafter, exemplary embodiments of the present invention will be described in detail with reference to the accompanying drawings, and in the following description with reference to the accompanying drawings, the same or corresponding components are given the same reference numerals and redundant description thereof will be omitted. Shall be.
1 is a block diagram of a mobile robot control apparatus according to an embodiment of the present invention.
Referring to FIG. 1, the mobile
The
The
The distance measuring sensor (not shown) may collect information that recognizes a space to which the mobile robot moves, including, for example, an ultrasonic sensor, an infrared sensor, and a laser sensor.
The image capturing unit (not shown) may collect information photographing a space to which the mobile robot moves, including, for example, a camera or a stereo camera.
The environment information may include static environment maps, dynamic obstacle information, road information, and the like, and may be mission information such as navigation, patrols, and destination arrivals given to the mobile robot.
The
The
When the area of the mobile robot area is called the first area, the area of at least one circle to be placed on the mobile robot skeleton is called the second area, and the area of the area excluding the second area from the first area is called the third area. The
The
The
The
The
The route
The
The mobile
Hereinafter, referring to FIGS. 2 to 7, the mobile
2 is a flowchart illustrating a mobile robot control method according to an embodiment of the present invention.
Referring to FIG. 2, the
3 to 7 are views for explaining a process of generating a two-dimensional modeling image of a mobile robot for controlling the mobile robot according to an embodiment of the present invention.
Referring to FIG. 3, the
Referring back to FIG. 2, the
Referring to FIG. 3 again, the
In constructing the rectangular
The
The
Referring back to FIG. 2, the
Referring to FIGS. 4 and 5, the
The
The
Since the minimum number n is a positive integer, when the minimum number n calculated through Equation 2 is not a positive integer, the minimum number n, which is a positive integer, is calculated again using the decimal point rounding, 1 the center of the main circle (C 11) (a), a first main circle (C 11) and a second main circle (C 12) to re-calculate the difference (x) between the center point of the overlap region (b) of have.
For example, the
Referring back to FIG. 2, the
Referring to FIG. 6, the
When the reference coordinates (0,0) and the magnitude (e) of the error are determined, the
The
As described above, the
The
For example, the
Referring back to FIG. 2, the
Referring to FIG. 7, the
When the path plan of the mobile robot is generated based on the circle according to the embodiments of the present invention, the calculation amount is reduced compared to the case of generating the path plan of the mobile robot on a pixel basis, thereby enabling faster processing.
For example, if a mobile robot region having a length l of 1.69 m and a width w of 1.2 m is specified, according to the pixel-based processing method, the obstacles of each of 204 or 408 pixels are determined. It is necessary to determine whether or not the collision with the obstacle from the distance value. However, according to embodiments of the present disclosure, the
Meanwhile, the present invention can be embodied as computer readable codes on a computer readable recording medium. The computer-readable recording medium includes all kinds of recording devices in which data that can be read by a computer system is stored.
Examples of computer-readable recording media include ROM, RAM, CD-ROM, magnetic tape, floppy disks, optical data storage devices, and the like, which may also be implemented in the form of carrier waves (for example, transmission over the Internet). Include. The computer readable recording medium can also be distributed over network coupled computer systems so that the computer readable code is stored and executed in a distributed fashion. And functional programs, codes and code segments for implementing the present invention can be easily inferred by programmers in the art to which the present invention belongs.
So far I looked at the center with respect to the embodiment. Those skilled in the art will understand that the present invention can be embodied in a modified form without departing from the essential characteristics of the present invention. Therefore, the disclosed embodiments should be considered in descriptive sense only and not for purposes of limitation. The scope of the present invention is shown not in the above description but in the claims, and all differences within the scope should be construed as being included in the present invention.
100: mobile robot control device
110: control unit
120: environmental information generation unit
130: user interface
140: route plan generation unit
150: database
Claims (5)
A user input for selecting a magnitude of an error that is a maximum size of a third area excluding the second area from the first area so as to fill the mobile robot area with at least one circle having a second area smaller than the first area A user interface for receiving a message; And
Specify the mobile robot area, extract a mobile robot skeleton in which the center point of the at least one circle is located in the mobile robot area, and use the error size to place the at least one circle on the mobile robot skeleton And a controller configured to calculate a number and a position of the at least one and to compare a distance value between the pixel and the obstacle included in the pixel including the center point of the at least one circle with a radius of the at least one circle.
The mobile robot skeleton includes at least one main axis,
The control unit calculates the number and position of the main circle to be placed on the main axis, using the maximum length of the first area, the minimum length of the first area and the size of the error.
A user input for selecting a magnitude of an error that is a maximum size of a third area excluding the second area from the first area so as to fill the mobile robot area with at least one circle having a second area smaller than the first area Receiving;
Specifying the mobile robot area;
Extracting a mobile robot skeleton in which the center point of the at least one circle is located in the mobile robot area;
Calculating the number and position of the at least one circle to be placed on the mobile robot skeleton using the magnitude of the error;
Comparing a distance value between the pixel and the obstacle included in the pixel including the center point of the at least one circle with a radius of the at least one circle; And
And determining that the at least one circle does not collide with the obstacle when the distance value is greater than the radius of the at least one circle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020150081534A KR102009479B1 (en) | 2015-06-09 | 2015-06-09 | Apparatus and method for controlling mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020150081534A KR102009479B1 (en) | 2015-06-09 | 2015-06-09 | Apparatus and method for controlling mobile robot |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20160144848A KR20160144848A (en) | 2016-12-19 |
KR102009479B1 true KR102009479B1 (en) | 2019-08-09 |
Family
ID=57735569
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020150081534A KR102009479B1 (en) | 2015-06-09 | 2015-06-09 | Apparatus and method for controlling mobile robot |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102009479B1 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11338438B2 (en) * | 2019-01-25 | 2022-05-24 | Bear Robotics, Inc. | Method, system and non-transitory computer-readable recording medium for determining a movement path of a robot |
CN112528848B (en) * | 2020-12-11 | 2024-05-24 | 北京百度网讯科技有限公司 | Evaluation method, device, equipment and storage medium for obstacle detection |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008152599A (en) | 2006-12-19 | 2008-07-03 | Toyota Motor Corp | Moving route generation method, autonomous moving object, and autonomous moving object control system |
JP2008152600A (en) | 2006-12-19 | 2008-07-03 | Toyota Motor Corp | Moving route generation method, autonomous moving object, and autonomous moving object control system |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4717105B2 (en) * | 2008-08-29 | 2011-07-06 | 株式会社日立製作所 | Autonomous mobile robot apparatus and jump collision avoidance method in such apparatus |
KR101105325B1 (en) * | 2009-09-08 | 2012-01-16 | 부산대학교 산학협력단 | Method for Path-planning for Actual Robots |
KR101213632B1 (en) * | 2010-04-30 | 2012-12-18 | 동국대학교 산학협력단 | Method and apparatus of planning trajectory using multi-step configuration space |
-
2015
- 2015-06-09 KR KR1020150081534A patent/KR102009479B1/en active IP Right Grant
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008152599A (en) | 2006-12-19 | 2008-07-03 | Toyota Motor Corp | Moving route generation method, autonomous moving object, and autonomous moving object control system |
JP2008152600A (en) | 2006-12-19 | 2008-07-03 | Toyota Motor Corp | Moving route generation method, autonomous moving object, and autonomous moving object control system |
Also Published As
Publication number | Publication date |
---|---|
KR20160144848A (en) | 2016-12-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11567502B2 (en) | Autonomous exploration framework for indoor mobile robotics using reduced approximated generalized Voronoi graph | |
US10948907B2 (en) | Self-driving mobile robots using human-robot interactions | |
KR101048098B1 (en) | Robot route planning device and method | |
KR101539270B1 (en) | sensor fusion based hybrid reactive motion planning method for collision avoidance and autonomous navigation, recording medium and mobile robot for performing the method | |
EP3950235A1 (en) | Self-propelled robot path planning method, self-propelled robot and storage medium | |
JP6896103B2 (en) | Systems and methods for controlling vehicle motion | |
KR101864949B1 (en) | Method for building a grid map with mobile robot unit | |
JP5902275B1 (en) | Autonomous mobile device | |
JP5518579B2 (en) | Movable region extraction apparatus and movable region extraction method | |
CN111752276A (en) | Local path planning method and device, computer readable storage medium and robot | |
CN110000793B (en) | Robot motion control method and device, storage medium and robot | |
KR20200050246A (en) | Method for detecting 3d object from 2d image and apparatus thereof | |
CN113405557B (en) | Path planning method and related device, electronic equipment and storage medium | |
JP2017526083A (en) | Positioning and mapping apparatus and method | |
US20200192341A1 (en) | Collaborative Determination Of A Load Footprint Of A Robotic Vehicle | |
KR20180030167A (en) | Object detecting apparatus, object detecting method, and program | |
JP6743526B2 (en) | Information processing apparatus, information processing method, and program | |
US20220019227A1 (en) | Route planning apparatus, route planning method, and computer-readable recording medium | |
KR102009479B1 (en) | Apparatus and method for controlling mobile robot | |
WO2021246169A1 (en) | Information processing device, information processing system, method, and program | |
CN113607161B (en) | Robot navigation path width acquisition system, method, robot and storage medium | |
CN113932825B (en) | Robot navigation path width acquisition system, method, robot and storage medium | |
WO2020157990A1 (en) | Path planning device, path planning method, and computer-readable recording medium | |
Han et al. | Optimization‐based humanoid robot navigation using monocular camera within indoor environment | |
JP5765163B2 (en) | Self-position estimation apparatus, method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
N231 | Notification of change of applicant | ||
A201 | Request for examination | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |