KR101494224B1 - 자율 이동체 - Google Patents
자율 이동체 Download PDFInfo
- Publication number
- KR101494224B1 KR101494224B1 KR1020127032283A KR20127032283A KR101494224B1 KR 101494224 B1 KR101494224 B1 KR 101494224B1 KR 1020127032283 A KR1020127032283 A KR 1020127032283A KR 20127032283 A KR20127032283 A KR 20127032283A KR 101494224 B1 KR101494224 B1 KR 101494224B1
- Authority
- KR
- South Korea
- Prior art keywords
- distance
- obstacle
- interference
- action
- path
- Prior art date
Links
- 230000033001 locomotion Effects 0.000 claims abstract description 126
- 230000009471 action Effects 0.000 claims description 182
- 238000000034 method Methods 0.000 claims description 86
- 238000004364 calculation method Methods 0.000 claims description 23
- 230000037361 pathway Effects 0.000 claims description 5
- 230000006399 behavior Effects 0.000 description 121
- 239000013598 vector Substances 0.000 description 33
- 238000010586 diagram Methods 0.000 description 29
- 238000012545 processing Methods 0.000 description 23
- 238000003708 edge detection Methods 0.000 description 17
- 230000008569 process Effects 0.000 description 16
- 230000002452 interceptive effect Effects 0.000 description 9
- 239000002131 composite material Substances 0.000 description 6
- 238000013459 approach Methods 0.000 description 5
- 238000001514 detection method Methods 0.000 description 5
- 238000010187 selection method Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 238000000605 extraction Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 239000000470 constituent Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000012447 hatching Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000013450 outlier detection Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
이동 가능한 장해물이 안전하게 통과할 수 있도록 정류 영역을 미리 정하지 않고, 스스로 설정한 대피 방향으로 이동하는 것이 가능한 자율 이동체를 제공한다.
자율 이동체(1)는 기기 자체의 크기(D2)를 기억하는 기억부(22)와, 장해물 정보를 취득하는 레이저 레인지 파인더(12)와, 취득된 장해물 정보에 의거하여 간섭 장해물(66)이 존재하는 영역의 양 단부의 위치로서 통로면과 평행한 면에 있어서 기기 자체의 이동 목표 방향(72)과 대략 직교하는 방향의 양 단부의 위치를 나타내는 에지점(86)을 특정하는 장해물 특정부(233)와, 기기 자체의 크기(D2) 및 에지점(86)에 의거하여 대피 방향을 설정하는 방향 설정부(237)와, 대피 방향으로 기기 자체가 향하도록 제어하는 이동 제어부(25)를 구비한다.
자율 이동체(1)는 기기 자체의 크기(D2)를 기억하는 기억부(22)와, 장해물 정보를 취득하는 레이저 레인지 파인더(12)와, 취득된 장해물 정보에 의거하여 간섭 장해물(66)이 존재하는 영역의 양 단부의 위치로서 통로면과 평행한 면에 있어서 기기 자체의 이동 목표 방향(72)과 대략 직교하는 방향의 양 단부의 위치를 나타내는 에지점(86)을 특정하는 장해물 특정부(233)와, 기기 자체의 크기(D2) 및 에지점(86)에 의거하여 대피 방향을 설정하는 방향 설정부(237)와, 대피 방향으로 기기 자체가 향하도록 제어하는 이동 제어부(25)를 구비한다.
Description
본 발명은 자율적으로 이동하는 자율 이동체에 관한 것이다.
종래부터, 레이저 레인지 파인더에 의해 장해물을 검출하고, 검출한 장해물과의 간섭을 피해서 자율적으로 이동하는 자율 이동체가 알려져 있다(하기 특허문헌 1). 이러한 종류의 자율 이동체로서 좁은 통로에서 사람이 통과할 수 있도록 길을 양보하는 자율 이동체가 하기 특허문헌 2에 기재되어 있다. 이 자율 이동체는 탑재한 센서에 사람이 접촉하면 정류 신호를 검출하고, 미리 통로의 끝에 설정된 정류 영역으로 이동하고, 정지한다.
상기 특허문헌 2에 기재된 자율 이동체가 정지하는 정류 영역은 미리 통로 상에 설정되어 있다. 그러나, 예를 들면 병원, 공항의 로비 등에서는 통로 상을 빈번히 사람이 지나가므로 정류 영역을 미리 확보하는 것은 곤란하다. 또한, 예를 들면 공장 또는 창고 등에서는 사람의 왕래가 적은 경우가 많지만 제품이나 보관물에 따라 배치를 변경하는 경우가 있으므로 배치를 변경할 때마다 정류 영역을 다시 설정하는 것은 노동력을 요한다.
본 발명은 상기 문제점을 해소하기 위해서 이루어진 것으로서, 정류 영역을 미리 정하지 않고, 이동 가능한 장해물이 안전하게 통과할 수 있도록 스스로 대피 방향을 설정해서 이동하는 것이 가능한 자율 이동체를 제공하는 것을 목적으로 한다.
본 발명에 의한 자율 이동체는 계획된 경로에 따라서 자율적으로 이동하는 자율 이동체로서, 기기 자체의 크기를 기억하는 기억 수단과, 기기 자체 주위의 장해물 정보를 취득하는 장해물 정보 취득 수단과, 장해물 정보 취득 수단에 의해 취득된 장해물 정보에 의거하여 이동 목표 방향에 위치하는 장해물이 존재하는 영역의 양 단부이고, 통로면과 평행한 면에 있어서 이동 목표 방향과 대략 직교하는 방향의 양 단부의 위치를 특정하는 장해물 특정 수단과, 기억 수단에 의해 기억된 기기 자체의 크기, 및 장해물 특정 수단에 의해 특정된 양 단부의 위치에 의거하여 대피 방향을 설정하는 방향 설정 수단과, 방향 설정 수단에 의해 설정된 대피 방향으로 이동하도록 제어하는 이동 제어 수단을 구비하는 것을 특징으로 한다.
본 발명에 의한 자율 이동체에 의하면, 기기 자체 주위의 장해물 정보가 취득되고, 이 장해물 정보에 의거하여 이동 목표 방향에 위치하는 장해물이 존재하는 영역의 양 단부이고, 통로면과 평행한 면에 있어서 이동 목표 방향과 대략 직교하는 방향의 양 단부의 위치가 특정된다. 이것에 의해, 자율 이동체가 그대로 전진했을 경우에 간섭할 가능성이 있는 장해물이 존재하는 영역의 양 단부의 위치가 특정된다. 그리고, 자율 이동체는 상기 장해물의 양 단부의 위치와 기기 자체의 크기에 의거하여 대피 방향을 설정해서 이동한다. 이것에 의해, 자율 이동체는 장해물과 간섭하지 않고 대피할 수 있는 방향을 스스로 설정하고, 설정한 방향으로 이동할 수 있다. 자율 이동체가 이 대피 방향으로 이동하면 장해물에게 길을 양보하게 되고, 장해물은 안전하게 전진할 수 있다. 즉, 정류 영역을 미리 정하지 않고, 이동 가능한 장해물이 안전하게 통과할 수 있도록 스스로 대피 방향을 설정해서 이동할 수 있게 된다.
본 발명에 의한 자율 이동체에서는 방향 설정 수단에 의해 설정된 대피 방향, 및 환경 지도에 의거하여 대피 방향 상에 정지 위치를 설정하는 정지 위치 설정 수단을 구비하고, 이동 제어 수단이 정지 위치 설정 수단에 의해 설정된 정지 위치로 이동하여 정지하도록 제어하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체는 대피 방향과 환경 지도에 의거하여 대피 방향 상에 정지 위치를 설정하고, 정지 위치까지 이동하고 정지한다. 이것에 의해, 자율 이동체는 환경에 적합한 위치, 즉 주위의 장해물과 간섭하지 않는 위치에 정지 위치를 스스로 설정할 수 있다. 따라서, 자율 이동체는 이동 목표 방향의 장해물에게 길을 양보하고, 이 장해물이 지나가는 것을 상황에 따른 위치에서 기다릴 수 있게 된다.
본 발명에 의한 자율 이동체에서는 이동 제어 수단이 기기 자체와 정지 위치 사이의 거리가 짧아질수록 이동 속도가 느려지도록 제어하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체는 정지 위치에 근접함에 따라서 이동 속도가 느려지므로 안전하게 정지할 수 있다. 또한, 주위로부터 볼 때 자율 이동체가 정지하는 것을 알기 쉬우므로 사람 등의 장해물이 안심하고 자율 이동체의 옆을 통과할 수 있다.
본 발명에 의한 자율 이동체에서는 대피 방향으로의 이동 중에 장해물 정보에 의거하여 대피 방향에 위치하는 장해물과 기기 자체 사이의 간섭 거리를 산출하는 간섭 거리 산출 수단과, 기기 자체가 정지에 필요로 하는 정지 거리를 추정하는 추정 수단과, 산출 수단에 의해 산출된 간섭 거리, 및 추정 수단에 의해 추정된 정지 거리에 의거하여 정지할지의 여부를 판정하는 판정 수단을 구비하고, 이동 제어 수단은 판정 수단에 의해 정지한다고 판정되었을 경우에 기기 자체를 정지시키고, 판정 수단에 의해 정지하지 않는다고 판정되었을 경우에 대피 방향으로 이동하는 제어를 속행하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체가 대피 방향으로 이동 중에 대피 방향에 위치하는 장해물과 기기 자체 사이의 간섭 거리가 산출된다. 이것에 의해, 자율 이동체가 대피 방향으로 이동하고 있을 때에 대피 방향에 장해물이 출현했을 경우 그 장해물과 기기 자체 사이의 간섭 거리가 산출된다. 또한, 기기 자체가 정지에 필요로 하는 정지 거리가 추정된다. 그리고, 자율 이동체는 간섭 거리와 정지 거리에 의거하여 정지할지의 여부를 판정하고, 정지한다고 판정한 경우에는 정지하고, 정지하지 않는다고 판정한 경우에는 대피 방향으로의 이동을 속행한다. 이것에 의해, 대피 방향으로의 이동 중에 있어서 대피 방향에 장해물이 출현한 경우에는 정지하므로 장해물과의 간섭을 방지할 수 있다.
본 발명에 의한 자율 이동체에서는, 판정 수단은 간섭 거리가 정지 거리에 여유값을 가산한 거리보다 짧을 경우에 정지한다고 판정하고, 간섭 거리가 정지 거리에 여유값을 가산한 거리 이상일 경우에 정지하지 않는다고 판정하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체는 간섭 거리가 정지 거리에 여유값을 가산한 거리보다 짧을 경우에 정지하고, 간섭 거리가 정지 거리에 여유값을 가산한 거리 이상인 경우에 대피 방향으로의 이동을 속행한다. 이것에 의해, 정지하지 않는다면 장해물과 간섭할 가능성이 있는 경우에 정지할 수 있다.
본 발명에 의한 자율 이동체에서는 계획된 경로가 설정되고, 기기 자체가 이동 가능한 영역인 통로 상에 있어서 이동 목표 방향에 위치하는 장해물을 장해물 정보에 의거하여 회피하면서 전진하는 회피 행동이 가능한지의 여부를 판정하는 회피 판정 수단을 구비하고, 이동 제어 수단은 회피 판정 수단에 의해 회피 행동이 가능이라고 판정되었을 경우에 회피 행동을 행하도록 제어하고, 회피 판정 수단에 의해 회피 행동이 불가능이라고 판정되었을 경우에 대피 방향으로 이동하도록 제어하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체는 통로 상에 있어서의 회피 행동이 가능한지의 여부를 판정하고, 회피 행동이 가능한 경우에 회피 행동을 행하고, 회피 행동이 불가능한 경우에 대피 방향을 향해서 이동한다. 따라서, 간섭할 가능성이 있는 장해물이 존재할 경우에 회피 행동이 가능하다면 회피 행동을 행하므로 효율적으로 목적지를 향할 수 있다.
본 발명에 의한 자율 이동체에서는, 이동 목표 방향에 존재하는 장해물과의 간섭을 회피하기 위해서 설정된 통로 상의 통과점과 계획된 경로 사이의 거리를 산출하는 통과점 거리 산출 수단과, 통로에 있어서 계획된 경로로부터 통과점측의 방향 및 경로 방향과 대략 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타내는 경로 여유를 특정하는 여유 특정 수단을 구비하고, 회피 판정 수단이 통과점 거리 산출 수단에 의해 산출된 거리가 여유 특정 수단으로 특정된 경로 여유보다 클 경우에 회피 행동이 가능이라고 판정하고, 통과점 거리 산출 수단에 의해 산출된 거리가 여유 특정 수단으로 특정된 경로 여유 이하인 경우에 회피 행동이 불가능이라고 판정하는 것이 바람직하다.
이 바람직한 구성에 의하면, 이동 목표 방향에 존재하는 장해물과의 간섭을 회피하기 위해서 설정된 통로 상의 통과점과 계획된 경로 사이의 거리가 산출된다. 또한, 계획된 경로로부터 통과점측의 방향 및 경로 방향과 대략 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타내는 경로 여유가 특정된다. 그리고, 자율 이동체는 통과점과 경로 사이의 거리가 경로 여유보다 클 경우에 회피 행동이 가능이라고 판정하고, 상기 거리가 경로 여유 이하일 경우에 회피 행동이 불가능이라고 판정한다. 이것에 의해, 자율 이동체는 장해물을 회피하기 위해서 통과점까지 이동할 여유가 통로 상에 있을 경우에 회피 행동이 가능이라고 판정하고, 그 여유가 통로에 없는 경우에는 회피 행동이 불가능이라고 판정한다. 따라서, 자율 이동체는 회피 행동과 대피해서 길을 양보하는 행동을 상황에 따라서 적절하게 분별하여 사용할 수 있다.
본 발명에 의한 자율 이동체에서는, 이동 제어 수단은 대피 방향으로의 이동 중에 회피 판정 수단에 의해 회피 행동이 가능이라고 판정되었을 경우 대피 방향으로의 이동을 중지하고, 회피 행동을 행하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체는 대피 방향으로의 이동 중에 회피 행동이 가능한 상황이 되었을 경우에는 대피 방향으로의 이동을 중지하고, 회피 행동을 개시한다. 따라서, 대피 방향으로의 이동 중이어도 상황이 회피 행동이 가능한 상황으로 변화한 경우에는 이 상황의 변화에 대응하여 회피 행동을 개시할 수 있다.
본 발명에 의한 자율 이동체에서는 이동 제어 수단은 정지 위치에 도달하고나서 소정 시간 대기한 후 다시 계획된 경로에 따라서 이동하도록 제어하는 것이 바람직하다.
이 바람직한 구성에 의하면, 자율 이동체가 정지 위치에 도달하고나서 소정 시간 대기하므로 장해물이 통로 상을 통과 가능한 상황을 만들어 내고, 통과하는 것을 기다릴 수 있다. 그리고, 자율 이동체는 소정 시간 대기한 후 원래의 계획된 경로에 따른 이동을 재개하므로 효율적으로 목적지에 도달할 수 있다.
(발명의 효과)
본 발명에 의하면, 정류 영역을 미리 정하지 않고, 이동 가능한 장해물이 안전하게 통과할 수 있도록 스스로 대피 방향을 설정해서 이동할 수 있게 된다.
도 1은 실시형태에 의한 자율 이동체의 개략 구성을 나타내는 도면이다.
도 2는 자율 이동체가 구비하는 전자 제어 장치의 구성을 나타내는 블럭도이다.
도 3a는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 3b는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 3c는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 4는 자율 이동체가 행하는 행동의 종류를 설명하기 위한 도면이다.
도 5a는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 5b는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 5c는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 6a는 에지 위치의 특정 방법을 설명하기 위한 도면이다.
도 6b는 에지 위치의 특정 방법을 설명하기 위한 도면이다.
도 7a는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 7b는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 7c는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 8a는 회피 행동이 가능한지의 여부를 판정하는 방법을 설명하기 위한 도면이다.
도 8b는 회피 행동이 가능한지의 여부를 판정하는 방법을 설명하기 위한 도면이다.
도 9a는 정지 행동과 퇴피 행동의 선택 방법을 설명하기 위한 도면이다.
도 9b는 정지 행동과 퇴피 행동의 선택 방법을 설명하기 위한 도면이다.
도 10은 정지 위치의 설정 방법을 설명하기 위한 도면이다.
도 11은 대기 위치의 설정 방법을 설명하기 위한 도면이다.
도 12는 정지 위치까지의 거리와 속도의 관계를 나타내는 그래프이다.
도 13은 간섭 판정의 방법을 설명하기 위한 도면이다.
도 14는 행동 선택 처리의 처리 순서를 나타내는 흐름도이다.
도 15는 에지점의 특정 처리의 처리 순서를 나타내는 흐름도이다.
도 16은 정지 행동(대피 방향으로의 이동)시의 이동 제어 처리의 처리 순서를 나타내는 흐름도이다.
도 17은 대기 행동과 우회 행동의 선택 처리의 처리 순서를 나타내는 흐름도이다.
도 18은 퇴피 행동이 선택되었을 경우의 동작을 나타내는 타이밍 차트이다.
도 2는 자율 이동체가 구비하는 전자 제어 장치의 구성을 나타내는 블럭도이다.
도 3a는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 3b는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 3c는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이다.
도 4는 자율 이동체가 행하는 행동의 종류를 설명하기 위한 도면이다.
도 5a는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 5b는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 5c는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
도 6a는 에지 위치의 특정 방법을 설명하기 위한 도면이다.
도 6b는 에지 위치의 특정 방법을 설명하기 위한 도면이다.
도 7a는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 7b는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 7c는 회피 통과점과 경로의 거리를 산출하는 방법을 설명하기 위한 도면이다.
도 8a는 회피 행동이 가능한지의 여부를 판정하는 방법을 설명하기 위한 도면이다.
도 8b는 회피 행동이 가능한지의 여부를 판정하는 방법을 설명하기 위한 도면이다.
도 9a는 정지 행동과 퇴피 행동의 선택 방법을 설명하기 위한 도면이다.
도 9b는 정지 행동과 퇴피 행동의 선택 방법을 설명하기 위한 도면이다.
도 10은 정지 위치의 설정 방법을 설명하기 위한 도면이다.
도 11은 대기 위치의 설정 방법을 설명하기 위한 도면이다.
도 12는 정지 위치까지의 거리와 속도의 관계를 나타내는 그래프이다.
도 13은 간섭 판정의 방법을 설명하기 위한 도면이다.
도 14는 행동 선택 처리의 처리 순서를 나타내는 흐름도이다.
도 15는 에지점의 특정 처리의 처리 순서를 나타내는 흐름도이다.
도 16은 정지 행동(대피 방향으로의 이동)시의 이동 제어 처리의 처리 순서를 나타내는 흐름도이다.
도 17은 대기 행동과 우회 행동의 선택 처리의 처리 순서를 나타내는 흐름도이다.
도 18은 퇴피 행동이 선택되었을 경우의 동작을 나타내는 타이밍 차트이다.
이하, 도면을 참조해서 본 발명의 적합한 실시형태에 대해서 상세하게 설명한다. 우선, 도 1을 참조하여 실시형태에 의한 자율 이동체(1)의 개략에 대하여 설명한다. 도 1은 자율 이동체(1)의 개략 구성을 나타내는 도면이다.
본 실시형태에 의한 자율 이동체(1)는, 예를 들면 병원 또는 공장 등의 시설 내에 배치되어 목적지까지의 경로를 스스로 계획하고, 계획한 경로에 따라서 벽이나 기둥 등의 장해물을 회피하면서 자율적으로 이동하는 로봇이다. 또한, 본 발명에 의한 자율 이동체는 무인 반송 대차(AGV : Automated Guided Vehicle) 등에도 적용할 수 있다. 자율 이동체(1)는 환경 지도에 미리 기억된 기지의 장해물을 회피하도록 경로를 계획하고, 계획된 경로에 따라서 이동할 때에 조우하는 미지의 장해물을 각종 장해물 센서에 의해 검출한다. 자율 이동체(1)는 장해물 센서를 이용하여 이동 목표 방향의 장해물을 검출한 경우 그 상황에 따라 회피 행동, 정지 행동, 또는 퇴피 행동 중 어느 하나를 스스로 선택해서 기기 자체의 이동을 제어한다.
또한, 회피 행동은 경로가 설정된 통로 상에서 장해물을 회피하는 행동이다. 정지 행동은 경로가 설정된 통로 상에서 대피 방향으로 이동하여 정지함으로써 길을 장해물에게 양보하는 행동이다. 퇴피 행동은 경로가 설정된 통로로부터 퇴피하는 행동이다. 또한, 본 명세서에서는 통로의 옆으로 비켜서 장해물이 통과하는 것을 기다린다는 의미에서 「대피」라는 단어를 사용하고, 이에 대하여 「퇴피」라는 단어는 통로로부터 비킨다는 의미로 사용한다.
본 실시형태의 자율 이동체(1)는 중공 원기둥 형상의 본체(11)를 갖고, 본체(11) 내에 전자 제어 장치(20)가 탑재되고, 본체(11) 측면에 주위의 장해물을 검출하기 위한 장해물 센서가 배치되어 있다. 자율 이동체(1)는 본 실시형태에서는 장해물 센서로서 레이저 레인지 파인더(12), 초음파 센서(13), 및 스테레오 카메라(14)를 구비하고 있다. 레이저 레인지 파인더(12), 초음파 센서(13), 및 스테레오 카메라(14)는 특허청구범위에 기재된 장해물 정보 취득 수단으로서 기능한다.
레이저 레인지 파인더(12)는 정면에 장착되고, 기기 자체의 주위를 수평 방향으로 중심각 240° 정도의 부채 형상으로 주사한다. 즉, 레이저 레인지 파인더(12)는 레이저를 사출하여 기기 자체 주위의 장해물에 반사되어 돌아온 레이저의 검출 각도, 및 레이저의 전파 시간을 계측한다. 그리고, 레이저 레인지 파인더(12)는 계측한 전파 시간을 이용하여 기기 자체와 장해물 사이의 거리를 산출하고, 산출한 거리 및 그 각도를 장해물 정보로서 전자 제어 장치(20)에 출력한다.
초음파 센서(13)는 1쌍의 발신기 및 수신기를 이용하여 구성되고, 본 실시형태에서는 16개의 초음파 센서(13)가 탑재되어 있다. 이 16개의 초음파 센서(13)는 본체(11)의 둘레 방향을 따라 동일한 간격으로 본체(11)에 장착되어 있다. 또한, 도 1에 있어서는 정면과 배면에 장착된 2개의 초음파 센서(13)를 나타내고, 그 이외의 초음파 센서(13)를 생략하고 있다. 16개의 초음파 센서(13)는 기기 자체를 중심으로 해서 기기 자체의 전체 주위 360°를 커버하도록 초음파를 발신한다.
각 초음파 센서(13)는 초음파를 발신한 후 기기 자체 주위의 장해물에 반사되어 돌아온 초음파를 검출하여 초음파의 전파 시간을 계측한다. 이것에 의해, 기기 자체의 주위 360°의 장해물을 검출할 수 있다. 각 초음파 센서(13)는 계측한 전파 시간을 이용하여 기기 자체와 장해물 사이의 거리를 산출하고, 산출한 거리를 장해물 정보로서 전자 제어 장치(20)에 출력한다.
스테레오 카메라(14)는 본체(11)의 상부 정면에 배치되고, 스테레오 화상을 사용한 삼각측량의 원리에 의거하여 기기 자체로부터 장해물까지의 거리 및 각도를 산출한다. 스테레오 카메라(14)는 산출한 거리 및 그 각도를 장해물 정보로서 전자 제어 장치(20)에 출력한다.
자율 이동체(1)는 이동 수단으로서 본체(11)의 하측에 설치된 4개의 전동 모터(15)와, 4개의 전동 모터(15)의 구동축 각각에 장착된 옴니휠(16)을 구비하고 있다. 4개의 옴니휠(16)은 동일 원주 상에 90°씩 각도를 어긋나게 해서 동일한 간격으로 배치되어 있다. 자율 이동체(1)는 4개의 전동 모터(15)를 독립적으로 제어함으로써 4개의 옴니휠(16) 각각의 회전 방향 및 회전 속도를 개별적으로 조절하여 360°의 임의의 방향으로 이동할 수 있다. 즉, 자율 이동체(1)는 장해물을 회피하기 위해서 본체(11)의 방향을 변경하지 않고, 좌우, 후방, 비스듬한 방향 등 임의의 방향으로 이동할 수 있다.
자율 이동체(1)가 구비하는 전자 제어 장치(20)는 자율 이동체(1)의 제어를 종합적으로 담당하는 것이다. 전자 제어 장치(20)는 연산을 행하는 마이크로 프로세서, 마이크로 프로세서에 후술하는 각 처리를 실행시키기 위한 프로그램 등을 기억하는 ROM, 연산 결과 등의 각종 데이터를 일시적으로 기억하는 RAM, 및 백업 RAM 등으로 구성되어 있다. 또한, 전자 제어 장치(20)는 레이저 레인지 파인더(12), 초음파 센서(13), 및 스테레오 카메라(14)와 마이크로 프로세서를 전기적으로 접속시키는 인터페이스 회로, 및 전동 모터(15)를 구동시키는 드라이버 회로 등도 구비하고 있다.
전자 제어 장치(20)는 이동을 제어하기 위해서 주요한 구성 요소로서 장해물 정보 통합부(21), 기억부(22), 산출부(23), 행동 선택부(24), 및 이동 제어부(25)를 구비하고 있다. 장해물 정보 통합부(21)는 레이저 레인지 파인더(12), 초음파 센서(13), 및 스테레오 카메라(14)로부터 출력된 장해물 정보를 입력하고, 입력된 장해물 정보를 통합한다. 산출부(23)는 장해물 정보 및 기억부(22)에 기억된 각종 정보 등을 이용하여 상황을 해석한다.
행동 선택부(24)는 해석된 상황에 의거하여 통상 행동, 회피 행동, 정지 행동, 또는 퇴피 행동 중 어느 하나의 행동을 선택한다. 그리고, 이동 제어부(25)가 선택된 행동에 의거하여 전동 모터(15)를 제어함으로써 자율 이동체(1)는 상황에 따른 이동을 행한다. 또한, 행동 선택부(24)는 특허청구범위에 기재된 선택 수단으로서 기능하고, 이동 제어부(25)는 제어 수단으로서 기능한다.
계속해서, 도 2를 참조하여 전자 제어 장치(20)의 구성 요소에 대해서 보다 상세하게 설명한다. 도 2는 전자 제어 장치(20)의 구성을 나타내는 블럭도이다. 전자 제어 장치(20)는 산출부(23)에 각종 정보를 제공하기 위한 구성 요소로서 상술한 장해물 정보 통합부(21) 및 기억부(22) 이외에 경로 계획부(26)와, 폭 특정부(27)와, 자기 위치 추정부(28)를 구비한다.
기억부(22)는 특허청구범위에 기재된 기억 수단으로서 기능하고, 수평 방향의 기기 자체의 크기를 미리 기억하고 있다. 이 기기 자체의 크기는 수평인 평면에 있어서 기기 자체가 내포되는 원의 직경을 이용하여 나타내어진다. 본 실시형태에서는 기기 자체의 크기가 수평인 평면에 있어서 기기 자체가 내접하는 원의 직경을 이용하여 나타내어지고, 이 경우 수평인 평면으로서는 원의 직경이 최대가 되는 면이 선택된다. 즉, 본 실시형태에서는 기기 자체의 크기가 자율 이동체(1)에 대해서 수평 방향의 최대 치수를 나타내고 있다.
또한, 기억부(22)는 환경 지도를 미리 기억하고 있다. 환경 지도는 자율 이동체(1)가 이동하는 환경의 지도 정보이고, 기지의 장해물이 존재하는 영역을 나타내는 정보이다. 기지의 장해물은 벽, 가구, 장착된 비품 등의 정지된 장해물 등이다. 이들 기지의 장해물이 존재하는 영역은 기지의 장해물 영역으로서 환경 지도에 미리 등록되어 있다. 또한, 기지의 장해물 영역은 통로면에 놓인 장해물뿐만 아니라 벽면에 장착된 장해물 또는 천장에서부터 매달린 장해물 중 자율 이동체(1)와 간섭할 가능성이 있는 높이에 위치하는 장해물을 노면 상에 투영한 영역을 포함해도 된다.
경로 계획부(26)는 자율 이동체(1)의 현재지를 출발지로 해서 목적지까지의 경로를 계획한다. 출발지는 후술하는 자기 위치 추정 처리에 의해 추정해도 되고, 사용자가 입력해도 된다. 목적지는 사용자가 설정해도 되고, 자율 이동체(1)가 스스로 설정해도 된다. 예를 들면, 자율 이동체(1) 스스로 기기 자체의 충전이 필요한 것을 검지하고, 충전기가 있는 충전 스테이션까지 이동할 경우에는 환경 지도 상에 있어서 미리 기억된 충전기의 위치를 목적지로 스스로 설정한다.
경로 계획부(26)는 기기 자체의 크기와 환경 지도를 이용하여 환경 지도 상의 기지의 장해물과 간섭하는 일없이 이동할 수 있는 경로를 추출한다. 그리고, 경로 계획부(26)는 추출한 복수의 경로 중에서 출발지와 목적지 사이를 연결하는 최단 경로를 탐색함으로써 경로를 계획한다. 경로는 사람이나 다른 자율 이동체가 이동하는 영역에도 설정된다. 예를 들면, 자율 이동체(1)가 병원 내를 이동할 경우 병원 내의 복도 등으로 경로가 설정된다.
경로 계획부(26)는 계획한 경로 상에 복수의 서브골을 설정한다. 서브골은 가상 포텐셜법을 이용하여 이동 제어를 행할 때에 이동 목표 방향으로의 인력(引力)을 설정하기 위해서 사용되는 점이다. 도 3a를 참조하여 서브골(63)에 대하여 설명한다. 도 3a~도 3c는 이동 제어에 사용하는 각종 정보를 설명하기 위한 도면이고, 도 3a는 서브골(63)을 설명하기 위한 도면이다.
도 3a~도 3c에 있어서, 해칭으로 나타내는 영역이 기지의 장해물 영역(61)을 나타내고 있다. 기지의 장해물 영역(61)에 끼여있는 영역이 자율 이동체(1)의 통로(95)이다. 즉, 이 통로(95)는 자율 이동체(1)가 이동 가능한 영역이다. 통로(95) 상에는 라인 형상의 경로(68)가 계획되어 있다. 도 3a~도 3c에서는 흑색의 사각형에 의해 3개의 서브골(63)이 나타내어져 있다. 또한, 서브골(63)에 대해서 개개의 서브골을 구별할 때에는 서브골(631), 서브골(632), 서브골(633)이라고 표기한다.
도 3a는 목적지를 향하는 경로 방향이 지면을 향해서 좌측 하방으로부터 우측 상방의 방향인 경우를 나타낸다. 경로(68)는 임의의 경로 계획 방법에 의해 주로 통로(95)의 폭 방향 중앙을 따라 설정된다. 따라서, 서브골(63)은 주로 서브골(631) 및 서브골(632)과 같이 통로(95)의 폭 방향 중앙에 설정된다. 단, 통로(95)의 안쪽에 기지의 장해물이 존재할 경우 우회전 또는 좌회전 등을 할 경우에는 통로(95)의 중앙으로부터 벗어난 위치로 경로(68)가 계획된다. 이 경우, 서브골(633)과 같이 통로(95)의 중앙으로부터 벗어난 위치에 서브골(63)이 설정된다.
경로 계획부(26)는 서브골(631~633)의 환경 지도 상에 있어서의 각 위치와, 각 서브골(631~633)의 순서를 특정한다. 각 서브골(631~633)의 순서는 목적지를 향하는 순서로 설정된다. 특정된 서브골(631~633)의 각 위치 및 순서는 경로 계획부(26)에 의해 기억부(22)로 출력되고, 기억부(22)에서 기억된다.
폭 특정부(27)는 각 서브골(63)에 대해서 공간 사이즈(D1)를 특정한다. 공간 사이즈(D1)는 통로(95)의 폭 방향의 크기를 나타낸다. 폭 방향은 통로(95) 상에 있어서 통로면과 평행인 면에 있어서 경로 방향과 대략 직교하는 방향이다. 도 3b에 나타내는 바와 같이, 본 실시형태에서는 공간 사이즈(D1)는 기기 자체의 크기(D2)와 경로 여유(D3)에 의해 나타내어진다. 기기 자체의 크기(D2)는 상술한 바와 같이 수평인 평면에 있어서 기기 자체가 내접하는 원의 직경이다.
경로 여유(D3)는 기기 자체의 크기(D2)의 원에 의해 근사되는 기기 자체가 서브골(63)에 위치할 경우에 기기 자체와 벽 등의 기지의 장해물 영역(61) 사이의 여유를 나타낸다. 즉, 이 경로 여유(D3)는 기기 자체의 크기(D2)의 원에 의해 근사되는 기기 자체가 서브골(63)에 위치할 경우에 폭 방향의 한쪽으로 이동 가능한 거리를 나타낸다. 따라서, 공간 사이즈(D1)는 D2+(D3×2)에 의해 나타내어진다.
경로 여유(D3)는 피치 폭(D4)을 사용해서 나타내어진다. 서브골(63)을 중심으로 하는 기기 자체의 크기(D2)의 원과, 폭 방향의 한쪽에 위치하는 벽 등의 기지의 장해물 영역(61)의 거리(D5)가 피치 폭(D4)의 X배보다 크고, 피치 폭(D4)의 (X+1)배보다 작을 경우 경로 여유(D3)는 피치 폭(D4)×X에 의해 나타내어진다. 도 3b에 나타내어지는 예에서는 서브골(63)을 중심으로 하는 기기 자체의 크기(D2)의 원과 기지의 장해물 영역(61)의 거리(D5)가 피치 폭(D4)의 2배보다 크고, 피치 폭(D4)의 3배보다 작으므로 경로 여유(D3)는 피치 폭(D4)×2에 의해 나타내어진다. 이러한 경로 여유(D3)를 사용해서 공간 사이즈(D1)를 나타냄으로써 이동 제어 상에 있어서 자율 이동체(1)가 이동 가능한 공간의 폭 방향의 크기를 공간 사이즈(D1)에 의해 정의할 수 있다.
피치 폭(D4)은, 예를 들면 10㎝ 정도로 설정된다. 이 피치 폭(D4)은 환경에 따라 값을 변경 가능한 파라미터이다. 예를 들면, 병원 내 등 불특정한 사람의 통행이 비교적 많은 환경에서는 피치 폭(D4)을 비교적 큰 값으로 하여 사람에 대한 안전성을 우선해도 좋다. 한편, 창고 내 등 관계자 이외의 사람의 통행이 비교적 적은 환경에서는 피치 폭(D4)을 비교적 작게 설정하여 자율 이동체(1)의 주행 효율을 우선해도 좋다.
폭 특정부(27)는 환경 지도에 의거하여 각 서브골(63)의 경로 여유(D3)를 특정하고, 경로 여유(D3)와 기기 자체의 크기(D2)에 의해 나타내어지는 공간 사이즈(D1)를 취득한다. 그리고, 생성된 각 서브골(63)의 공간 사이즈(D1)는 기억부(22)에 기억된다.
자기 위치 추정부(28)는 데드 레코닝(Dead-reckoning) 기술 및 SLAM(Simultaneous Localization And Mapping) 기술을 이용하여 환경 지도 상에 있어서의 자율 이동체(1)의 위치를 추정한다.
데드 레코닝 기술은 전동 모터(15)의 회전량으로부터 이동 로봇의 이동량을 산출하는 기술이다. 본 실시형태에서는 4개의 전동 모터(15) 각각의 구동축에 구동축의 회전 각도를 검출하는 엔코더가 장착되어 있다. 자기 위치 추정부(25)는 엔코더로부터 출력되는 각 전동 모터(15)의 회전 각도로부터 초기 위치 또는 전회(前回) 추정된 자기 위치로부터의 자율 이동 장치(1)의 이동량을 연산한다.
SLAM 기술은 센서를 이용하여 이동 로봇 주위의 환경 형상을 파악하고, 그 형상 데이터를 바탕으로 환경 지도를 작성함과 아울러 로봇의 자기 위치를 추정하는 기술이다. 본 실시형태에서는 자기 위치 추정부(28)가 장해물 정보 통합부(21)에 의해 통합된 장해물 정보를 이용하여 기기 자체 주위의 환경 형상을 파악한다.
보다 구체적으로는, 자기 위치 추정부(28)는 장해물 정보 통합부(21)로부터 입력된 장해물 정보에 의거하여 기기 자체를 중심으로 한 이차원의 극좌표 상에 있어서 기기 자체 주위의 장해물의 존재를 나타내는 장해물점을 특정한다. 그리고, 자기 위치 추정부(28)는 전동 모터(15)의 이동량을 참조하여 극좌표 상의 장해물점과, 직교좌표로 나타내어진 환경 지도 상에 있어서의 기지의 장해물 영역(61)을 대조하여 환경 지도 상에 있어서의 극좌표의 중심을 자기 위치라고 추정한다.
또한, 도 3c에 나타내는 바와 같이 환경 지도 상의 자기 위치(64)가 추정되면 장해물 정보 통합부(21)는 기기 자체 주위의 장해물의 존재를 나타내는 장해물점(65)의 위치를 환경 지도 상에 있어서 특정한다. 또한, 도 3c에 있어서 장해물점(65)을 백색의 삼각형에 의해 나타내고 있다.
이어서, 자율 이동체(1)가 행하는 행동의 종류에 대하여 설명한다. 자율 이동체(1)가 행하는 행동에는 통상 행동, 회피 행동, 정지 행동, 및 퇴피 행동의 4개가 있다. 그리고, 퇴피 행동에는 더 상세하게 분류하여 대기 행동과 우회 행동이 있다. 통상 행동은 계획된 경로에 따라서 이동하는 행동이고, 간섭하는 장해물이 검출되지 않은 경우에 선택되는 행동이다. 회피 행동, 정지 행동, 및 퇴피 행동에 대해서는 도 4를 참조해서 설명한다.
도 4의 (a)가 회피 행동을 설명하기 위한 도면이고, 도 4의 (b)가 정지 행동, 도 4의 (c)가 퇴피 행동 중 대기 행동, 도 4의 (d)가 퇴피 행동 중 우회 행동을 설명하기 위한 도면이다. 도 4에 있어서, 해칭된 직사각형상의 영역은 기지의 장해물 영역(61)을 나타내고, 크로스 해칭된 타원형상의 영역은 미지의 장해물 영역을 나타내고 있다. 미지의 장해물 영역은 환경 지도에 기지의 장해물 영역(61)으로서 등록되어 있지 않은 영역이고, 자율 이동체(1)에 있어서 미지의 장해물이 존재하는 영역이다. 미지의 장해물에는 사람 등의 움직이는 장해물과, 짐 등의 정지한 장해물이 포함되고, 사람이 대차를 밀면서 이동하고 있는 경우 등도 있다.
도 4에 나타내는 파선은 계획된 경로(68)를 나타내고 있다. 기지의 장해물을 피하도록 경로(68)가 계획된다. 이 때문에, 이동 중에 있어서 자율 이동체(1)의 이동 목표 방향에 미지의 장해물이 출현하는 경우가 있다. 이 경우, 자율 이동체(1)는 그대로 전진했을 경우에 간섭하는 간섭 장해물(66)이 존재하는 것을 장해물 정보에 의거하여 검출하고, 회피 행동, 정지 행동, 또는 퇴피 행동 중 어느 하나를 선택한다.
회피 행동은 장해물 정보에 의거하여 통로(95) 상에 있어서 간섭 장해물(66)을 회피해서 목적지(67)를 향해서 전진하는 행동이다. 이 때문에, 회피 행동은 간섭 장해물(66)과 기지의 장해물 영역(61) 사이에 자율 이동체(1)가 통과할 여유가 있는 경우에 선택된다. 도 4의 (a)에 있어서, 일점쇄선으로 나타내는 선이 회피 행동시의 이동을 나타내고 있다.
정지 행동은 통로(95)의 끝으로 대피해서 정지하는 행동이다. 간섭 장해물(66)과 기지의 장해물 영역(61) 사이에 자율 이동체(1)가 통과할 여유가 없는 경우라도 자율 이동체(1)와 간섭 장해물(66)이 각각 끝으로 접근할 수 있다면 자율 이동체(1)와 간섭 장해물(66)이 통로(95) 상에서 마주 지나갈 수 있는 경우가 있다. 자율 이동체(1)가 통로(95) 상에서 간섭 장해물(66)과 마주 지나갈 수 있다면 퇴피 행동을 행하는 것보다 효율적으로 목적지(67)에 도달할 수 있다. 그래서, 통로(95) 상에서 자율 이동체(1)가 간섭 장해물(66)과 마주 지나갈 만큼의 여유가 있는 경우에는 정지 행동이 선택된다. 이 경우, 자율 이동체(1)는 정지 위치(69)를 스스로 설정한다. 도 4의 (b)에 있어서, 일점쇄선으로 나타내는 선이 정지 행동시의 이동을 나타내고 있다.
퇴피 행동은 간섭 장해물(66)이 존재하는 통로(95)로부터 퇴피하는 행동이다. 통로(95) 상에서 간섭 장해물(66)과 마주 지나갈 만큼의 여유가 없는 경우에 퇴피 행동이 선택된다. 퇴피 행동 중 대기 행동은 통로(95)와 교차하는 퇴피로(70)로 퇴피하고, 대피 위치에서 대기하는 행동이다. 이것에 의해, 간섭 장해물(66)이 사람 등의 자율적으로 이동 가능한 것일 경우 간섭 장해물(66)이 통로(95)를 통과할 수 있다. 대기 행동을 행할 경우 자율 이동체(1)는 대기 위치(71)를 스스로 설정한다. 도 4의 (c)에 있어서, 일점쇄선으로 나타내는 선이 대기 행동시의 이동을 나타내고 있다.
퇴피 행동 중 우회 행동은 간섭 장해물(66)이 존재하는 통로(95)를 우회하는 행동이다. 이 경우, 자율 이동체(1)는 간섭 장해물(66)이 존재하는 통로(95)를 우회하는 우회로(97)를 통과하여 목적지(67)까지 이동한다. 도 4의 (d)에 있어서, 일점쇄선으로 나타내는 선이 우회 행동시의 이동을 나타내고 있다. 또한, 도 4의 (c), 도 4의 (d)에서는 대기 행동시 및 우회 행동시에 자율 이동체(1)가 간섭 장해물(66)의 바로 앞의 위치(100)로부터 후방의 통로로 이동하는 경우를 나타내고 있지만 위치(100)의 좌우에 통로가 있으면 위치(100)로부터 좌우로 이동해도 된다. 또한, 위치(100)와 간섭 장해물(66) 사이에 좌우의 통로가 있으면 전진하고나서 좌우로 이동해도 된다.
자율 이동체(1)가 상황에 맞춰서 행동을 선택하기 때문에 산출부(23)는 간섭 거리 산출부(231), 최근방 특정부(232), 장해물 특정부(233), 통과점 거리 산출부(234), 에지 거리 산출부(235), 도달 시간 산출부(236), 및 방향 설정부(237)를 구비한다. 그리고, 행동 선택부(24)는 통상 행동 선택부(241), 회피 행동 선택부(242), 정지 행동 선택부(243), 및 퇴피 행동 선택부(244)를 구비한다.
간섭 거리 산출부(231)는 통상 행동 선택부(241)가 통상 행동을 선택할지의 여부를 판정하기 위해서 간섭 거리를 산출한다. 간섭 거리는 자율 이동체(1)와 간섭 장해물(66) 사이의 거리이다. 도 5a~도 5c를 참조하여 간섭 거리 산출부(231)에 의한 간섭 거리의 산출 방법에 대하여 설명한다. 도 5a~도 5c는 간섭 거리의 산출 방법을 설명하기 위한 도면이다.
우선, 도 5a에 나타내는 바와 같이 간섭 거리 산출부(231)는 이동 목표 방향(72)을 결정한다. 간섭 거리 산출부(231)는 자기 위치 추정부(28)에 의해 추정된 자기 위치(64)로부터 일정 범위 내의 서브골(63)을 특정하고, 자기 위치(64)로부터 일정 범위 내의 각 서브골(63)을 향하는 벡터를 설정한다. 도 5a에 나타내는 예에서는 자기 위치(64)보다 전방의 서브골(632, 633)을 향하는 벡터가 설정된다. 그리고, 간섭 거리 산출부(231)는 설정한 복수의 벡터의 합성 벡터를 산출하고, 산출한 합성 벡터의 방향을 이동 목표 방향(72)으로 한다. 이 이동 목표 방향(72)은 자율 이동체(1)가 이동하는 목표가 되는 방향이고, 가상 포텐셜법을 이용하여 이동을 제어할 때의 인력 방향이 된다.
이어서, 도 5b에 나타내는 바와 같이 간섭 거리 산출부(231)는 간섭존(73)을 설정한다. 간섭존(73)은 이동 목표 방향(72)과 평행하게 연장된 띠 형상의 영역이고, 이동 목표 방향(72)과 수직인 폭 방향의 크기(74)는 기기 자체의 크기(D2) 또는 기기 자체의 크기(D2)에 여유를 더한 크기로 설정된다. 또한, 간섭존(73)은 폭 방향의 중앙에 자기 위치(64)가 위치하도록 설정된다. 그리고, 간섭 거리 산출부(231)는 장해물 정보에 의해 특정되는 장해물점(65) 중 자기 위치(64)보다 전방의 간섭존(73) 내에 위치하는 장해물점(65)을 간섭점(75)으로서 특정한다. 도 5b에 있어서, 특정되는 간섭점(75)을 흑색의 삼각형으로 나타내고, 그 이외의 장해물점(65)을 백색의 삼각형으로 나타내고 있다. 또한, 도 5a~도 5c에 있어서는 간섭 장해물(66)을 파선으로 나타내고 있다.
마지막으로, 도 5c에 나타내는 바와 같이 간섭 거리 산출부(231)는 자율 이동체(1)로부터 각 간섭점(75)까지의 거리(76)를 산출한다. 거리(76)는 이동 목표 방향(72)과 평행한 방향의 거리이다. 간섭 거리 산출부(231)는 산출한 거리(76) 중 가장 짧은 거리를 간섭 거리(D6)로 한다.
간섭 거리 산출부(231)에 의해 산출된 간섭 거리(D6)가 미리 정해진 역치보다 클 경우, 및 간섭 거리 산출부(231)에 의해 간섭점(75)이 특정되지 않았을 경우 통상 행동 선택부(241)는 간섭 장해물(66)이 검출되지 않았다고 판단한다. 간섭 장해물(66)이 검출되지 않았다고 판단했을 경우 통상 행동 선택부(241)는 통상 행동을 선택한다. 한편, 통상 행동 선택부(241)는 간섭 거리(D6)가 역치 이하인 경우 간섭 장해물(66)이 검출되었다고 판단하고, 통상 행동을 선택하지 않는다. 이 경우, 회피 행동 선택부(242), 정지 행동 선택부(243), 퇴피 행동 선택부(244)에 의해 통상 행동 이외의 행동이 선택된다.
간섭 거리(D6)가 역치 이하인 경우 최근방 특정부(232)는 간섭점(75) 중 자율 이동체(1)와 간섭하는 가장 가까운 점인 최근방 간섭점(79)을 특정한다. 즉, 최근방 특정부(232)는 간섭 거리 산출부(231)에 의해 산출된 간섭 거리(D6)의 간섭점(75)을 최근방 간섭점(79)으로서 특정한다. 도 5c에서는 최근방 특정부(232)에 의해 특정되는 최근방 간섭점(79)을 흑색의 삼각형으로 나타내고, 그 이외의 간섭점(75)을 백색의 삼각형으로 나타내고 있다.
장해물 특정부(233)는 간섭 장해물(66)의 에지 위치를 특정하기 위해서 하나로 통합해 간주할 수 있는 장해물점(65)을 클러스터링한다. 또한, 장해물 특정부(233)는 특허청구범위에 기재된 장해물 특정 수단으로서 기능한다. 도 6a 및 도 6b를 참조하여 장해물 특정부(233)에 의한 에지 위치의 특정 방법을 설명한다. 도 6a 및 도 6b는 에지 위치의 특정 방법을 설명하기 위한 도면이다.
우선, 도 6a에 나타내는 바와 같이 장해물 특정부(233)는 에지 검출존(80)을 설정한다. 에지 검출존(80)은 이동 목표 방향(72)과 수직으로 연장된 띠 형상 영역이고, 이동 목표 방향(72)과 평행인 폭 방향의 중앙에 최근방 간섭점(79)이 위치하도록 설정된다. 에지 검출존(80)의 폭 방향의 크기(81)는 임의로 설정 가능하지만, 예를 들면 10~20㎝ 정도로 설정된다. 그리고, 장해물 특정부(233)는 장해물점(65) 중에서 에지 검출존(80)에 포함되는 장해물점(82)을 특정하고, 특정한 장해물점(82)을 클러스터링한다. 도 6a에 있어서, 클러스터링된 장해물점(82)을 흑색의 삼각형으로 나타내고, 그 이외의 장해물점(65)을 백색의 삼각형으로 나타낸다.
장해물 특정부(233)는 최근방 간섭점(79)과 가까운 순서로 에지 검출존(80) 내의 장해물점(82)인지의 여부를 특정해 간다. 특정된 장해물점(82)의 옆에 위치하는 장해물점(83)이 에지 검출존(80)으로부터 벗어나 있을 경우 장해물 특정부(233)는 그 장해물점(83)이 특이점인지의 여부의 판정을 행한다. 특이점인지의 여부의 판정을 행하기 위해서 도 6b에 나타내는 바와 같이 장해물 특정부(233)는 특이점 검출존(84)을 설정한다. 특이점 검출존(84)은 이동 목표 방향(72)과 평행하게 연장된 띠 형상 영역이고, 이동 목표 방향(72)과 수직인 폭 방향의 중앙에 판정 대상이 되는 장해물점(83)이 위치하도록 설정된다.
장해물 특정부(233)는 에지 검출존(80)과 특이점 검출존(84)이 겹치는 영역(85) 내에 위치하는 장해물점(65)이 있는 경우에는 장해물점(83)을 특이점이라고 판정하고, 영역(85) 내의 장해물점(65)을 포함해서 클러스터링을 행한다. 그리고, 영역(85) 내의 장해물점(65)을 최근방 간섭점(79)과 가까운 순서로 에지 검출존(80) 내의 장해물점(82)인지의 여부를 판정해 간다. 도 6b에 나타내는 예에서는 영역(85) 내의 장해물점(65)은 존재하지 않으므로 상기에서 특정한 장해물점(82)만을 클러스터링한다.
이것에 의해, 에지 검출존(80) 내에 있어서 최근방 간섭점(79)과 하나로 통합해 간주할 수 있는 장해물점(65)이 클러스터링된다. 그리고, 장해물 특정부(233)는 클러스터링한 장해물점(82)으로부터 이동 목표 방향(72)과 직교하는 가장 멀리 떨어진 2개의 장해물점(82)을 에지점(86)으로서 특정한다. 즉, 에지점(86)은 간섭 장해물(66)이 존재하는 영역의 양 단부로서, 통로면과 평행한 면에 있어서 기기 자체의 이동 목표 방향(72)과 대략 직교하는 방향의 양 단부의 위치를 나타낸다. 본 실시형태에서는, 에지점(86)은 자율 이동체(1)의 전방에 위치하고 가로 방향으로 연장된 띠 형상의 에지 검출존(80) 내에 있어서 간섭 장해물(66)의 양 끝의 위치를 나타내는 점이라고 간주할 수 있다. 도 6a 및 도 6b에 있어서는 보기 쉽게 하기 위해서 기기 자체의 크기(D2)를 나타내는 원에 대하여 에지 검출존(80)의 폭을 크게 도시하고 있지만, 실제로는 기기 자체의 크기(D2)에 대하여 에지 검출존(80)의 폭이 작으므로 2개의 에지점(86)을 연결하는 직선은 이동 목표 방향(72)과 대략 수직이 된다.
회피 행동 선택부(242)가 장해물 특정부(233)에 의해 특정된 에지점(86)을 갖는 간섭 장해물(66)을 경로 상에 있어서 회피할 수 있는지의 여부를 판정하기 위해서 방향 설정부(237)가 회피하는 방향을 설정하고, 통과점 거리 산출부(234)는 통과점 거리를 산출한다. 통과점 거리는 간섭 장해물(66)을 통로(95) 상에서 회피할 경우에 자율 이동체(1)가 통과하는 회피 통과점과, 계획된 경로(68) 사이의 거리이다. 즉, 통과점 거리 산출부(234)는 자율 이동체(1)가 간섭 장해물(66)을 회피하기 위해서 경로(68)로부터 얼마만큼 떨어질 필요가 있는지를 산출한다. 또한, 통과점 거리 산출부(234)는 특허청구범위에 기재된 통과점 거리 산출 수단으로서 기능한다.
도 7a~도 7c를 참조하여 회피 통과점(91)과 경로(68) 사이의 거리를 산출하는 방법을 설명한다. 도 7a~도 7c는 회피 통과점(91)과 경로(68)의 거리를 산출하는 방법을 설명하기 위한 도면이다.
우선, 도 7a에 나타내는 바와 같이 방향 설정부(237)는 기기 자체의 크기(D2)와 에지점(86)에 의거하여 회피 방향을 설정한다. 방향 설정부(237)는 2개의 에지점(86) 중 자기 위치(64)에 가까운 에지점(86)을 중심으로 하는 가상원(87)을 설정한다. 이 가상원(87)의 반경(88)은 기기 자체의 크기(D2)의 절반에 여유를 가산한 안전 거리로 설정된다. 이렇게, 에지점(86)을 가상원(87)으로 설정함으로써 자율 이동체(1)를 점으로서 취급할 수 있다.
그리고, 방향 설정부(237)는 자기 위치(64)를 지나 가상원(87)에 접하는 2개의 접선(891, 892)을 긋는다. 방향 설정부(237)는 2개의 접선(891, 892)으로부터 하나의 접선을 선택하고, 회피 방향(90)으로 설정한다. 도 7a에 나타내는 예에서는 한쪽의 접선(891)이 2개의 에지점(86)에 끼여 있으므로 이 한쪽의 접선(891) 방향으로 자율 이동체(1)가 이동하면 간섭 장해물(66)에 간섭한다. 다른쪽의 접선(892)의 방향으로 이동하면 간섭 장해물(66)을 회피할 수 있다. 그래서, 방향 설정부(234)는 에지점(86)에 끼여있지 않은 쪽의 접선(892)을 회피 방향(90)으로 설정한다.
또한, 도 7b에 나타내는 예에서는 2개의 접선(893, 894) 사이에 2개의 에지점(86)이 위치하고 있다. 이 경우, 방향 설정부(237)는 자기 위치(64)에 가까운 에지점(86)측의 접선(893)을 회피 방향(90)으로 설정한다.
이어서, 도 7c에 나타내는 바와 같이 통과점 거리 산출부(234)는 회피 방향(90)을 나타내는 접선(89)과 가상원(87)의 접점을 회피시에 통과하는 회피 통과점(91)으로서 특정한다. 그리고, 통과점 거리 산출부(234)는 서브골(631)과 서브골(632)을 연결하는 경로(68)와, 회피 통과점(91) 사이의 최단 거리를 통과점 거리(D7)로서 산출한다.
회피 행동 선택부(242)는 통과점 거리(D7)와, 가장 가깝거나 또는 바로 앞의 서브골(631)의 경로 여유(D3)에 의거하여 회피 행동이 가능한지의 여부를 판정한다. 즉, 회피 행동 선택부(242)는 특허청구범위에 기재된 회피 판정 수단으로서 기능한다. 도 8a 및 도 8b를 참조하여 회피 행동이 가능한지의 여부를 판정하는 방법에 대하여 설명한다. 도 8a 및 도 8b는 회피 행동이 가능한지의 여부를 판정하는 방법을 설명하기 위한 도면이다.
도 8a에 나타내는 예와 같이, 통과점 거리(D7)가 경로 여유(D3) 이하이면 간섭 장해물(66)을 회피하기 위해서 자율 이동체(1)가 회피 통과점(91)에서 벗어난 경우라도 기지의 장해물 영역(61)과 자율 이동체(1) 사이에 여유가 있다. 그래서, 통과점 거리(D7)가 경로 여유(D3) 이하일 경우 회피 행동 선택부(242)는 회피 가능이라고 판정한다. 그 결과, 회피 행동 선택부(242)는 회피 행동을 선택한다.
도 8b에 나타내는 예와 같이, 통과점 거리(D7)가 경로 여유(D3)보다 클 경우 간섭 장해물(66)을 회피하기 위해서 벗어나면 기지의 장해물 영역(61)과 간섭할 가능성이 있기 때문에 회피 행동 선택부(242)는 회피 불가능이라고 판정한다. 그 결과, 회피 행동 선택부(242)는 회피 행동을 선택하지 않는다. 또한, 도 8a 및 도 8b에 나타내는 바와 같이 경로 여유(D3)는 통로(95)에 있어서 경로(68)로부터 회피 통과점(91)측의 방향 및 경로 방향과 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타낸다. 따라서, 이 경로 여유(D3)를 취득하는 폭 특정부(27)가 특허청구범위에 기재된 여유 특정 수단으로서 기능한다.
회피 행동 선택부(242)가 회피 행동을 선택하지 않은 경우, 정지 행동 선택부(243)가 정지 행동과 퇴피 행동 중 어느 하나를 선택하기 때문에 에지 거리 산출부(235)는 2개의 에지점(86) 사이의 거리를 산출한다. 도 9a 및 도 9b를 참조하여 정지 행동과 퇴피 행동의 선택 방법에 대하여 설명한다. 도 9a 및 도 9b는 정지 행동과 퇴피 행동의 선택 방법을 설명하기 위한 도면이다.
도 9a에 나타내는 바와 같이, 에지 거리 산출부(235)는 2개의 에지점(86) 사이의 거리를 산출하고, 산출한 거리를 간섭 장해물(66)의 크기(D8)로 한다. 간섭 장해물(66)의 크기(D8)는 통로면과 평행한 면에 있어서 이동 목표 방향(72)과 대략 직교하는 방향의 크기이고, 간섭 장해물(66)에 있어서의 에지 검출존(80) 내의 부분의 크기이다.
정지 행동 선택부(243)는 공간 사이즈(D1)와, 기기 자체의 크기(D2)와, 간섭 장해물(66)의 크기(D8)에 의거하여 정지 행동과 퇴피 행동 중 어느 하나를 선택한다. 정지 행동은 장해물이 있기 때문에 이동 목표 방향(72)으로는 이동할 수 없고, 회피 행동을 행하기 위해서는 길 폭의 여유가 없지만 자율 이동체(1)와 간섭 장해물(66)이 끝으로 접근하면 자율 이동체(1)와 간섭 장해물(66)이 통로(95) 상에 있어서 마주 지나갈 만큼의 여유가 있는 경우에 선택된다.
정지 행동 선택부(243)는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1)보다 작을 경우에 통로(95) 상에 있어서 자율 이동체(1)와 간섭 장해물(66)이 마주 지나갈 만큼의 여유가 있다고 판정한다. 그 결과, 정지 행동 선택부(243)는 통로(95)의 끝으로 피해서 정지하기 때문에 정지 행동을 선택한다. 도 9a에 나타내는 예에서는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1)보다 작으므로 정지 행동이 선택된다. 정지 행동 선택부(243)는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1) 이상일 경우에 통로(95)에 있어서 자율 이동체(1)와 간섭 장해물(66)이 마주 지나갈 만큼의 여유가 없다고 판정한다. 그 결과, 정지 행동 선택부(243)는 퇴피 행동을 선택한다. 도 9b에 나타내는 예에서는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1) 이상이기 때문에 퇴피 행동이 선택된다.
또한, 정지 행동 선택부(243)는 스테레오 카메라(14)에 의해 촬영된 화상을 해석하여 간섭 장해물(66)이 사람이나 다른 자율 이동체 등과 같이 피하는 행동을 취할 수 있는 장해물인지의 여부를 판정하고, 이 판정 결과를 가미하여 정지 행동 또는 대피 행동을 선택해도 된다. 이 경우, 정지 행동 선택부(243)는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1)보다 작고, 또한 간섭 장해물(66)이 피하는 행동을 취할 수 있는 장해물인 경우에 정지 행동을 선택한다. 또한, 정지 행동 선택부(243)는 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값이 공간 사이즈(D1)보다 작은 경우라도 간섭 장해물(66)이 피하는 행동을 취할 수 있는 장해물이 아닌 경우에는 대피 행동을 선택한다.
정지 행동이 선택된 경우에 스스로 정지 위치를 설정하기 위해서 전자 제어 장치(20)는 정지 위치 설정부(29)를 구비한다. 정지 위치 설정부(29)는 통로(95) 상에서 간섭 장해물(66)과 마주 지나가기 위해서 통로(95)의 끝으로 피해서 정지하는 정지 위치를 설정한다. 이 정지 위치 설정부(29)는 특허청구범위에 기재된 정지 위치 설정 수단으로서 기능한다.
도 10을 참조하여 정지 위치의 설정 방법을 설명한다. 도 10은 정지 위치의 설정 방법을 설명하기 위한 도면이다. 정지 위치 설정부(29)는 상기에서 설정된 회피 방향(90)을 사용해서 정지 위치(69)를 설정한다. 정지 위치 설정부(29)는 회피 방향(90)을 나타내는 직선 상에서 정지 위치(69)를 설정한다. 즉, 정지 위치 설정부(29)는 회피 방향(90)을 특허청구범위에 기재된 대피 방향으로서 사용해서 정지 위치(69)를 설정한다. 따라서, 회피 방향(90)(대피 방향)을 설정한 방향 설정부(237)는 특허청구범위에 기재된 방향 설정 수단으로서 기능한다. 또한, 정지 위치 설정부(29)는 통로(95)의 끝에 위치하고, 또한 환경 지도에 나타내어지는 기지의 장해물 영역(61)으로부터 여유를 갖는 위치에 정지 위치(69)를 설정한다. 예를 들면, 정지 위치(69)는 대피 방향[회피 방향(90)]을 나타내는 직선 상에서 경로(68)로부터의 거리가 경로 여유(D3)인 위치에 설정된다. 또한, 정지 위치(69)는 회피 방향(90) 상에서 자율 이동체(1)가 기지의 장해물(61)에 닿지않을 정도로 최대한으로 끝에 근접한 위치이어도 된다.
한편, 퇴피 행동이 선택된 경우 퇴피 행동 선택부(244)는 대기 행동과 우회 행동 중 어느 하나를 선택한다. 퇴피 행동 선택부(244)는 대기 행동과 우회 행동 중 목적지까지 도달하는데 걸리는 시간이 빠른 쪽의 행동을 선택한다. 이 때문에, 도달 시간 산출부(236)는 대기 행동을 선택했을 경우의 목적지까지의 도달 시간과, 우회 행동을 선택했을 경우의 도달 시간을 산출한다.
도 2로 돌아가서, 전자 제어 장치(20)는 도달 시간 산출부(236)가 대기 행동과 우회 행동의 도달 시간을 산출하기 위해서 퇴피 경로 계획부(30)를 구비한다. 퇴피 경로 계획부(30)는 기억부(22)에 기억된 환경 지도와, 경로 계획부(26)에 의해 이미 계획된 경로(68) 등을 이용하여 퇴피 경로를 탐색한다. 퇴피 경로에는 대기 행동이 선택된 경우에 사용하는 대기 위치까지의 경로와, 우회 행동이 선택된 경우에 사용하는 우회로(97)가 포함된다. 퇴피 경로 계획부(30)는 대기 위치를 설정하고, 설정한 대기 위치까지의 경로를 계획하는 대기 위치 설정부(301)와, 우회로(97)를 탐색하고, 우회로(97)를 통과하여 목적지(67)까지 이동하는 경로를 계획하는 우회로 탐색부(302)를 구비한다.
도 11을 참조하여 대기 위치 설정부(301)에 의한 대기 위치의 설정 방법에 대하여 설명한다. 도 11은 대기 위치의 설정 방법에 대해서 설명하기 위한 도면이다. 우선, 대기 위치 설정부(301)는 대기 위치(71)를 설정 가능한 경로 여유(D3)를 갖는 퇴피로(70)를 특정한다. 대기 위치(71)를 설정 가능한 퇴피로(70)로서는 간섭 장해물(66)이 존재하는 통로(95)와 교차하는 통로가 있다.
통로(95)에 있어서, 다른 통로와 교차하는 교차점 상의 서브골(63)에서는 교차점 이외의 통로(95) 상의 서브골(63)보다 경로 여유(D3)가 크다. 따라서, 대기 위치 설정부(301)는, 예를 들면 기억부(22)에 기억된 각 서브골(63)의 경로 여유(D3)에 의거하여 자기 위치(64)보다 후방의, 바람직하게는 자기 위치(64)로부터 가장 가까운 교차점 상의 서브골(63)을 특정한다. 또한, 자기 위치(64)가 교차점의 서브골(63) 상이라면 그 서브골(63)을 특정해도 좋다. 또한, 자기 위치(64)와 간섭 장해물(66) 사이에 교차점 상의 서브골(63)이 있고, 자기 위치(64)와 간섭 장해물(66) 사이에 여유가 있는 경우에는 그 서브골(63)을 특정해도 좋다.
그리고, 대기 위치 설정부(301)는 특정한 교차점 상의 서브골(63)의 위치에서 통로(95)와 교차하는 통로를 대기 위치(71)를 설정하는 퇴피로(70)로서 특정한다. 이어서, 대기 위치 설정부(301)는 특정한 퇴피로(70) 상에 있어서 통로(95)의 경로(72)에 대하여 수직인 직선(96) 상에 대기 위치(71)를 설정한다. 그리고, 대기 위치 설정부(301)는 대기 위치(71)를 일시적인 목적지로 설정하고, 자기 위치(64)로부터 대기 위치(71)까지의 경로 계획을 행한다. 또한, 대기 위치 설정부(301)는 교차점 상의 서브골(63)에 한정되지 않고, 공간 사이즈(D1)가 기기 자체의 크기(D2)와 간섭 장해물(66)의 크기(D8)의 합계값 이상인 서브골(63)을 특정하고, 특정한 서브골(63) 부근에 있어서 최대한으로 끝에 접근한 위치를 대기 위치로 설정해도 된다.
우회로 탐색부(302)는 간섭 장해물(66)이 존재하는 통로(95)를 우회하기 위한 우회로(97)[도 4의 (d)]를 탐색하고, 자기 위치(64)로부터 목적지(67)까지의 경로를 계획한다. 또한, 대기 위치 설정부(301)에 의한 경로 계획과, 우회로 탐색부(302)에 의한 우회로(97)의 경로 계획은 환경 지도, 공간 사이즈(D1), 기기 자체의 크기(D2) 등에 의거하여 상술한 경로 계획부(26)에 의한 경로 계획과 같은 알고리즘을 이용하여 행하여진다.
도달 시간 산출부(236)는 대기 행동을 선택했을 경우의 목적지(67)까지의 도달 시간과, 우회 행동을 선택했을 경우의 도달 시간을 산출한다. 도달 시간 산출부(236)는 대기 위치 설정부(301)에 의해 계획된 경로와, 경로 계획부(26)에 의해 계획된 원래의 경로(68)에 의거하여 대기 행동시의 도달 시간을 산출한다. 대기 행동의 도달 시간으로서 자기 위치(64)로부터 대기 위치(71)까지 이동하는 시간, 대기하는 시간, 및 대기 위치(71)로부터 다시 원래의 계획된 경로(68)에 따라서 목적지(67)까지 이동하는 시간의 합계값을 산출한다.
또한, 도달 시간 산출부(236)는 우회로 탐색부(302)에 의해 계획된 경로에 의거하여 우회 행동시의 도달 시간을 산출한다. 구체적으로는, 도달 시간 산출부(236)는 우회 행동의 도달 시간으로서 자기 위치(64)로부터 우회로(97)를 통과하여 목적지(67)까지 이동하는 시간을 산출한다.
퇴피 행동 선택부(244)는 산출된 대기 행동과 우회 행동의 도달 시간 중 도달 시간이 짧은 쪽의 행동을 선택한다. 이상, 산출부(23)의 산출 결과에 의거하여 행동 선택부(24)가 행동을 선택하는 방법에 대하여 설명했다. 이어서, 이동 제어부(25)가 선택된 행동에 의거하여 자율 이동체(1)의 이동을 제어하는 방법에 대하여 설명한다.
이동 제어부(25)는 본 실시형태에서는 가상 포텐셜법을 이용하여 장해물을 회피하면서 목적지(67)까지의 이동을 제어한다. 가상 포텐셜법은 서브골(63)에 대한 가상적인 인력 포텐셜장과, 장해물에 대한 가상적인 척력 포텐셜장을 중합한 가상적인 포텐셜장을 생성하고, 이 가상적인 포텐셜장에서 발생하는 힘을 이동 제어에 사용하는 방법이다. 이동 제어부(25)는 가상 포텐셜법을 이용하여 이동 제어를 행하기 위해서 벡터 산출부(251)와, 출력 변환부(252)를 구비한다.
벡터 산출부(251)는 행동 선택부(24)에 의해 선택된 행동에 의거하여 인력 벡터를 산출한다. 또한, 벡터 산출부(251)는 자기 위치(64), 자기의 이동 속도, 경로 여유(D3), 및 장해물 정보에 의거해서 특정되는 장해물의 위치 및 이동 속도 등에 의거하여 척력 벡터를 산출한다. 그리고, 벡터 산출부(251)는 인력 벡터와 척력 벡터의 합성 벡터를 산출한다.
출력 변환부(252)는 벡터 산출부(251)에 의해 산출된 합성 벡터를 전동 모터(15)의 출력으로 변환한다. 출력 변환부(252)는 합성 벡터의 놈에 의해 나타내어지는 속도로 합성 벡터의 방향으로 이동하도록 4개의 전동 모터(15)의 출력을 조정한다.
통상 행동이 선택되었을 경우, 인력 벡터는 자기 위치(64) 근방의 서브골(63)의 위치 및 거리에 의거하여 산출된다. 예를 들면 인력 벡터의 방향은 상술한 이동 목표 방향(72)으로 설정된다. 놈은, 예를 들면 서브골(63)마다 할당된 소정의 입력 속도로 설정된다. 이것에 의해, 통상 행동이 선택되었을 경우 이동 제어부(25)는 계획된 경로(68)에 따름과 아울러 척력 벡터에 의거하여 장해물을 피하면서 목적지(67)를 향해서 이동하도록 전동 모터(15)를 제어한다.
회피 행동이 선택되었을 경우, 인력 벡터의 방향은 회피 방향(90)으로 설정되고, 놈은 예를 들면 소정의 입력 속도로 설정된다. 이것에 의해, 회피 행동이 선택되었을 경우 이동 제어부(25)는 통로(95) 상에 있어서 간섭 장해물(66)을 회피하도록 전동 모터(15)를 제어한다.
정지 행동이 선택되었을 경우, 정지 위치(69)에 도달할 때까지 인력 벡터의 방향은 자기 위치(64)로부터 정지 위치(69)를 향하는 대피 방향[회피 방향(90)]으로 설정된다. 즉, 이동 제어부(25)는 대피 방향을 향해서 이동하고, 정지 위치(69)에서 정지하도록 기기 자체를 제어한다. 이것에 의해, 이동 제어부(25)는 특허청구범위에 기재된 이동 제어 수단으로서 기능한다. 또한, 인력 벡터의 놈은 자기 위치(64)와 정지 위치(69) 사이의 거리에 따라 설정된다. 도 12는 정지 위치까지의 거리와 속도의 관계를 나타내는 그래프이다. 도 12에 있어서, 가로축이 자기 위치(64) 및 정지 위치(69) 사이의 거리를 나타내고, 세로축이 정지 행동시의 인력 벡터의 놈, 즉 속도를 나타낸다.
도 12에 나타내는 바와 같이, 인력 벡터의 놈은 자기 위치(64)와 정지 위치(69) 사이의 거리가 추출 범위 이상인 경우 소정의 입력 속도로 설정된다. 또한, 이동 목표 방향(72)을 특정할 때에 자기 위치(64)로부터 일정 범위 내의 서브골(63)을 특정했지만 이 일정 범위를 추출 범위로 설정할 수 있다. 인력 벡터의 놈은 자기 위치(64)와 정지 위치(69) 사이의 거리가 추출 범위 이하인 경우 자기 위치(64)가 정지 위치(69)에 근접함에 따라서 작아지고, 자기 위치(64)와 정지 위치(69) 사이의 거리가 여유(α)까지 근접한 위치에서 0이 된다. 즉, 이동 제어부(25)는 기기 자체와 정지 위치(69) 사이의 거리가 짧아질수록 이동 속도가 느려지도록 제어한다. 이것에 의해, 자율 이동체(1)는 감속하면서 정지 위치(69)에 근접하고, 놈이 0의 값이 되면 정지한다. 여유(α)는 본 실시형태에서는 기기 자체의 크기(D2)의 절반의 값, 또는 기기 자체의 크기(D2)의 절반의 값에 임의의 여유를 가산한 값으로 설정된다.
가상 포텐셜법에서는 인력 벡터와 인력 벡터의 놈(속도)을 리미트로 한 척력 벡터를 합성하여 합력 벡터를 산출한다. 이 때문에, 놈이 작아질수록 장해물을 회피하는 힘이 작아지고, 장해물을 피하기 어려워진다. 이 때문에, 전자 제어 장치(20)는 자율 이동체(1)가 정지하도록 이동 제어가 행하여질 때에 간섭 판정을 행하는 간섭 판정부(31)를 구비한다.
도 13을 참조하여 간섭 판정부(31)에 의한 간섭 판정의 방법을 설명한다. 도13은 간섭 판정의 방법을 설명하기 위한 도면이다. 간섭 판정부(31)에 의한 간섭 판정은 상술한 간섭 거리 산출부(231)에 의해 산출되는 간섭 거리(D6)를 사용해서 행하여진다.
도 13에 나타내는 바와 같이, 간섭 거리 산출부(231)는 상기와 마찬가지로 간섭존(73)을 설정한다. 간섭존(73)은 이동 목표 방향(72)과 평행하게 연장된 띠 형상의 영역이고, 이동 목표 방향(72)과 수직인 폭 방향의 크기(74)는 기기 자체의 크기(D2) 또는 기기 자체의 크기(D2)에 여유를 더한 크기로 설정된다. 또한, 간섭존(73)은 폭 방향의 중앙에 자기 위치(64)가 위치하도록 설정된다. 또한, 이동 목표 방향(72)으로서 자기 위치(64)로부터 정지 위치(69)를 향하는 대피 방향[(회피 방향(90)]이 설정된다.
그리고, 간섭 거리 산출부(231)는 장해물 정보에 의해 특정되는 장해물점(65) 중 자기 위치(64)보다 전방의 간섭존(72) 내에 위치하는 간섭점(75)을 특정한다. 도 13은 미지의 장해물(99)이 간섭존(73) 내로 이동해 온 경우를 나타내고 있다. 간섭 거리 산출부(231)는 특정한 간섭점(75)으로부터 자율 이동체(1)까지의 이동 목표 방향(72)을 따른 거리(102)를 산출한다. 간섭점(75)이 복수 특정된 경우에는 각각의 거리(102)가 산출된다. 그리고, 간섭 거리 산출부(231)는 산출한 거리(102) 중 최소의 거리를 간섭 거리(D6)라고 한다. 즉, 간섭 거리 산출부(231)는 특허청구범위에 기재된 간섭 거리 산출 수단으로서 기능한다.
간섭 판정부(31)는 정지에 필요한 정지 거리를 추정한다. 그리고, 간섭 판정부(31)는 간섭 거리(D6)가 정지 거리에 여유값을 가산한 거리보다 작을 경우 정지하지 않으면 간섭 장해물(66)과 간섭한다고 판정한다. 이 경우, 간섭 판정부(31)는 정지한다고 판정한다. 또한, 간섭 판정부(31)는 간섭 거리(D6)가 정지 거리에 여유값을 가산한 거리 이상일 경우 정지하지 않고 전진해도 간섭하지 않는다고 판정한다. 이 경우, 간섭 판정부(31)는 정지하지 않는다고 판정한다. 즉, 간섭 판정부(31)는 특허청구범위에 기재된 추정 수단 및 판정 수단으로서 기능한다. 정지 거리는 이동 제어부(25)가 정지시키는 제어를 개시하고나서 실제로 정지할 때까지 기기 자체가 이동하는 거리이다. 본 실시형태에서는 정지 거리가 (현재의 속도)×(감속에 걸리는 시간)÷2의 식에 의해 추정된다. 또한, 정지 거리에 여유값을 가산한 거리로서 (현재의 속도)×(감속에 걸리는 시간)+β의 식에 의해 나타내어지는 거리를 사용해도 된다. β는 안전을 가미한 여유를 나타내는 거리이다.
간섭 판정부(31)에 의해 정지한다고 판정되었을 경우 벡터 산출부(251)는 인력 벡터의 놈을 0으로 설정하고, 자율 이동체(1)가 정지하도록 제어한다. 또한, 이동 제어부(25)는 정지 위치(69)를 향하는 도중에 간섭 판정부(31)에 의해 정지하지 않는다고 판정된 경우에는 정지 위치(69)를 향하는 이동 제어를 속행한다.
또한, 이동 제어부(25)는 퇴피 행동이 선택되었을 경우도 정지 위치로 이동하고나서 정지하도록 제어한 후 대기 위치(71) 또는 우회로로 퇴피하도록 이동을 제어한다. 즉, 이동 제어부(25)는 퇴피 행동이 선택되었을 경우 상술한 정지 행동을 행하고나서 퇴피 행동을 행하도록 제어한다. 이 때문에, 정지 위치 설정부(29)는 퇴피 행동이 선택된 경우도 정지 위치(69)를 설정한다.
퇴피 행동으로서 대기 행동이 선택되었을 경우 이동 제어부(25)는 정지 위치(69)로부터 대기 위치(71)로 퇴피하고나서 소정 시간 대기한 후 다시 원래의 통로(95)로 돌아가도록 이동을 제어한다. 그리고, 이동 제어부(25)는 다시 원래의 경로(68)에 따라서 이동을 제어한다. 퇴피 행동으로서 우회 행동이 선택되었을 경우 이동 제어부(25)는 정지 위치(69)로부터 우회로로 이동하도록 제어하고, 우회로를 통과하여 목적지(67)까지 이동하도록 제어한다.
계속하여, 전자 제어 장치(20)에 의한 이동 제어의 처리 순서에 대하여 설명 함과 아울러 자율 이동체(1)의 동작에 대하여 설명한다. 우선, 도 14를 참조하여 자율 이동체에 의한 행동 선택 처리의 처리 순서를 설명한다. 도 14는 행동 선택 처리의 처리 순서를 나타내는 흐름도이다. 이 행동 선택 처리는 자율 이동체(1)가 목적지(67)를 향해서 자율 이동하고 있을 때에 소정의 주기로 실행된다.
우선, 스텝 S101에서는 자기 위치(64)와 자기 위치(64)보다 전방의 복수의 서브골(63)의 위치에 의거하여 이동 목표 방향(72)이 결정된다(도 5a). 또한, 이것에 앞서 환경 지도 상의 자기 위치(64)의 추정과, 환경 지도 상의 기기 자체 주위의 장해물의 존재를 나타내는 장해물점(65)의 특정이 행하여진다. 이어서, 스텝 S102에서는 이동 목표 방향(72)과 평행인 간섭존(73)이 설정되고, 간섭존(73) 내의 간섭점(75) 중 가장 기기 자체에 가까운 최근방 간섭점(79)과 자율 이동체(1) 사이의 거리, 즉 간섭 거리(D6)가 산출된다(도 5b, 도 5c).
이어지는 스텝 S103에서는 스텝 S102에서 산출된 간섭 거리(D6)가 역치 이하인지의 여부가 판정된다. 이것에 의해, 자율 이동체(1)의 전방에 간섭 장해물(66)이 존재하는지의 여부가 판정된다. 스텝 S103에 있어서 간섭 거리(D6)가 역치보다 클 경우 스텝 S104로 처리가 진행된다. 스텝 S104에서는 통상 행동이 선택된다. 통상 행동이 선택되면 이동 제어부(25)에 의한 제어에 의해 자율 이동체(1)는 통로(95) 상을 이동 목표 방향(72)을 향해서 이동한다.
스텝 S103에 있어서, 간섭 거리(D6)가 역치 이하일 경우 스텝 S105로 처리가 진행된다. 스텝 S105에서는 간섭 장해물(66)의 에지점(86)이 특정된다. 이 에지점을 특정하는 처리의 처리 순서에 대해서 도 15를 참조해서 설명한다. 도 15는 에지점(86)의 특정 처리의 처리 순서를 나타내는 흐름도이다.
에지점의 특정 처리는 우선 스텝 S1051에 있어서 간섭점(75) 중 자율 이동체(1)와 간섭할 가능성이 있고, 가장 가까운 점인 최근방 간섭점(79)이 특정된다(도 5c). 이어서, 스텝 S1052에서는 최근방 간섭점(79)을 포함해 이동 목표 방향(72)에 직교하는 방향으로 연장된 에지 검출존(80)이 설정된다(도 6a). 그리고, 스텝 S1053에서는 에지 검출존(80)에 포함되는 장해물점(82)이 특정된다. 즉, 하나로 통합해 간주할 수 있는 장해물점(82)이 클러스터링된다(도 6a). 에지 검출존(80)에 포함되면 특정된 장해물점(82)의 옆의 장해물점(83)이 에지 검출존(80)에 포함되지 않은 경우 스텝 S1054에서는 이동 목표 방향(72)과 평행하게 연장된 특이점 검출존(84)이 설정된다(도 6b).
계속되는 스텝 S1055에서는 에지 검출존(80)과 특이점 검출존(84)이 겹치는 영역(85)(도 6b에 있어서 크로스 해칭된 영역)에 장해물점(65)이 존재하는지의 여부에 의거하여 장해물점(83)이 특이점인지의 여부를 판정한다. 그리고, 장해물점(83)이 특이점이라면 영역(85) 내에 존재하는 장해물점(65)도 포함하여 클러스터링한다. 그리고, 스텝 S1056에서는 클러스터링된 장해물점(65) 중 이동 목표 방향(72)과 대략 직교하는 방향으로 가장 멀리 떨어진 2개의 장해물점을 에지점(86)으로서 특정한다(도 6b). 이상의 처리에 의해, 2개의 에지점(86)이 특정된다. 그 후, 도 14의 스텝 S106으로 처리가 이행된다.
스텝 S106에서는 간섭 장해물(66)을 회피하기 위한 회피 방향(90)이 선택된다(도 7a, 도 7b). 그리고, 스텝 S107에서는 간섭 장해물(66)을 회피할 경우에 통과하는 회피 통과점(91)과 경로(68) 사이의 최단 거리인 통과점 거리(D7)가 산출된다(도 7c).
스텝 S108에서는 회피 통과점(91)과 경로(68) 사이의 통과점 거리(D7)가 경로 여유(D3) 이하인지의 여부가 판정된다. 이것에 의해, 통로(95) 상에 있어서 간섭 장해물(66)을 회피할 수 있는지의 여부가 판정된다. 스텝 S108에 있어서, 통과점 거리(D7)가 경로 여유(D3) 이하인 경우 회피 행동이 가능이라고 판정되고, 스텝 S109로 처리가 진행된다. 스텝 S109에서는 회피 행동이 선택된다. 회피 행동이 선택되면 이동 제어부(25)에 의한 제어에 의해 자율 이동체(1)는 통로(95) 상에 있어서 간섭 장해물(66)을 회피하기 위해서 회피 방향(90)을 향해서 이동한다.
스텝 S108에 있어서, 통과점 거리(D7)가 경로 여유(D3)보다 클 경우 회피 행동이 불가능이라고 판정되고, 스텝 S110으로 처리가 진행된다. 스텝 S110에서는 간섭 장해물(66)에 대해서 이동 목표 방향(72)과 대략 직교하는 방향의 크기(D8)가 산출된다. 계속되는 스텝 S111에서는 간섭 장해물(66)의 크기(D8)와 기기 자체의 크기(D2)의 합계값이 공간 사이즈(D1)보다 작은지의 여부가 판정된다. 이것에 의해, 계획된 경로를 포함하는 통로(95) 상에서 간섭 장해물(66)과 자율 이동체가 마주 지나갈 수 있는지의 여부가 판정된다.
스텝 S111에 있어서 간섭 장해물(66)의 크기(D8)와 기기 자체의 크기(D2)의 합계값이 공간 사이즈(D1)보다 작을 경우 스텝 S112로 처리가 진행된다. 스텝 S112에서는 정지 행동이 선택된다. 스텝 S111에 있어서 간섭 장해물(66)의 크기(D8)와 기기 자체의 크기(D2)의 합계값이 공간 사이즈(D1) 이상일 경우 간섭 장해물(66)과 마주 지나갈 수 없다고 자율 이동체(1)에 의해 판단되고, 스텝 S113으로 처리가 진행된다. 스텝 S113에서는 퇴피 행동이 선택된다.
이어서, 도 16을 참조하여 정지 행동이 선택된 경우의 이동 제어 처리의 처리 순서에 대하여 설명한다. 도 16은 정지 행동시의 이동 제어 처리의 처리 순서를 나타내는 흐름도이다. 또한, 정지 위치(69)를 향하는 제어 중에 있어서도 도 14에 나타내는 행동 선택 처리는 소정의 주기로 행하여진다.
우선, 스텝 S121에서는 일시 정지하기 위해서 이동하는 대피 방향이 결정된다(도 10). 본 실시형태에서는 이동하는 대피 방향으로서 회피 방향(90)이 선택된다. 이어서. 스텝 S122에서는 정지 위치(69)가 통로(95)의 끝에 설정된다. 스텝 S123에서는 정지 위치(69)를 향하는 이동 제어가 개시된다. 정지 위치(69)로의 이동 제어 중 간섭 판정이 실행되고, 기기 자체가 근접해 오는 미지의 장해물에 간섭할 우려가 높다고 판정되면 정지 위치(69)에 도달하지 않았어도 정지하도록 제어된다.
스텝 S124에서는 정지 위치(69)에서 소정 시간 대기하도록 제어된다. 그 후에 스텝 S125에서는 장해물 정보에 의거하여 간섭 장해물(66)이 없어진 것이 확인되면 스텝 S126에서는 원래의 계획된 경로(68)에 의거하는 이동 제어로 복귀한다. 이상의 처리에 의해, 자율 이동체(1)가 통로(95)의 끝으로 피해서 정지하므로 자율 이동체(1)가 간섭 장해물(66)에게 길을 양보할 수 있다. 이 때문에, 간섭 장해물(66)이 사람이면 스트레스없이 전진할 수 있다. 그리고, 자율 이동체(1)는 간섭 장해물(66)이 없어지면 원래의 경로(68)에 따른 이동을 재개한다.
이어서, 도 17을 참조하여 퇴피 행동 중 대기 행동과 우회 행동 중 어느 하나의 행동을 선택하는 행동 선택 처리의 처리 순서를 설명한다. 도 17은 대기 행동과 우회 행동의 선택 처리의 처리 순서를 나타내는 흐름도이다.
스텝 S131에서는 장해물점(65)에 의거하는 간섭 장해물(66)의 위치와, 간섭 장해물(66)의 크기(D8)를 이용하여 통과할 수 없는 통로가 특정된다. 이어서, 스텝 S132에서는 대기 위치(71)를 설정 가능한 경로 여유(D3)를 갖는 퇴피로(70)가 특정된다. 그리고, 스텝 S133에서는 퇴피로(70) 상에 대기 위치(71)가 설정된다. 계속되는 스텝 S134에서는 자기 위치(64)로부터 대기 위치(71)까지의 경로 계획이 행하여지고, 대기 행동이 선택되었을 경우의 목적지까지의 도달 시간이 산출된다.
또한, 스텝 S135에서는 간섭 장해물(66)이 존재하는 경로를 우회하는 우회로(97)가 탐색된다. 이어서, 스텝 S136에서는 우회 행동이 선택되었을 경우의 목적지까지의 도달 시간이 산출된다. 계속해서, 스텝 S137에서는 대기 행동은 우회 행동보다 목적지까지의 도달 시간이 빠른지의 여부가 판단된다.
스텝 S137에 있어서, 대기 행동이 우회 행동보다 도달 시간이 빠른 경우에는 처리가 스텝 S138로 진행된다. 스텝 S138에서는 대기 행동이 선택된다. 스텝 S137에 있어서 대기 행동이 우회 행동보다 도달 시간이 늦을 경우, 및 대기 행동과 우회 행동의 도달 시간이 같을 경우에는 처리가 스텝 S139로 진행된다. 스텝 S139에서는 우회 행동이 선택된다.
계속해서 도 18을 참조하여 퇴피 행동이 선택되고나서 대기 행동 또는 우회 행동을 행할 때까지의 자율 이동체(1)의 움직임에 대하여 설명한다. 도 18은 퇴피 행동이 선택된 경우의 동작을 나타내는 타이밍 차트이다.
행동 선택부(24)는 소정의 주기로 행동을 선택한다. 이동 제어부(25)는 행동 선택부(24)에 의한 선택 결과, 및 타이밍에 의거하여 전동 모터(15)를 제어한다. 도 18에 나타내어지는 예와 같이, 통상 행동이 선택되어 있었던 상태로부터 퇴피 행동이 선택되면 이동 제어부(25)는 정지 행동을 개시하도록 전동 모터(15)를 제어한다. 정지 위치 설정부(29)에 의해 정지 위치(69)가 설정되고, 정지 위치(69)를 향해서 감속하면서 이동하고, 정지 위치(69)에서 정지하도록 전동 모터(15)가 제어된다.
연속해서 재차 퇴피 행동이 선택되면 행동 선택부(24)에 의해 퇴피 경로 계획부(30)에 대기 위치까지의 경로 계획 및 우회로(97)의 경로 계획이 요구된다. 그리고, 퇴피 경로 계획(30)에 의해 대기 위치까지의 경로 계획 및 우회로의 경로 계획이 행하여진다. 이 경로 계획이 행하여지고 있는 동안에 행동 선택부(24)에 의해 퇴피 행동이 계속해서 선택되고 있으면 자율 이동체(1)는 정지 위치(69)에서 정지한 상태가 되도록 제어된다. 예를 들면, 경로 계획이 행하여지고 있는 동안에 사람인 간섭 장해물(66)이 자율 이동체(1)를 피해서 통과했을 경우 등에 의해 다시 원래의 계획된 경로(68)에 따라서 자율 이동체(1)가 이동할 수 있는 상태가 되었을 경우 통상 행동이 선택된다. 이 경우에는 원래의 경로 계획으로 복귀한다.
대기 위치까지의 경로 계획 및 우회로(97)의 경로 계획이 퇴피 경로 계획부(30)에 의해 출력되면 각각의 목적지(67)까지의 도달 시간이 산출되고, 산출된 도달 시간에 의거하여 대기 행동 또는 우회 행동이 선택된다. 그리고, 선택된 퇴피 행동이 행하여진다. 또한, 상술한 도 17의 스텝 S135에 있어서 우회로(97)가 탐색된 결과 우회로가 존재하지 않는 경우에는 스텝 S137에 있어서 대기 행동이 선택된다. 또한, 도 17의 스텝 S132에 있어서 퇴피로(71)가 결정되지 않은 경우에는 퇴피로(71) 및 우회로(97)가 존재하지 않으므로 정지 행동이 선택된다. 그리고, 정지 후 예를 들면 자율 이동체(1)가 구비한 디스플레이에 에러 표시가 행하여지거나 또는 에러가 발생한 취지의 음성이 재생된다.
우회 행동이 선택된 경우에는 계획된 우회로(97)를 통과하여 목적지(67)까지 이동하도록 전동 모터(15)가 제어된다. 대기 행동이 선택된 경우에는 대기 위치(71)를 향해서 감속하면서 이동하고, 대기 위치(71)에서 정지하도록 전동 모터(15)가 제어된다. 그리고, 대기 위치(71)에서 정지한 상태에서 소정 시간이 경과한 후 원래의 통로(95)로 돌아가고, 원래의 계획된 경로에 따라서 이동하도록 전동 모터(15)가 제어된다.
본 실시형태에서는 퇴피 행동이 1번 선택된 것만으로는 퇴피 행동으로 이행하지 않고, 복수회 연속해서 퇴피 행동이 선택되었을 경우에 퇴피 행동으로 이행하도록 제어가 행하여진다. 이 때문에, 센서 노이즈 등에 의해 잘못하여 퇴피 행동이 선택되었을 경우에 전진할 수 있음에도 불구하고 퇴피 행동이 실행되는 것을 방지할 수 있다.
또한, 퇴피 행동이 선택되었을 경우에 있어서도 정지 행동을 행함으로써 일단 길을 양보하는 행동을 행할 수 있다. 그리고, 정지하고 있는 동안에도 행동을 선택하는 처리를 행하므로 길을 양보하는 행동 동안에 간섭 장해물(66)의 움직임을 판정하고, 상황에 따라 원래의 통로(95)로 돌아갈지, 퇴피 행동을 행할지 선택할 수 있다. 이것에 의해, 자율 이동체(1)와 대향하는 사람의 스트레스를 경감할 수 있고, 자율 이동체(1)는 최소한의 시간으로 목적지에 도달할 수 있다.
이상 설명한 본 실시형태에 의한 자율 이동체(1)는 간섭 장해물(66)이 존재하는 영역의 양 단부의 위치를 나타내는 에지점(86)을 특정하고, 특정한 에지점(86)과 기기 자체의 크기(D2)에 의거하여 대피 방향을 설정해서 이동한다. 이것에 의해, 자율 이동체(1)는 간섭 장해물(66)과 간섭하지 않고 대피할 수 있는 방향을 스스로 설정하고, 설정한 방향으로 이동할 수 있다. 자율 이동체(1)가 이 대피 방향으로 이동하면 간섭 장해물(66)에게 길을 양보하게 되고, 간섭 장해물(66)은 안전하게 전진할 수 있다. 즉, 자율 이동체(1)는 정류 영역을 미리 정하지 않고, 이동 가능한 장해물이 안전하게 통과할 수 있도록 스스로 대피 방향을 설정해서 이동할 수 있게 된다.
이 자율 이동체(1)는 대피 방향과 환경 지도에 의거하여 정지 위치(69)를 설정하고, 정지 위치(69)까지 이동하여 정지한다. 이것에 의해, 자율 이동체(1)는 환경에 적절한 위치, 즉 주위의 장해물과 간섭하지 않는 위치에 정지 위치(69)를 스스로 설정할 수 있다. 따라서, 자율 이동체(1)는 간섭 장해물(66)에게 길을 양보하고, 이 간섭 장해물(66)이 지나가는 것을 상황에 따른 위치에서 기다릴 수 있게 된다.
또한, 자율 이동체(1)는 정지 위치(69)에 근접함에 따라서 이동 속도가 느려지도록 이동 제어를 행하므로 안전하게 정지할 수 있다. 또한, 주위로부터 볼 때 자율 이동체(1)가 정지하는 것을 알기 쉬우므로 사람 등의 간섭 장해물(66)이 안심하고 옆을 통과할 수 있다.
또한, 자율 이동체(1)는 정지 위치(69)를 향해서 이동할 때에 간섭 판정을 행함으로써 장해물과의 사이의 거리가 정지 거리에 여유값을 가산한 거리보다 작을 경우에 정지한다. 따라서, 대피 방향으로 이동 중에 있어서 속도가 느려지면 가상 포텐셜법에 의한 장해물을 회피하는 힘이 작아지지만 간섭 판정을 행함으로써 대피 방향에 장해물이 출현한 경우에 확실하게 정지할 수 있다.
또한, 자율 이동체(1)는 통로(95) 상에 있어서의 회피 행동이 가능한지의 여부를 판정하고, 회피 행동이 가능한 경우에 회피 행동을 행하고, 회피 행동이 불가능한 경우에 대피 방향을 향해서 이동한다. 따라서, 간섭 장해물(66)이 존재할 경우에 회피 행동이 가능하다면 회피 행동을 행하므로 효율적으로 목적지로 향할 수 있다.
이 자율 이동체(1)는 통과점 거리(D7)가 경로 여유(D3)보다 클 경우에 회피 행동이 가능이라고 판정하고, 통과점 거리(D7)가 경로 여유(D3) 이하일 경우에 회피 행동이 불가능이라고 판정한다. 이것에 의해, 자율 이동체(1)는 간섭 장해물(66)을 회피하기 위해서 통과점(91)까지 이동할 여유가 통로(95) 상에 있는 경우에 회피 행동이 가능이라고 판정하고, 그 여유가 통로(95)에 없는 경우에는 회피 행동이 불가능이라고 판정한다. 따라서, 자율 이동체는 회피 행동과 대피해서 길을 양보하는 행동을 상황에 따라서 적절하게 분별하여 사용할 수 있다.
상술한 가상 포텐셜법을 이용하여 이동 제어를 행할 경우 간섭 장해물(66)을 통로(95) 상에서 회피할 수 없는 상황에서는 간섭 장해물(66)의 존재에 의한 척력과 목적지(67)를 향하는 인력이 균형이 잡히는 경우가 있다. 이 경우, 자율 이동체는 상술한 회피 행동과 정지 행동의 선택 처리를 행하지 않고, 가상 포텐셜법을 이용하여 장해물 회피를 행하면 간섭 장해물(66)을 전방으로 하여 전후로 반복해서 이동한다. 이에 비하여, 본 실시형태에 의한 자율 이동체(1)는 회피 행동 또는 정지 행동을 상황에 따라 선택하므로 회피 행동을 할 수 없다고 판단한 경우에는 회피 행동을 행하지 않고, 정지 행동을 행한다. 따라서, 가상 포텐셜법을 사용한 이동 제어에 있어서 자율 이동체(1)가 간섭 장해물(66)을 전방으로 하여 전후로 반복해서 이동하는 행동을 방지할 수 있다.
또한, 자율 이동체(1)는 자율 이동체가 정지 위치(69)에 도달하고나서 소정 시간 대기하므로 간섭 장해물(66)이 통로(95) 상을 통과 가능한 상황을 만들어 내고, 통과하는 것을 기다릴 수 있다. 그리고, 자율 이동체(1)는 소정 시간 대기한 후 원래의 경로(68)에 따른 이동을 재개하므로 효율적으로 목적지에 도달할 수 있다.
이상, 본 발명의 실시형태에 대하여 설명했지만 본 발명은 상기 실시형태에 한정되는 것은 아니고 여러 가지 변형이 가능하다. 예를 들면, 상기 실시형태의 자율 이동체(1)는 원기둥 형상의 본체(11)와 본체(11) 하부에 옴니휠이 장착된 로봇으로 했지만 본체(11) 형상 및 이동 수단은 이것에 한정되지 않는다.
또한, 상기 실시형태에서는 정지 위치 설정부(29)가 통로(95) 상에 정지 위치(69)를 설정했지만 통로(95)와 교차하는 통로 상에 정지 위치를 설정해도 된다.
또한, 상기 실시형태에서는 정지 행동이 선택된 경우에는 정지 위치(69)(대피 방향)를 향해서 대피하는 것으로 했지만 자율 이동체(1)는 대피 방향을 향하고 있는 도중에 회피 행동이 가능한 상황이 되었을 경우에는 대피 방향으로의 이동을 중지하고, 회피 행동을 개시해도 좋다. 따라서, 대피 방향으로의 이동을 개시한 후라도 상황이 회피 행동이 가능한 상황으로 변화된 경우에는 이 상황의 변화에 대응하여 회피 행동을 개시할 수 있다.
1 : 자율 이동체 12 : 레이저 레인지 파인더
13 : 초음파 센서 14 : 스테레오 카메라
22 : 기억부 25 : 이동 제어부
27 : 폭 특정부 29 : 정지 위치 설정부
31 : 간섭 판정부 65 : 장해물점
66 : 간섭 장해물 68 : 경로
69 : 정지 위치 72 : 이동 목표 방향
79 : 최근방 간섭점 86 : 에지점
95 : 통로 233 : 장해물 특정부
237 : 방향 설정부 234 : 에지 거리 산출부
242 : 회피 행동 선택부 D2 : 기기 자체의 크기
D3 : 경로 여유 D6 : 간섭 거리
D7 : 통과점 거리
13 : 초음파 센서 14 : 스테레오 카메라
22 : 기억부 25 : 이동 제어부
27 : 폭 특정부 29 : 정지 위치 설정부
31 : 간섭 판정부 65 : 장해물점
66 : 간섭 장해물 68 : 경로
69 : 정지 위치 72 : 이동 목표 방향
79 : 최근방 간섭점 86 : 에지점
95 : 통로 233 : 장해물 특정부
237 : 방향 설정부 234 : 에지 거리 산출부
242 : 회피 행동 선택부 D2 : 기기 자체의 크기
D3 : 경로 여유 D6 : 간섭 거리
D7 : 통과점 거리
Claims (20)
- 계획된 경로에 따라서 자율적으로 이동하는 자율 이동체로서,
기기 자체의 크기를 기억하는 기억 수단과,
기기 자체 주위의 장해물 정보를 취득하는 장해물 정보 취득 수단과,
상기 장해물 정보 취득 수단에 의해 취득된 장해물 정보에 의거하여 이동 목표 방향에 위치하는 장해물이 존재하는 영역의 양 단부로서 통로면과 평행한 면에 있어서 상기 이동 목표 방향과 직교하는 방향의 양 단부의 위치를 특정하는 장해물 특정 수단과,
상기 기억 수단에 의해 기억된 기기 자체의 크기, 및 상기 장해물 특정 수단에 의해 특정된 상기 양 단부의 위치에 의거하여 대피 방향을 설정하는 방향 설정 수단과,
상기 방향 설정 수단에 의해 설정된 대피 방향으로 이동하도록 제어하는 이동 제어 수단과,
상기 대피 방향으로의 이동 중에 상기 장해물 정보에 의거하여 상기 대피 방향에 위치하는 장해물과 기기 자체 사이의 간섭 거리를 산출하는 간섭 거리 산출 수단과,
기기 자체가 정지에 필요로 하는 정지 거리를 추정하는 추정 수단과,
상기 산출 수단에 의해 산출된 간섭 거리, 및 상기 추정 수단에 의해 추정된 정지 거리에 의거하여 정지할지의 여부를 판정하는 판정 수단을 구비하고,
상기 이동 제어 수단은 상기 판정 수단에 의해 정지한다고 판정되었을 경우에 기기 자체를 정지시키고, 상기 판정 수단에 의해 정지하지 않는다고 판정되었을 경우에 상기 대피 방향으로 이동하는 제어를 속행하는 것을 특징으로 하는 자율 이동체. - 제 1 항에 있어서,
상기 방향 설정 수단에 의해 설정된 대피 방향, 및 환경 지도에 의거하여 상기 대피 방향 상에 정지 위치를 설정하는 정지 위치 설정 수단을 구비하고,
상기 이동 제어 수단은 상기 정지 위치 설정 수단에 의해 설정된 정지 위치로 이동하여 정지하도록 제어하는 것을 특징으로 하는 자율 이동체. - 제 2 항에 있어서,
상기 이동 제어 수단은 기기 자체와 상기 정지 위치 사이의 거리가 짧아질수록 이동 속도가 느려지도록 제어하는 것을 특징으로 하는 자율 이동체. - 삭제
- 제 1 항에 있어서,
상기 판정 수단은 상기 간섭 거리가 상기 정지 거리에 여유값을 가산한 거리보다 짧은 경우에 정지한다고 판정하고, 상기 간섭 거리가 상기 정지 거리에 상기 여유값을 가산한 거리 이상인 경우에 정지하지 않는다고 판정하는 것을 특징으로 하는 자율 이동체. - 제 1 항에 있어서,
상기 계획된 경로가 설정되고, 기기 자체가 이동 가능한 영역인 통로 상에 있어서 상기 이동 목표 방향에 위치하는 장해물을 상기 장해물 정보에 의거하여 회피하면서 전진하는 회피 행동이 가능한지의 여부를 판정하는 회피 판정 수단을 구비하고,
상기 이동 제어 수단은 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우에 상기 회피 행동을 행하도록 제어하고, 상기 회피 판정 수단에 의해 상기 회피 행동이 불가능이라고 판정되었을 경우에 상기 대피 방향으로 이동하도록 제어하는 것을 특징으로 하는 자율 이동체. - 제 6 항에 있어서,
상기 이동 목표 방향에 존재하는 장해물과의 간섭을 회피하기 위해서 설정된 상기 통로 상의 통과점과 상기 계획된 경로 사이의 거리를 산출하는 통과점 거리 산출 수단과,
상기 통로에 있어서 상기 계획된 경로로부터 상기 통과점측의 방향 및 경로 방향과 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타내는 경로 여유를 특정하는 여유 특정 수단을 구비하고,
상기 회피 판정 수단은 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유보다 클 경우에 상기 회피 행동이 가능이라고 판정하고, 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유 이하인 경우에 상기 회피 행동이 불가능이라고 판정하는 것을 특징으로 하는 자율 이동체. - 제 6 항에 있어서,
상기 이동 제어 수단은 상기 대피 방향으로의 이동 중에 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우 상기 대피 방향으로의 이동을 중지하고 상기 회피 행동을 행하는 것을 특징으로 하는 자율 이동체. - 제 2 항에 있어서,
상기 이동 제어 수단은 상기 정지 위치에 도달하고나서 소정 시간 대기한 후 다시 상기 계획된 경로에 따라서 이동하도록 제어하는 것을 특징으로 하는 자율 이동체. - 삭제
- 제 3 항에 있어서,
상기 판정 수단은 상기 간섭 거리가 상기 정지 거리에 여유값을 가산한 거리보다 짧은 경우에 정지한다고 판정하고, 상기 간섭 거리가 상기 정지 거리에 상기 여유값을 가산한 거리 이상인 경우에 정지하지 않는다고 판정하는 것을 특징으로 하는 자율 이동체. - 제 11 항에 있어서,
상기 계획된 경로가 설정되고, 기기 자체가 이동 가능한 영역인 통로 상에 있어서 상기 이동 목표 방향에 위치하는 장해물을 상기 장해물 정보에 의거하여 회피하면서 전진하는 회피 행동이 가능한지의 여부를 판정하는 회피 판정 수단을 구비하고,
상기 이동 제어 수단은 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우에 상기 회피 행동을 행하도록 제어하고, 상기 회피 판정 수단에 의해 상기 회피 행동이 불가능이라고 판정되었을 경우에 상기 대피 방향으로 이동하도록 제어하는 것을 특징으로 하는 자율 이동체. - 제 12 항에 있어서,
상기 이동 목표 방향에 존재하는 장해물과의 간섭을 회피하기 위해서 설정된 상기 통로 상의 통과점과 상기 계획된 경로 사이의 거리를 산출하는 통과점 거리 산출 수단과,
상기 통로에 있어서 상기 계획된 경로로부터 상기 통과점측의 방향 및 경로 방향과 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타내는 경로 여유를 특정하는 여유 특정 수단을 구비하고,
상기 회피 판정 수단은 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유보다 클 경우에 상기 회피 행동이 가능이라고 판정하고, 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유 이하인 경우에 상기 회피 행동이 불가능이라고 판정하는 것을 특징으로 하는 자율 이동체. - 제 13 항에 있어서,
상기 이동 제어 수단은 상기 대피 방향으로의 이동 중에 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우 상기 대피 방향으로의 이동을 중지하고 상기 회피 행동을 행하는 것을 특징으로 하는 자율 이동체. - 제 3 항에 있어서,
상기 이동 제어 수단은 상기 정지 위치에 도달하고나서 소정 시간 대기한 후 다시 상기 계획된 경로에 따라서 이동하도록 제어하는 것을 특징으로 하는 자율 이동체. - 삭제
- 제 2 항에 있어서,
상기 판정 수단은 상기 간섭 거리가 상기 정지 거리에 여유값을 가산한 거리보다 짧은 경우에 정지한다고 판정하고, 상기 간섭 거리가 상기 정지 거리에 상기 여유값을 가산한 거리 이상인 경우에 정지하지 않는다고 판정하는 것을 특징으로 하는 자율 이동체. - 제 17 항에 있어서,
상기 계획된 경로가 설정되고, 기기 자체가 이동 가능한 영역인 통로 상에 있어서 상기 이동 목표 방향에 위치하는 장해물을 상기 장해물 정보에 의거하여 회피하면서 전진하는 회피 행동이 가능한지의 여부를 판정하는 회피 판정 수단을 구비하고,
상기 이동 제어 수단은 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우에 상기 회피 행동을 행하도록 제어하고, 상기 회피 판정 수단에 의해 상기 회피 행동이 불가능이라고 판정되었을 경우에 상기 대피 방향으로 이동하도록 제어하는 것을 특징으로 하는 자율 이동체. - 제 18 항에 있어서,
상기 이동 목표 방향에 존재하는 장해물과의 간섭을 회피하기 위해서 설정된 상기 통로 상의 통과점과 상기 계획된 경로 사이의 거리를 산출하는 통과점 거리 산출 수단과,
상기 통로에 있어서 상기 계획된 경로로부터 상기 통과점측의 방향 및 경로 방향과 직교하는 방향으로 기기 자체가 이동 가능한 거리를 나타내는 경로 여유를 특정하는 여유 특정 수단을 구비하고,
상기 회피 판정 수단은 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유보다 클 경우에 상기 회피 행동이 가능이라고 판정하고, 상기 통과점 거리 산출 수단에 의해 산출된 거리가 상기 여유 특정 수단으로 특정된 경로 여유 이하인 경우에 상기 회피 행동이 불가능이라고 판정하는 것을 특징으로 하는 자율 이동체. - 제 19 항에 있어서,
상기 이동 제어 수단은 상기 대피 방향으로의 이동 중에 상기 회피 판정 수단에 의해 상기 회피 행동이 가능이라고 판정되었을 경우 상기 대피 방향으로의 이동을 중지하고 상기 회피 행동을 행하는 것을 특징으로 하는 자율 이동체.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010159103A JP5560979B2 (ja) | 2010-07-13 | 2010-07-13 | 自律移動体 |
JPJP-P-2010-159103 | 2010-07-13 | ||
PCT/JP2011/003103 WO2012008085A1 (ja) | 2010-07-13 | 2011-06-02 | 自律移動体 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20130037684A KR20130037684A (ko) | 2013-04-16 |
KR101494224B1 true KR101494224B1 (ko) | 2015-02-17 |
Family
ID=45469105
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020127032283A KR101494224B1 (ko) | 2010-07-13 | 2011-06-02 | 자율 이동체 |
Country Status (6)
Country | Link |
---|---|
US (1) | US8924068B2 (ko) |
EP (1) | EP2595025B1 (ko) |
JP (1) | JP5560979B2 (ko) |
KR (1) | KR101494224B1 (ko) |
DK (1) | DK2595025T3 (ko) |
WO (1) | WO2012008085A1 (ko) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20230084778A (ko) | 2021-12-06 | 2023-06-13 | (주)씨에이시스템 | 전후 동기화 구동휠을 가지는 무인반송대차 |
Families Citing this family (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2993376B1 (fr) * | 2012-07-12 | 2014-07-25 | Renault Sa | Procede de controle de trajectoire d'un vehicule autonome a roues directrices |
JP2014191689A (ja) | 2013-03-28 | 2014-10-06 | Hitachi Industrial Equipment Systems Co Ltd | 移動体の走行制御手段に対して制御指令を出力する位置検出装置を取り付けた移動体及びその位置検出装置 |
JP6020326B2 (ja) * | 2013-04-16 | 2016-11-02 | 富士ゼロックス株式会社 | 経路探索装置、自走式作業装置、プログラム及び記録媒体 |
JP6136543B2 (ja) * | 2013-05-01 | 2017-05-31 | 村田機械株式会社 | 自律移動体 |
JP6104715B2 (ja) * | 2013-05-30 | 2017-03-29 | 株式会社Ihiエアロスペース | 経路生成方法と装置 |
JP5939266B2 (ja) * | 2014-02-21 | 2016-06-22 | トヨタ自動車株式会社 | 移動体制御システム及び移動体制御方法、プログラム |
JP6340824B2 (ja) * | 2014-02-25 | 2018-06-13 | 村田機械株式会社 | 自律走行台車 |
JP2016081403A (ja) * | 2014-10-21 | 2016-05-16 | 株式会社Ihiエアロスペース | 無人移動体とその経路生成方法 |
KR102404258B1 (ko) * | 2015-02-06 | 2022-06-02 | 삼성전자주식회사 | 로봇충전복귀장치 및 그 복귀방법 |
US20170341235A1 (en) * | 2016-05-27 | 2017-11-30 | General Electric Company | Control System And Method For Robotic Motion Planning And Control |
US10527730B2 (en) * | 2015-10-22 | 2020-01-07 | Toyota Motor Engineering & Manufacturing North America, Inc. | Object detection system |
JP2017177328A (ja) * | 2016-03-28 | 2017-10-05 | 富士ゼロックス株式会社 | プリントシステム、サーバ機器、プリンタ選定プログラム、およびプリント指示振分プログラム |
US11796673B2 (en) | 2016-07-06 | 2023-10-24 | Lawrence Livermore National Security, Llc | Object sense and avoid system for autonomous vehicles |
WO2018039559A2 (en) * | 2016-08-26 | 2018-03-01 | Crown Equipment Corporation | Materials handling vehicle obstacle scanning tools |
JP6396392B2 (ja) | 2016-11-02 | 2018-09-26 | ファナック株式会社 | 複数の機器に対して設定を行う設定装置及び設定システム |
JP7019947B2 (ja) * | 2016-12-19 | 2022-02-16 | 富士フイルムビジネスイノベーション株式会社 | 移動装置 |
US20200117220A1 (en) * | 2017-04-12 | 2020-04-16 | Lawrence Livermore National Security, Llc | Swarm path planner system for vehicles |
US11573575B2 (en) | 2017-04-12 | 2023-02-07 | Lawrence Livermore National Security, Llc | Attract-repel path planner system for collision avoidance |
CN110235074A (zh) * | 2017-04-26 | 2019-09-13 | 深圳市元征科技股份有限公司 | 医疗车的自动行驶方法及装置 |
EP3622364B1 (en) * | 2017-05-09 | 2023-07-05 | Brain Corporation | System and method for motion control of a robot |
JP2017152051A (ja) * | 2017-06-07 | 2017-08-31 | 株式会社日立産機システム | 移動体の走行制御手段に対して制御指令を出力する位置検出装置を取り付けた移動体及びその位置検出装置 |
CN107091637B (zh) * | 2017-06-21 | 2020-04-28 | 安徽瑞弋自动化科技有限公司 | 一种基于磁导航的自动化调度*** |
JP6289791B1 (ja) * | 2017-07-12 | 2018-03-07 | 三菱電機株式会社 | 情報処理装置及び情報処理システム |
US10282995B2 (en) | 2017-09-05 | 2019-05-07 | Starship Technologies Oü | Mobile robot having collision avoidance system for crossing a road from a pedestrian pathway |
CN108852174B (zh) * | 2017-09-25 | 2022-02-25 | 北京石头创新科技有限公司 | 自主移动机器人及其寻桩方法、控制装置和智能清洁*** |
JP7087708B2 (ja) * | 2018-06-15 | 2022-06-21 | トヨタ自動車株式会社 | 自律移動体、および自律移動体の制御プログラム |
JP7176241B2 (ja) * | 2018-06-15 | 2022-11-22 | トヨタ自動車株式会社 | 自律移動体、および自律移動体の制御プログラム |
JP7178066B2 (ja) * | 2018-09-14 | 2022-11-25 | 学校法人早稲田大学 | ロボット、並びに、その行動計画装置及び行動計画用プログラム |
JP2020187551A (ja) * | 2019-05-14 | 2020-11-19 | 株式会社豊田自動織機 | 自律走行車 |
KR20210045022A (ko) * | 2019-10-16 | 2021-04-26 | 네이버 주식회사 | 인식된 사람과 연관된 개인 영역에 기반하여 로봇을 제어하는 방법 및 시스템 |
JP7338414B2 (ja) * | 2019-11-15 | 2023-09-05 | 株式会社豊田自動織機 | 自律移動体 |
JP7308138B2 (ja) * | 2019-12-24 | 2023-07-13 | アマノ株式会社 | 自律走行作業装置 |
US11966232B2 (en) * | 2020-10-03 | 2024-04-23 | Viabot Inc. | Systems for setting and programming zoning for use by autonomous modular robots |
CN112327847A (zh) * | 2020-11-04 | 2021-02-05 | 北京石头世纪科技股份有限公司 | 一种绕行物体的方法、装置、介质和电子设备 |
US11927972B2 (en) | 2020-11-24 | 2024-03-12 | Lawrence Livermore National Security, Llc | Collision avoidance based on traffic management data |
CN114610008A (zh) * | 2020-12-09 | 2022-06-10 | 富泰华工业(深圳)有限公司 | 自主移动设备以及自动闪避方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH081563B2 (ja) * | 1989-07-12 | 1996-01-10 | 日産自動車株式会社 | 自律走行車 |
JP2000330632A (ja) | 1999-05-20 | 2000-11-30 | Komatsu Ltd | 移動体の誘導装置 |
JP2006259877A (ja) * | 2005-03-15 | 2006-09-28 | Daifuku Co Ltd | 物品搬送設備 |
JP2010061442A (ja) * | 2008-09-04 | 2010-03-18 | Murata Machinery Ltd | 自律移動装置 |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2658056B2 (ja) | 1987-06-17 | 1997-09-30 | 日産自動車株式会社 | 自律走行車両制御装置 |
JPH02120909A (ja) * | 1988-10-31 | 1990-05-08 | Mazda Motor Corp | 物体認識装置 |
JPH02300803A (ja) * | 1989-05-16 | 1990-12-13 | Yamaha Motor Co Ltd | 無人移動体 |
US5648901A (en) * | 1990-02-05 | 1997-07-15 | Caterpillar Inc. | System and method for generating paths in an autonomous vehicle |
JP3296105B2 (ja) | 1994-08-26 | 2002-06-24 | ミノルタ株式会社 | 自律移動ロボット |
JPH08132994A (ja) * | 1994-11-04 | 1996-05-28 | Nippon Steel Corp | 移動装置の衝突緩衝方法および衝突緩衝装置 |
US6393362B1 (en) * | 2000-03-07 | 2002-05-21 | Modular Mining Systems, Inc. | Dynamic safety envelope for autonomous-vehicle collision avoidance system |
JP2002282306A (ja) * | 2001-03-27 | 2002-10-02 | Sekisui Chem Co Ltd | 自走式車椅子 |
JP3675386B2 (ja) | 2001-11-01 | 2005-07-27 | 松下電工株式会社 | 自律移動装置及び自律移動装置運用システム |
JP3758628B2 (ja) * | 2002-09-25 | 2006-03-22 | 松下電工株式会社 | 自律移動装置 |
JP4348276B2 (ja) | 2004-11-02 | 2009-10-21 | 本田技研工業株式会社 | ロボット制御装置 |
US9026301B2 (en) * | 2005-10-14 | 2015-05-05 | Aethon, Inc. | Robotic ordering and delivery system software and methods |
ES2718831T3 (es) * | 2005-12-02 | 2019-07-04 | Irobot Corp | Sistema de robots |
JP5112666B2 (ja) * | 2006-09-11 | 2013-01-09 | 株式会社日立製作所 | 移動装置 |
JP2009288930A (ja) | 2008-05-28 | 2009-12-10 | Murata Mach Ltd | 自律移動体及びその移動制御方法 |
KR101228485B1 (ko) | 2008-09-03 | 2013-01-31 | 무라다기카이가부시끼가이샤 | 경로 계획 방법, 경로 계획 장치, 및 자율 이동 장치 |
JP5063549B2 (ja) * | 2008-09-29 | 2012-10-31 | 本田技研工業株式会社 | 移動装置 |
JP5560978B2 (ja) * | 2010-07-13 | 2014-07-30 | 村田機械株式会社 | 自律移動体 |
-
2010
- 2010-07-13 JP JP2010159103A patent/JP5560979B2/ja active Active
-
2011
- 2011-06-02 KR KR1020127032283A patent/KR101494224B1/ko active IP Right Grant
- 2011-06-02 EP EP11806422.9A patent/EP2595025B1/en active Active
- 2011-06-02 WO PCT/JP2011/003103 patent/WO2012008085A1/ja active Application Filing
- 2011-06-02 US US13/809,719 patent/US8924068B2/en active Active
- 2011-06-02 DK DK11806422.9T patent/DK2595025T3/da active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH081563B2 (ja) * | 1989-07-12 | 1996-01-10 | 日産自動車株式会社 | 自律走行車 |
JP2000330632A (ja) | 1999-05-20 | 2000-11-30 | Komatsu Ltd | 移動体の誘導装置 |
JP2006259877A (ja) * | 2005-03-15 | 2006-09-28 | Daifuku Co Ltd | 物品搬送設備 |
JP2010061442A (ja) * | 2008-09-04 | 2010-03-18 | Murata Machinery Ltd | 自律移動装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20230084778A (ko) | 2021-12-06 | 2023-06-13 | (주)씨에이시스템 | 전후 동기화 구동휠을 가지는 무인반송대차 |
Also Published As
Publication number | Publication date |
---|---|
JP2012022468A (ja) | 2012-02-02 |
EP2595025A1 (en) | 2013-05-22 |
EP2595025A4 (en) | 2016-12-28 |
WO2012008085A1 (ja) | 2012-01-19 |
KR20130037684A (ko) | 2013-04-16 |
EP2595025B1 (en) | 2020-01-15 |
US20130116880A1 (en) | 2013-05-09 |
US8924068B2 (en) | 2014-12-30 |
DK2595025T3 (da) | 2020-04-06 |
JP5560979B2 (ja) | 2014-07-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101494224B1 (ko) | 자율 이동체 | |
KR101476239B1 (ko) | 자율 이동체 | |
CN112654470B (zh) | 机器人清洁器及其控制方法 | |
CN112367888B (zh) | 多个机器人清洁器及其控制方法 | |
US11693427B2 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
EP3787463B1 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
US11148290B2 (en) | Plurality of robot cleaner and a controlling method for the same | |
EP3787458B1 (en) | A plurality of robot cleaners | |
US11169539B2 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
CN112384119B (zh) | 多个自主移动机器人及其控制方法 | |
US11150668B2 (en) | Plurality of robot cleaner and a controlling method for the same | |
US11435759B2 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
KR20210058998A (ko) | 웨이포인트 매칭을 이용한 자율적 맵 주행 | |
CN112578787B (zh) | 对象搜索方法、设备及存储介质 | |
EP3787462B1 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
US20220334583A1 (en) | Route generation device | |
CN117685947A (zh) | 机器人的地图生成方法、机器人及清洁*** |
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: 20180202 Year of fee payment: 4 |
|
FPAY | Annual fee payment |
Payment date: 20190201 Year of fee payment: 5 |