KR20120069949A - 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 - Google Patents
이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 Download PDFInfo
- Publication number
- KR20120069949A KR20120069949A KR1020100131295A KR20100131295A KR20120069949A KR 20120069949 A KR20120069949 A KR 20120069949A KR 1020100131295 A KR1020100131295 A KR 1020100131295A KR 20100131295 A KR20100131295 A KR 20100131295A KR 20120069949 A KR20120069949 A KR 20120069949A
- Authority
- KR
- South Korea
- Prior art keywords
- path
- cost
- point
- turning
- grid
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 107
- 230000001172 regenerating effect Effects 0.000 claims abstract description 5
- 230000008929 regeneration Effects 0.000 claims description 7
- 238000011069 regeneration method Methods 0.000 claims description 7
- 210000004185 liver Anatomy 0.000 claims description 2
- 101100462378 Danio rerio otpb gene Proteins 0.000 description 18
- 238000004088 simulation Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000005283 ground state Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/162—Mobile manipulator, movable base with manipulator arm mounted on it
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S901/00—Robots
- Y10S901/01—Mobile robot
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
본 발명은 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇에 관한 것이다. 본 발명에 따른 이동 로봇의 최적 경로 생성 방법은 격자 지도를 구성하는 각각의 격자점에 할당된 격자 비용에 기초한 제1 경로 생성 방법을 통해 출발 위치로부터 목표 위치까지의 1차 경로가 생성되는 단계와, 상기 1차 경로 상의 적어도 일부 경로가 상기 격자 비용에 기초한 제2 경로 생성 방법을 통해 재생성되어 최종 경로가 생성되는 단계를 포함하는 것을 특징으로 한다. 이에 따라, 그라디언트 방법(Gradient method)과 같은 제1 경로 생성 방법에 따라 생성된 1차 경로를 제1 경로 생성 방법을 통해 수정하여 보다 매끄러운(Smooth) 형태의 경로로 재생성할 수 있다.
Description
본 발명은 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇에 관한 것으로서, 보다 상세하게는 그라디언트 방법(Gradient method)과 같은 기존의 경로 생성 방법에 따라 생성된 경로를 수정하여 보다 매끄러운(Smooth) 형태의 경로로 재생성하는 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇에 관한 것이다.
로봇이 실생활에 적용되기 위해서는 로봇 기술 분야에서 해결하여야 하는 다양한 문제들이 아직 존재하고 있는 것이 현실이다. 특히, 자율형의 이동 로봇이 사람과 비슷한 신뢰성 있는 주행이 이루어지지 않는 경우에는 로봇의 실용화는 현실적으로 많은 어려움에 직면하게 된다.
이와 같은 이동 로봇의 신뢰성 있는 주행이 이루어지기 위해 선행되어야 하는 것이 이동 로봇이 원하는 목표 위치까지 센서를 통해 자신의 위치를 추정해 가면서 최적의 경로 계획을 세우는 것이다. 그리고, 수립된 경로 계획에 따르면서 실시간 상황에 알맞게 움직일 수 있도록 모터나 바퀴의 방향을 제어하여 목표 위치에 도착하는 일련의 과정이 완벽히 이루어져야 한다.
여기서, 경로 계획을 세우는 방법, 즉 경로 생성 방법으로는 로드맵(Roadmap) 방법, 셀 분할(Cell decomposition) 방법, 포텐셜 필드(Potential field) 방법이 있으며, 근래에는 Konolige가 발표한 그라디언트 방법(Gradient method)가 경로 생성 방법을 널리 활용되고 있다.
그라디언트 방법에서는, 장소에 대해 일정한 크기의 격자 공간으로 만들어진 격자 지도가 주어진 상태에서, 먼저 각 격자 공간 또는 격자점에 대한 고유 비용(Intrinsic cost)이 수치적으로 계산된다. 여기서, 고유 비용은 각 격자 공간과 장애물 간의 거리나, 해당 격자 공간의 바닥 상태, 예를 들어 미끄러짐 정도 등의 위험도에 대한 비용이다.
그런 다음, 목표 위치가 주어지고, 해당 목표 위치로부터, 도 1에 도시된 바와 같이, 주변 8개 방향으로 이동할 격자점에 대해 근접 비용(Adjacent cost)이 격자 지도 상에 있는 모든 격자점에 대해 수치적인 값으로 주어진다. 여기서, 근접 비용은 하나의 격자점에서 다른 격자점으로 이동하는데 발생하는 거리에 대한 비용이다.
그리고, 모든 격자 공간과 격자점에 대해 고유 비용과 근접 비용이 수치적인 값으로 주어진 상태에서, 각 격자점이 가지고 있는 수치적 값을 이용하여 생성되는 등록선인 웨이브프론트(Wavefront)를 생성하게 된다. 이에 따라, 이동 로봇은 격자 지도 상의 어느 위치에 있더라도 자신의 위치로부터 목표 위치까지 최소 비용이 드는 격자점을 찾아서 이동 가능하게 한다.
그런데, 그라디언트 방법(Gradient method)은, 도 1에 도시된 바와 같이, 한 격자점으로부터 8개 방향으로 존재하는 다른 격자점까지 이동하는 비용을 계산하기 때문에, 웨이브프론트(Wavefront)에 의해 최소의 비용이 드는 상, 하, 좌, 우, 대각선(즉 45° 방향)에 위치하는 다음 격자점으로만 이동이 가능하게 경로를 생성한다.
이는 그라디언트 방법(Gradient method)이 지역적인 최소 비용의 경로를 찾아서 전체 경로를 찾는 방식을 사용하고 있으므로, 전역적인 관점에서 볼 때 최적의 경로, 예컨대, 전역적으로 더 근접하고 적은 회전 횟수와 다양한 각도로 이동할 수 있는 최적의 경로를 생성해 주지 못하는 단점으로 작용하게 된다.
도 2는 그라디언트 방법(Gradient method)에 의해 생성된 경로의 예를 도시한 도면으로, 출발 위치로부터 목표 위치까지 이동할 때 벽 쪽으로 방향을 전환한 뒤 벽을 따라 직진을 하는 경로를 생성함을 확인할 수 있다. 이러한 한계는 격자 지도가 사각형 셀을 기본으로 하고 그 기본을 바탕으로 지역적으로만 계산을 하기 때문에 발생하게 된다.
이에, 본 발명은 상기와 같은 문제점을 해결하기 위해 안출된 것으로서, 그라디언트 방법(Gradient method)과 같은 기존의 경로 생성 방법에 따라 생성된 경로를 수정하여 보다 매끄러운(Smooth) 형태의 경로로 재생성하는 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇을 제공하는데 그 목적이 있다.
상기 목적은 본 발명에 따라, 이동 로봇의 최적 경로 생성 방법에 있어서, 격자 지도를 구성하는 각각의 격자점에 할당된 격자 비용에 기초한 제1 경로 생성 방법을 통해 출발 위치로부터 목표 위치까지의 1차 경로가 생성되는 단계와, 상기 1차 경로 상의 적어도 일부 경로가 상기 격자 비용에 기초한 제2 경로 생성 방법을 통해 재생성되어 최종 경로가 생성되는 단계를 포함하는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법에 의해서 달성된다.
여기서, 상기 제1 경로 생성 방법은 그라디언트 방법(Gradient method)이 적용될 수 있다.
그리고, 상기 제2 경로 생성 방법은 (a) 상기 목표 위치 방향으로 상기 제1 경로 상에 순차적으로 위치하는 제1 방향 전환 격자점, 제2 방향 전환 격자점, 제3 방향 전환 격자점을 검출하는 단계와; (b) 상기 제2 방향 전환 격자점과 상기 제3 방향 전환 격자점 사이의 상기 제1 경로 상에서 적어도 하나의 중계점을 설정하는 단계와; (c) 상기 제1 방향 전환 격자점, 상기 각 중계점 및 상기 제3 방향 전환 격자점을 연결하는 각각의 후보 경로에 대한 중계점 경로 비용을 상기 격자 비용에 기초하여 산출하는 단계와; (d) 최소의 중계점 경로 비용을 발생하는 최소 비용 중계점을 추출하는 단계와; (e) 상기 제1 방향 전환 격자점, 상기 최소 비용 중계점 및 상기 제3 방향 전환 격자점을 연결하는 후보 경로가 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경로를 대체하여 재생성되는 단계를 포함할 수 있다.
그리고, 상기 제2 경로 생성 방법은 상기 출발 위치를 첫 번째 상기 제1 방향 전환 격자점으로 하여 상기 1차 경로 상의 방향 전환 격자점들에 대해 상기 (a) 단계 내지 상기 (e) 단계를 수행하여 경로가 재생성될 수 있다.
또한, 상기 제2 경로 생성 방법은 (f) 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경우의 경로 비용을 추출하는 단계와, (g) 상기 (f) 단계에서 산출된 경로 비용과 상기 최소 중계점 경로 비용을 비교하는 단계를 더 포함하고; 상기 (e) 단계는 상기 최소 중계점 경로 비용이 상기 (f) 단계에서 산출된 경로 비용보다 작은 경우 수행될 수 있다.
그리고, 상기 (b) 단계에서는 상기 제3 방향 전환 격자점이 상기 중계점의 하나로 설정되며; 상기 (c) 단계에서는 상기 제1 방향 전환 격자점과 상기 제3 방향 전환 격자점을 연결하는 후보 경로에 대한 중계점 경로 비용이 산출되며; 상기 (d) 단계에서 상기 최소 비용 중계점으로 상기 제3 방향 전환 격자점이 추출되는 경우, 상기 (e) 단계에서 상기 제1 방향 전환 격자점과 상기 제3 방향 전환 격자점을 연결하는 상기 후보 경로가 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경로를 대체하여 재생성될 수 있다.
그리고, 상기 격자 비용은 그라디언트 방법 상의 고유 비용(Intrinsic cost)과 근접 비용(Adjacent cost)을 포함하며; 상기 (c) 단계에서 상기 중계점 경로 비용은 상기 후보 경로가 통과하는 격자 공간을 형성하는 격자점들의 상기 고유 비용에 기초하여 산출되는 공간 고유 비용과, 상기 제1 방향 전환 격자점과 상기 중계점 간의 상기 근접 비용의 합에 의해 산출될 수 있다.
그리고, 상기 (c) 단계는 (c1) 상기 격자 공간을 형성하며 한 방향으로 배열되는 변들과 상기 후보 경로가 교차하는 적어도 하나의 교차점을 추출하는 단계와; (c2) 상기 변을 형성하는 한 쌍의 격자점에 할당된 상기 고유 비용과, 상기 한 쌍의 격자점 각각과 상기 교차점 간의 거리에 기초하여 상기 교차점에 대한 교차점 고유 비용을 산출하는 단계와; (c3) 상기 교차점에 대해 산출된 상기 교차점 고유 비용을 합산하여 상기 공간 고유 비용을 산출하는 단계를 포함할 수 있다.
또한, 상기 교차점 고유 비용은 수학식 ICcp = ICg1×L2 + ICg2×L1 (여기서, ICcp는 상기 교차점 고유 비용이고, ICg1과 ICg2는 상기 한 쌍의 격자점 각각의 상기 고유 비용이고, L1은 상기 고유 비용이 ICg1인 격자점과 상기 교차점 간의 거리이고, L2는 상기 고유 비용이 ICg2인 격자점과 상기 교차점 간의 거리이다)에 의해 산출될 수 있다.
한편, 상기 목적은 본 발명의 다른 실시 형태에 따라, 상기 최적 경로 생성 방법이 적용된 이동 로봇에 의해서도 달성될 수 있다.
상기와 같은 구성을 통해, 본 발명에 따르면 그라디언트 방법(Gradient method)과 같은 제1 경로 생성 방법에 따라 생성된 1차 경로를 제1 경로 생성 방법을 통해 수정하여 보다 매끄러운(Smooth) 형태의 경로로 재생성하는 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇이 제공된다.
여기서, 경로 비용 측면에서도 전체 경로 비용을 줄여 보다 효율적인 최종 경로의 생성이 가능하며, 전체 경로를 주행하는데 있어 이동 로봇의 회전 각도가 보다 다양해짐과 동시에 회전 횟수 또한 감소되어 보다 매끄러운 주행이 가능하게 된다.
도 1은 기존의 그라디언트 방법(Gradient method)에 적용된 이동 로봇의 회전 방향을 설명하기 위한 도면이고,
도 2는 기존의 그라디언트 방법에 의해 생성된 경로의 예를 나타낸 도면이고,
도 3은 본 발명에 따른 이동 로봇의 최적 경로 생성 방법을 설명하기 위한 제어 흐름도이고,
도 4는 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서 중계점을 설정한 예를 설명하기 위한 도면이고,
도 5는 본 발명에 따른 이동 로봇이 최적 경로 생성 방법에서 중계점 경로 비용의 산출 방법을 설명하기 위한 도면이고,
도 6 및 도 7은 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에 따른 시뮬레이션 예를 설명하기 위한 도면이다.
도 2는 기존의 그라디언트 방법에 의해 생성된 경로의 예를 나타낸 도면이고,
도 3은 본 발명에 따른 이동 로봇의 최적 경로 생성 방법을 설명하기 위한 제어 흐름도이고,
도 4는 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서 중계점을 설정한 예를 설명하기 위한 도면이고,
도 5는 본 발명에 따른 이동 로봇이 최적 경로 생성 방법에서 중계점 경로 비용의 산출 방법을 설명하기 위한 도면이고,
도 6 및 도 7은 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에 따른 시뮬레이션 예를 설명하기 위한 도면이다.
이하에서는 첨부된 도면을 참조하여 본 발명을 상세히 설명한다.
도 3은 본 발명에 따른 이동 로봇의 최적 경로 생성 방법을 설명하기 위한 도면이다. 여기서, 본 발명에 따른 이동 로봇의 최적 경로 생성 방법의 적용에 있어, 이동 로봇에는 이동 로봇의 주행 환경에 대한 격자 지도가 등록된 상태로 적용된다.
먼저, 격자 지도 상에서 출발 위치와 목표 위치가 설정되면(S30), 격자 지도를 구성하는 각각의 격자점에 대해 할당된 격자 비용에 기초한 제1 경로 생성 방법을 통해 출발 위치로부터 목표 위치까지의 경로가 생성된다.(S31). 여기서, 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서는 제1 경로 생성 방법으로 그라디언트 방법(Gradient method)이 적용되는 것을 예로 한다.
보다 구체적으로 설명하는 격자 지도 상의 각각의 격자점에 대한 격자 비용은 고유 비용(Intrinsic cost)과 근접 비용(Adjacent cost)을 포함한다. 여기서, 고유 비용은 각 격자 공간과 장애물 간의 거리나, 해당 격자 공간의 바닥 상태, 예를 들어 미끄러짐 정도 등의 위험도에 대한 비용을 의미하며, 근접 비용은, 도 1에 도시된 바와 같이, 8개 방향으로 이동할 격자점에 대한 이동 거리에 대한 비용을 의미한다. 본 발명에 따른 이동 로봇의 최적 경로 생성 방법의 제1 경로 생성 방법으로 적용되는 그라디언트 방법(Gradient method)에 대한 상세한 설명은 생략한다.
상기와 같이, 그라디언트 방법(Gradient method)을 통해 출발 위치로부터 목표 위치까지의 1차 경로(P1, 도 7 참조)가 생성되면, 1차 경로(P1) 상의 적어도 일부 경로를 격자 비용에 기초한 제2 경로 생성 방법을 통해 재생성하여 최종 경로(Popt)를 생성하는 과정을 수행하게 된다.
도 3을 참조하여 최종 경로(Popt)를 생성하기 위한 제2 경로 생성 방법에 대해 보다 구체적으로 설명하면, 먼저, 출발 위치로부터 제1 방향 전환 격자점(OTP1), 제2 방향 전환 격자점(OTP2) 및 제3 방향 전환 격자점(OTP3)을 추출한다(S32). 최초 경로 재생성 과정에서 제1 방향 전환 격자점(OTP1)은 이동 로봇의 초기 위치로 설정된다.
그리고, 각각의 방향 전환 격자점은 제1 경로 생성 방법을 통해 생성된 1차 경로(P1) 상에서 이동 로봇의 방향이 전환되는 위치의 격자점들이 선택된다. 도 4를 참조하여 설명하면, 출발 위치가 제1 방향 전환 격자점(OTP1)으로 설정되고, 1차 경로(P1) 상에서 첫 번째 방향 전환이 발생하는 격자점이 제2 방향 전환 격자점(OTP2)으로 설정되고, 두 번째 방향 전환이 발생하는 격자점이 제3 방향 전환 격자점(OTP3)으로 설정된다.
상기와 같이, 제1 방향 전환 격자점(OTP1), 제2 방향 전환 격자점(OTP2) 및 제3 방향 전환 격자점(OTP3)이 설정되면, 제2 방향 전환 격자점(OTP2)과 제3 방향 전환 격자점(OTP3) 사이의 제1 경로 상에서 적어도 하나의 중계점(TP1,TP2,TP3)을 설정한다(S33). 이 때, 중계점(TP1,TP2,TP3)은 제2 방향 전환 격자점(OTP2)과 제3 방향 전환 격자점(OTP3) 사이의 제1 경로 상에 존재하는 격자점들로 설정되는 것을 예로 한다. 또한, 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서는 제3 방향 전환 격자점(OTP3)도 중계점(TP1,TP2,TP3)의 하나로 설정되는 것을 예로 한다.
그런 다음, 각각의 중계점(TP1,TP2,TP3)에 대해, 제1 방향 전환 격자점(OTP1), 중계점(TP1,TP2,TP3) 및 제3 방향 전환 격자점(OTP3)을 연결하는 후보 경로에 대한 중계점 경로 비용을 격자 비용에 기초하여 산출한다(S34).
본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서는, 중계점 경로 비용이 해당 중계점(TP1,TP2,TP3)에 대한 후보 경로가 통과하는 격자 공간을 형성하는 격자점들의 고유 비용에 기초하여 산출되는 공간 고유 비용과, 제1 방향 전환 격자점(OTP1)과 중계점(TP1,TP2,TP3) 간의 근접 비용의 합에 의해 산출되는 것을 예로 한다. 여기서, 중계점 경로 비용의 산출에 적용되는 근접 비용은 상술한 그라디언트 방법(Gradient method)에 의해 산출되는 바, 그 상세한 설명은 생략한다.
이하에서는, 도 5를 참조하여 본 발명에 따른 공간 고유 비용의 산출 방법에 대해 설명한다.
먼저, 격자 공간을 형성하는 4개의 변 중 일 방향으로 배열된 변들과, 후보 경로가 교차하는 교차점(CP1,CP2,CP3)들을 추출한다. 도 5에서는 가로 방향으로 배열된 변들과 후보 경로가 교차하는 교차점(CP1,CP2,CP3)을 추출하는 것을 예로 하고 있으며, 3개의 교차점(CP1,CP2,CP3)이 형성되는 예를 도시하고 있다.
그런 다음, 해당 변을 형성하는 한 쌍의 격자점에 할당된 고유 비용과, 한 쌍의 격자점 각각과 교차점(CP1,CP2,CP3) 간의 거리에 기초하여, 해당 교차점(CP1,CP2,CP3)에 대한 고유 비용인 교차점 고유 비용이 산출된다. 여기서, 하나의 교차점(CP1,CP2,CP3)에 대한 교차점 고유 비용은 [수학식 1]을 통해 산출되는 것을 예로 한다.
[수학식 1]
ICcp = ICg1×L2 + ICg2×L1
[수학식 1]에서, ICcp는 교차점 고유 비용이고, ICg1과 ICg2는 한 쌍의 격자점 각각의 고유 비용이고, L1은 고유 비용이 ICg1인 격자점과 교차점(CP1,CP2,CP3) 간의 거리이고, L2는 고유 비용이 ICg2인 격자점과 교차점(CP1,CP2,CP3) 간의 거리이다
상기와 같이 하나의 후보 경로 상의 교차점(CP1,CP2,CP3)들에 대해 교차점 고유 비용이 산출되면, 교차점 고유 비용을 합산하여 공간 고유 비용을 산출하며, 공간 고유 비용과 근접 비용의 합을 통해 해당 중계점 경로 비용이 산출된다. 이 때, 산출된 중계점 경로 비용은 제1 방향 전환 격자점(OTP1), 중계점(TP1,TP2,TP3) 및 제3 방향 전환 격자점(OTP3)을 연결하는 전체 경로에 대한 경로 비용으로 산출됨은 상술한 바와 같다.
한편, 각각의 중계점(TP1,TP2,TP3)에 대한 중계점 경로 비용이 산출되면, 중계점(TP1,TP2,TP3) 중 최소의 중계점 경로 비용을 발생하는 중계점(TP1,TP2,TP3)을 최소 비용 중계점으로 추출한다(S35). 여기서, 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서는 최소 비용 중계점의 중계점 경로 비용과 1차 경로(P1)의 경로 비용을 비교한다(S36).
이 때, 1차 경로(P1)의 경로 비용은 제1 방향 전환 격자점(OTP1)으로부터 제2 방향 전환 격자점(OTP2)을 거쳐 제3 방향 전환 격자점(OTP3)을 연결하는 1차 경로(P1)의 일부이며, 해당 경로 비용은 그라디언트 방법(Gradient method)을 이용한 1차 경로(P1)의 생성시 계산된 경로 비용들로부터 추출될 수 있다.
여기서, 중계점 경로 비용이 1차 경로(P1)의 경로 비용보다 작은 경우 제1 방향 전환 격자점(OTP1), 최소 비용 중계점 및 제2 방향 전환 격자점(OTP2)을 연결하는 경로가 기존의 1차 경로(P1)를 대신하여 새로운 경로로 재생된다(S37). 반면, 중계점 경로 비용이 1차 경로(P1)의 경로 비용보다 큰 경우에는 해당 경로 구간에서는 1차 경로(P1)가 그대로 유지된다.
상술한 바와 같이, 출발 위치를 첫 번째 제1 방향 전환 격자점(OTP1)으로 하는 경로 재생성 과정이 완료되면, 다른 방향 전환 격자점들에 대한 경로 재생성 과정을 진행한다. 먼저, 다음번의 경로 재생성을 위한 제1 방향 전환 격자점(OTP1), 제2 방향 전환 격자점(OTP2) 및 제3 방향 전환 격자점(OTP3)을 검출한다(S39). 그리고, 상술한 바와 같이, S33 단계 내지 S37 단계를 수행하여 제1 방향 전환 격자점(OTP1), 제2 방향 전환 격자점(OTP2) 및 제3 방향 전환 격자점(OTP3)을 연결하는 1차 경로(P1)의 재생성 여부가 결정된다.
여기서, 경로 재생성을 위한 제1 방향 전환 격자점(OTP1)의 선택은, 이전 단계의 경로 재생성 과정에서의 제3 방향 전환 격자점(OTP3)을 다음 단계에서의 제1 방향 전환 격자점(OTP1)으로 설정하는 방법으로 수행하여, 1차 경로(P1) 전체에 대해 순차적으로 진행하는 것을 예로 한다.
그리고, 1차 경로(P1)의 각 구간별로 새로운 경로가 부분적으로 재생성되는 과정이 완료되면, 전체 재생성된 구간과 1차 경로(P1)의 기존 구간을 연결하여 새로운 최적 경로를 생성(S40)함으로써, 경로 생성을 종료하게 된다.
한편, 본 발명에 따른 이동 로봇의 최적 경로 생성 방법에서는 제3 방향 전환 격자점(OTP3)이 중계점(TP1,TP2,TP3)의 하나로 설정되는 것을 예로 한다. 즉, 제1 방향 전환 격자점(OTP1)과 제3 방향 전환 격자점(OTP3)을 연결하는 경로가 후보 경로가 되며, 이 후보 경로에 대한 중계점 경로 비용이 산출된다.
이 때, 제1 방향 전환 격자점(OTP1)과 제3 방향 전환 격자점(OTP3)을 연결하는 후보 경로가 최소의 중계점 경로 비용으로 판단되고, 해당 중계점 경로 비용이 기존의 1차 경로(P1)의 경로 비용보다 적은 경우 제1 방향 전환 격자점(OTP1)과 제3 방향 전환 격자점(OTP3)을 연결하는 후보 경로가, 기존의 1차 경로(P1) 구간, 즉 제1 방향 전환 격자점(OTP1), 제2 방향 전환 격자점(OTP2) 및 제3 방향 전환 격자점(OTP3)을 연결하는 경로를 대체하여 재생성된다.
이하에서는 도 6 및 도 7을 참조하여 본 발명에 따른 이동 로봇의 최적 경로 생성 방법의 시뮬레이션 예에 대해 설명한다. 먼저, 제1 경로 생성 방법 및 제2 경로 생성 방법에 적용되는 고유 비용은, 도 6에 도시된 바와 같이, 장애물로부터 거리가 20cm까지는 100으로 설정하고, 20cm 이상의 거리에 대해서는 1차 함수로 감소하도록 설정한다.
그리고, 시뮬레이션을 위한 격자 지도의 사이즈는, 도 7에 도시된 바와 같이, 104cm × 150cm로 설정하고, 목표 위치를 (57,58)로 두어 시뮬레이션을 수행하였다. 도 7에서 실선으로 표시된 경로가 그라디언트 방법(Gradient method)을 통해 생성된 1차 경로(P1)를 나타낸 것이고, 파선으로 표시된 경로가 제1 경로 생성 방법에 따라 재생성된 경로를 나타내고 있다.
[표 1]은 도 6의 A 구간에서 1차 경로(P1)의 경로 비용과 각각의 중계점을 기준으로 하는 후보 경로의 중계점 경로 비용을 나타낸 것이다. [표 1]에 나타난 바와 같이, 중계점 4의 중계점 경로 비용이 최소로 나타나 중계점 4가 최소 비용 중계점으로 결정되며, 기존 비용보다 작으므로 중계점 4를 거치는 경로가 재생성된다.
[표 1]
한편, [표 2]는 도 6의 A 구간에서 1차 경로(P1)에 따른 이동 로봇의 헤드 방향에 대한 회전 각도의 변화와, 중계점 4를 통해 재생성된 경로에 따른 이동 로봇의 헤드 방향에 대한 회전 각도의 변화를 나타내고 있다. 1차 경로(P1), 즉 그라디언트 방법(Gradient method)을 통해 생성된 경로에서는 총 36회의 회전 횟수를 나타냈으며 이중 일부 만을 [표 1]에 기록한 것으로, 도 1에 도시된 바와 같이, 대부분 45°의 회전 각도를 나타내고 있음을 확인할 수 있다.
반면, 재생성된 경로에서는 대부분 45°보다 작은 다양한 회전 각도로 회전함을 확인할 수 있으며, 회전 횟수도 총 23회로 기존 경로보다 방향 전환 횟수 또한 감소되어 보다 최적화된 경로를 생성함을 확인할 수 있다.
[표 2]
전술한 실시예에서는 제1 경로 생성 방법으로 그라디언트 방법이 적용되는 것을 예로 하여 설명하였다. 이외에도, S. Koenig, M. Likhachev 및 D. Furcy의 논문 "Lifelong Planning A* (Artificial Intelligence Journal, 155, (1-2), 93-146, 2004.)"에 기재된 Lifelong Planning A* 방법이나, Stentz, Anthony의 논문 "The Focussed D* Algorithm for Real-Time Replanning(In Proceedings of the International Joint Conference on Artificial Intelligence: 1652-1659, http://citeseerx.ist.psu.edu/viewdoc/summary?doi=10.1.1.41.8257)에 기재된 Focussed D* 알고리즘도 제1 경로 생생 방법에 적용 가능하며, 이외에도 격자 지도에서 경로 비용에 기초하여 경로를 생성하는 다른 알고리즘도 본 발명의 기술 사상의 범위 내에서 제1 경로 생성 방법에 적용 가능함은 물론이다.
비록 본 발명의 몇몇 실시예들이 도시되고 설명되었지만, 본 발명이 속하는 기술분야의 통상의 지식을 가진 당업자라면 본 발명의 원칙이나 정신에서 벗어나지 않으면서 본 실시예를 변형할 수 있음을 알 수 있을 것이다. 발명의 범위는 첨부된 청구항과 그 균등물에 의해 정해질 것이다.
Claims (10)
- 이동 로봇의 최적 경로 생성 방법에 있어서,
격자 지도를 구성하는 각각의 격자점에 할당된 격자 비용에 기초한 제1 경로 생성 방법을 통해 출발 위치로부터 목표 위치까지의 1차 경로가 생성되는 단계와,
상기 1차 경로 상의 적어도 일부 경로가 상기 격자 비용에 기초한 제2 경로 생성 방법을 통해 재생성되어 최종 경로가 생성되는 단계를 포함하는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제1항에 있어서,
상기 제1 경로 생성 방법은 그라디언트 방법(Gradient method)이 적용되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제12항에 있어서,
상기 제2 경로 생성 방법은,
(a) 상기 목표 위치 방향으로 상기 제1 경로 상에 순차적으로 위치하는 제1 방향 전환 격자점, 제2 방향 전환 격자점, 제3 방향 전환 격자점을 검출하는 단계와;
(b) 상기 제2 방향 전환 격자점과 상기 제3 방향 전환 격자점 사이의 상기 제1 경로 상에서 적어도 하나의 중계점을 설정하는 단계와;
(c) 상기 제1 방향 전환 격자점, 상기 각 중계점 및 상기 제3 방향 전환 격자점을 연결하는 각각의 후보 경로에 대한 중계점 경로 비용을 상기 격자 비용에 기초하여 산출하는 단계와;
(d) 최소의 중계점 경로 비용을 발생하는 최소 비용 중계점을 추출하는 단계와;
(e) 상기 제1 방향 전환 격자점, 상기 최소 비용 중계점 및 상기 제3 방향 전환 격자점을 연결하는 후보 경로가 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경로를 대체하여 재생성되는 단계를 포함하는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제3항에 있어서,
상기 제2 경로 생성 방법은 상기 출발 위치를 첫 번째 상기 제1 방향 전환 격자점으로 하여 상기 1차 경로 상의 방향 전환 격자점들에 대해 상기 (a) 단계 내지 상기 (e) 단계를 수행하여 경로가 재생성되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제4항에 있어서,
상기 제2 경로 생성 방법은,
(f) 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경우의 경로 비용을 추출하는 단계와,
(g) 상기 (f) 단계에서 산출된 경로 비용과 상기 최소 중계점 경로 비용을 비교하는 단계를 더 포함하고;
상기 (e) 단계는 상기 최소 중계점 경로 비용이 상기 (f) 단계에서 산출된 경로 비용보다 작은 경우 수행되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제5항에 있어서,
상기 (b) 단계에서는 상기 제3 방향 전환 격자점이 상기 중계점의 하나로 설정되며;
상기 (c) 단계에서는 상기 제1 방향 전환 격자점과 상기 제3 방향 전환 격자점을 연결하는 후보 경로에 대한 중계점 경로 비용이 산출되며;
상기 (d) 단계에서 상기 최소 비용 중계점으로 상기 제3 방향 전환 격자점이 추출되는 경우, 상기 (e) 단계에서 상기 제1 방향 전환 격자점과 상기 제3 방향 전환 격자점을 연결하는 상기 후보 경로가 상기 제1 방향 전환 격자점, 상기 제2 방향 전환 격자점 및 상기 제3 방향 전환 격자점을 연결하는 경로를 대체하여 재생성되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제3항에 있어서,
상기 격자 비용은 그라디언트 방법 상의 고유 비용(Intrinsic cost)과 근접 비용(Adjacent cost)을 포함하며;
상기 (c) 단계에서 상기 중계점 경로 비용은 상기 후보 경로가 통과하는 격자 공간을 형성하는 격자점들의 상기 고유 비용에 기초하여 산출되는 공간 고유 비용과, 상기 제1 방향 전환 격자점과 상기 중계점 간의 상기 근접 비용의 합에 의해 산출되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제7항에 있어서,
상기 (c) 단계는,
(c1) 상기 격자 공간을 형성하며 한 방향으로 배열되는 변들과 상기 후보 경로가 교차하는 적어도 하나의 교차점을 추출하는 단계와;
(c2) 상기 변을 형성하는 한 쌍의 격자점에 할당된 상기 고유 비용과, 상기 한 쌍의 격자점 각각과 상기 교차점 간의 거리에 기초하여 상기 교차점에 대한 교차점 고유 비용을 산출하는 단계와;
(c3) 상기 교차점에 대해 산출된 상기 교차점 고유 비용을 합산하여 상기 공간 고유 비용을 산출하는 단계를 포함하는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제8항에 있어서,
상기 교차점 고유 비용은 수학식 ICcp = ICg1×L2 + ICg2×L1 (여기서, ICcp는 상기 교차점 고유 비용이고, ICg1과 ICg2는 상기 한 쌍의 격자점 각각의 상기 고유 비용이고, L1은 상기 고유 비용이 ICg1인 격자점과 상기 교차점 간의 거리이고, L2는 상기 고유 비용이 ICg2인 격자점과 상기 교차점 간의 거리이다)에 의해 산출되는 것을 특징으로 하는 이동 로봇의 최적 경로 생성 방법. - 제1항 내지 제9항 중 어느 한 항에 따른 최적 경로 생성 방법이 적용된 이동 로봇.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020100131295A KR101234371B1 (ko) | 2010-12-21 | 2010-12-21 | 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020100131295A KR101234371B1 (ko) | 2010-12-21 | 2010-12-21 | 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20120069949A true KR20120069949A (ko) | 2012-06-29 |
KR101234371B1 KR101234371B1 (ko) | 2013-02-18 |
Family
ID=46687917
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020100131295A KR101234371B1 (ko) | 2010-12-21 | 2010-12-21 | 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101234371B1 (ko) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015167220A1 (ko) * | 2014-05-02 | 2015-11-05 | 한화테크윈 주식회사 | 이동 로봇의 경로 계획 장치 및 이동 로봇의 경로 계획 방법 |
CN107478232A (zh) * | 2017-09-18 | 2017-12-15 | 珠海市微半导体有限公司 | 机器人导航路径的搜索方法及芯片 |
WO2022198992A1 (zh) * | 2021-03-22 | 2022-09-29 | 深圳市优必选科技股份有限公司 | 一种机械臂运动规划方法、装置、可读存储介质及机械臂 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104407613B (zh) * | 2014-10-20 | 2017-03-22 | 河南工业职业技术学院 | 一种避障路径平滑优化方法 |
KR101701241B1 (ko) | 2015-03-05 | 2017-02-01 | 국방과학연구소 | 히스토그램 유사도 기반 디지털지형정보의 도로정보 개선방법 및 개선장치 |
CN106142082B (zh) * | 2016-06-23 | 2018-07-10 | 苏州穿山甲机器人股份有限公司 | 机器人调整路径偏移的定位导航方法 |
KR20220138438A (ko) * | 2021-02-26 | 2022-10-13 | 현대자동차주식회사 | 이동 로봇의 다중 경로 생성 장치 및 방법 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5793934A (en) * | 1994-06-22 | 1998-08-11 | Siemens Aktiengesellschaft | Method for the orientation, route planning and control of an autonomous mobile unit |
KR100745975B1 (ko) * | 2004-12-30 | 2007-08-06 | 삼성전자주식회사 | 그리드 맵을 사용하여 최소 이동 경로로 이동하는 방법 및장치 |
JP4661838B2 (ja) | 2007-07-18 | 2011-03-30 | トヨタ自動車株式会社 | 経路計画装置及び方法、コスト評価装置、並びに移動体 |
KR20090126414A (ko) * | 2008-06-04 | 2009-12-09 | 삼성전자주식회사 | 로봇 및 그 경로생성방법 |
-
2010
- 2010-12-21 KR KR1020100131295A patent/KR101234371B1/ko not_active IP Right Cessation
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015167220A1 (ko) * | 2014-05-02 | 2015-11-05 | 한화테크윈 주식회사 | 이동 로봇의 경로 계획 장치 및 이동 로봇의 경로 계획 방법 |
US10369695B2 (en) | 2014-05-02 | 2019-08-06 | Hanwha Defense Co., Ltd. | Device for planning path of mobile robot and method for planning path of mobile robot |
CN107478232A (zh) * | 2017-09-18 | 2017-12-15 | 珠海市微半导体有限公司 | 机器人导航路径的搜索方法及芯片 |
CN107478232B (zh) * | 2017-09-18 | 2020-02-21 | 珠海市一微半导体有限公司 | 机器人导航路径的搜索方法 |
WO2022198992A1 (zh) * | 2021-03-22 | 2022-09-29 | 深圳市优必选科技股份有限公司 | 一种机械臂运动规划方法、装置、可读存储介质及机械臂 |
Also Published As
Publication number | Publication date |
---|---|
KR101234371B1 (ko) | 2013-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101234371B1 (ko) | 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 | |
Lakshmanan et al. | Complete coverage path planning using reinforcement learning for tetromino based cleaning and maintenance robot | |
Alonso-Mora et al. | Distributed multi-robot formation control among obstacles: A geometric and optimization approach with consensus | |
KR101732902B1 (ko) | 로봇의 경로 계획 장치 및 그 방법 | |
KR101798652B1 (ko) | 매니퓰레이터를 제어하기 위한 방법 및 장치 | |
CN103809463B (zh) | 用于机器人模拟器的示教点指令选择方法 | |
Kim et al. | Practical motion planning for car-parking control in narrow environment | |
CN104062902A (zh) | Delta机器人时间最优轨迹规划方法 | |
CN108983776A (zh) | 一种机器人控制方法及其装置、电子设备 | |
CN112229419B (zh) | 一种动态路径规划导航方法及*** | |
KR20090126414A (ko) | 로봇 및 그 경로생성방법 | |
CN107357295B (zh) | 一种基于栅格地图的路径搜索方法和芯片及机器人 | |
Paus et al. | A combined approach for robot placement and coverage path planning for mobile manipulation | |
Breitenmoser et al. | Distributed coverage control on surfaces in 3d space | |
Norouzi et al. | Planning high-visibility stable paths for reconfigurable robots on uneven terrain | |
Ordonez et al. | The virtual wall approach to limit cycle avoidance for unmanned ground vehicles | |
Pal et al. | A focused wave front algorithm for mobile robot path planning | |
Eren et al. | Implementation of the spline method for mobile robot path control | |
Firoozi et al. | Occlusion-aware MPC for guaranteed safe robot navigation with unseen dynamic obstacles | |
Manns et al. | Improving A* walk trajectories with B-splines and motion capture for manual assembly verification | |
Yoon et al. | Path planning for unmanned ground vehicle in urban parking area | |
Cherubini et al. | Comparing appearance-based controllers for nonholonomic navigation from a visual memory | |
Pimenta et al. | Fully continuous vector fields for mobile robot navigation on sequences of discrete triangular regions | |
Jasna et al. | Remodeled A* algorithm for mobile robot agents with obstacle positioning | |
Ziaei et al. | Vision-based path coordination for multiple mobile robots with four steering wheels using an overhead camera |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant | ||
FPAY | Annual fee payment |
Payment date: 20160112 Year of fee payment: 4 |
|
LAPS | Lapse due to unpaid annual fee |