KR100668788B1 - Position recognition apparatus for mobile robot - Google Patents
Position recognition apparatus for mobile robot Download PDFInfo
- Publication number
- KR100668788B1 KR100668788B1 KR1020060045662A KR20060045662A KR100668788B1 KR 100668788 B1 KR100668788 B1 KR 100668788B1 KR 1020060045662 A KR1020060045662 A KR 1020060045662A KR 20060045662 A KR20060045662 A KR 20060045662A KR 100668788 B1 KR100668788 B1 KR 100668788B1
- Authority
- KR
- South Korea
- Prior art keywords
- position recognition
- recognition device
- mobile robot
- encoder
- change amount
- Prior art date
Links
- 238000000034 method Methods 0.000 claims description 23
- 238000005070 sampling Methods 0.000 claims description 10
- 238000004891 communication Methods 0.000 claims description 8
- 230000033001 locomotion Effects 0.000 claims description 8
- 230000008878 coupling Effects 0.000 description 5
- 238000010168 coupling process Methods 0.000 description 5
- 238000005859 coupling reaction Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000007796 conventional method Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000000149 penetrating effect Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 238000006073 displacement reaction Methods 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
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
Description
도 1은 본 발명에 따른 이동로봇의 위치인식장치에 대한 개략적 구성을 나타낸 사시도.1 is a perspective view showing a schematic configuration of a position recognition device of a mobile robot according to the present invention.
도 2는 본 발명에 따른 위치인식장치의 세부구성을 나타내는 분해사시도.Figure 2 is an exploded perspective view showing a detailed configuration of the position recognition device according to the present invention.
도 3은 본 발명의 작동구조를 개략적으로 나타낸 블록도.Figure 3 is a block diagram schematically showing the operating structure of the present invention.
도 4는 본 발명에 따른 위치인식장치의 양 바퀴 바깥쪽에 이동로봇의 순간회전중심(ICR)이 있는 경우의 회전 반경을 구하는 방법을 설명하기 위한 개념도.4 is a conceptual view for explaining a method for obtaining a radius of rotation when the instantaneous center of rotation (ICR) of the mobile robot on the outside of both wheels of the position recognition device according to the present invention.
도 5는 본 발명에 따른 위치인식장치의 양 바퀴 안쪽에 이동로봇의 순간회전중심(ICR)이 있을 경우의 회전 반경을 구하는 방법을 설명하기 위한 개념도.5 is a conceptual view for explaining a method for obtaining a radius of rotation when there is an instantaneous center of rotation (ICR) of the mobile robot inside both wheels of the position recognition device according to the present invention.
도 6은 본 발명에 따른 위치인식장치의 회전 반경과 이동 거리를 이용해 위치 변화량을 구하는 방법을 설명하기 위한 개념도.6 is a conceptual view for explaining a method for obtaining a position change amount using the rotation radius and the moving distance of the position recognition device according to the present invention.
<도면중 주요부분에 대한 부호의 설명><Description of the symbols for the main parts of the drawings>
100 : 위치인식장치 110 : 인코더1100: position recognition device 110: encoder 1
111 : 회전축 120 : 인코더2111: rotation axis 120: encoder 2
121 : 회전축 130 : 컨트롤러121: rotation axis 130: controller
131 : 카운터 132 : 계산기131: Counter 132: Calculator
133 : 통신수단 140 : 인코더 고정블록133: communication means 140: encoder fixed block
141 : 인코더 결합홈 143 : 수직 관통홀141: encoder coupling groove 143: vertical through hole
150 : 바퀴 160 : 탄성부재150: wheel 160: elastic member
170 : 지지대 180 : 상판170: support 180: top plate
190 : 하판 200 : 이동로봇190: bottom plate 200: mobile robot
210 : 로봇 제어기210: robot controller
본 발명은 이동로봇의 자율 이동에 있어서, 절대좌표계 상에서의 이동로봇의 위치정보를 인식하기 위한 이동로봇의 위치인식장치에 관한 것이다.The present invention relates to a position recognition device of a mobile robot for recognizing the position information of the mobile robot on the absolute coordinate system in the autonomous movement of the mobile robot.
현재까지 사용되고 있는 로봇 위치인식방법에는 랜드 마크를 사용하는 방법과 로봇 내부 또는 외부의 카메라를 이용하는 방법, 및 로봇 바퀴에 인코더를 부착하여 로봇이 움직일 때 발생하는 펄스를 계수하여 로봇의 위치를 계산하는 방법 등이 사용되고 있다.The robot position recognition method currently used includes a method using a landmark, a camera using an internal or external camera, and an encoder attached to the robot wheel to count the pulse generated when the robot moves to calculate the robot's position. Methods and the like are used.
이때, 상기 랜드 마크를 사용하는 방법 및 카메라를 이용하는 방법은 비교적 정확한 위치를 인식할 수 있으나 설치가 어렵고, 설치에 많은 비용이 소요되는 문 제가 있었다.At this time, the method of using the landmark and the method of using the camera can recognize a relatively accurate position, but it is difficult to install, there is a problem that requires a large cost for installation.
또한, 상기 로봇 바퀴에 부착된 인코더를 이용하는 방법은 설치비용이 저가인데 반해, 로봇의 바퀴가 공회전할 경우 오차가 커지는 단점과 로봇 제어기에서 복잡한 계산을 다루어야하는 문제가 있었다.In addition, the method of using the encoder attached to the robot wheel has a low installation cost, while there is a disadvantage that the error is increased when the wheel of the robot idles, and there is a problem to deal with complex calculations in the robot controller.
이와 같은 단점을 극복하기 위한 방법으로 두 개의 인코더를 직교하도록 배치한 형태의 위치인식장치인 이동로봇용 절대 위치인식장치(등록번호 실용신안 제 0392635호)가 제안된 바 있다.As a method for overcoming the above disadvantages, an absolute position recognition device (registration number utility model No. 0392635) for a mobile robot, which is a position recognition device in which two encoders are arranged orthogonally, has been proposed.
그러나 상기한 바와 같은 종래기술은 위치인식장치의 회전 각도를 보상하기 위해 고가의 센서와 빠른 응답성을 갖는 서보 시스템을 장착해야 하기 때문에 경제적이지 못한 문제점이 있었다.However, the prior art as described above has a problem that it is not economical to mount a servo system having an expensive sensor and a quick response to compensate for the rotation angle of the position recognition device.
상기와 같은 종래기술의 문제점을 해결하기 위한 본 발명의 목적은 모터의 공회전 현상에 따른 오차 문제를 해결하기 위해 이동로봇의 바퀴에 직접 인코더를 설치하여 위치를 계산하던 종전 방식과 달리 한 쌍의 인코더가 좌우 평행하게 배치되고, 상기 인코더에 축 결합된 바퀴가 회전 할 때에 얻게 되는 펄스 수를 계수하여 절대좌표계 상에서의 이동로봇의 위치가 계산되도록 하는 이동로봇의 위치인식장치를 제공함에 있다.An object of the present invention for solving the problems of the prior art as described above is a pair of encoders, unlike the conventional method that calculates the position by installing the encoder directly on the wheel of the mobile robot to solve the error problem caused by the idle phenomenon of the motor Is arranged in parallel to the left and right, and to provide a position recognition device for a mobile robot to count the number of pulses obtained when the wheel coupled to the encoder is rotated to calculate the position of the mobile robot on the world coordinate system.
본 발명의 다른 목적은 별도의 서보시스템과 고가의 센서를 갖추지 않고도 회전각도의 신속한 보상이 가능하도록 하기 위해 별개로 구동하는 한 쌍의 인코더 를 이용하는 구조에 있어서, 한 쌍의 인코더를 수직 배치하지 않고 평행 배치하도록 하는 이동로봇의 위치인식장치를 제공함에 있다.Another object of the present invention is a structure using a pair of encoders that are driven separately to enable fast compensation of the rotation angle without having a separate servo system and expensive sensors, without a pair of encoders arranged vertically It is to provide a position recognition device of the mobile robot to be arranged in parallel.
본 발명의 또 다른 목적은 종래의 이동로봇의 제어기에서 수행하던 위치 인식에 필요한 복잡한 계산을 별도 마련된 위치인식장치의 컨트롤러에서 수행하도록 하는 이동로봇의 위치인식장치를 제공함에 있다.Still another object of the present invention is to provide a position recognition device of a mobile robot, which performs a complicated calculation required for position recognition performed in a controller of a conventional mobile robot in a controller of a separately provided position recognition device.
상기한 바와 같은 목적을 달성하기 위한 본 발명에 따른 이동로봇의 위치인식장치는 이동로봇에 설치되어 상기 이동로봇의 위치를 인식하는 위치인식장치로서, Position recognition device for a mobile robot according to the present invention for achieving the above object is installed in the mobile robot as a position recognition device for recognizing the position of the mobile robot,
상기 위치인식장치는, 복수 개의 지지대가 소정간격으로 설치되는 상, 하판; 상기 상, 하판 사이의 지지대 상에 관통 결합되는 한 쌍의 인코더 고정블록; 상기 인코더 고정블록의 좌우 내측에 대향 삽입되어 평행하게 배치되는 인코더1, 2; 상기 인코더1, 2로부터 축 연장되어 인코더 고정블록을 관통하는 각각의 회전축과 결합되는 한 쌍의 바퀴; 및 상기 바퀴들이 지면에 접촉하여 회전함에 따라 인코더1, 2에서 발생되는 펄스를 계수하고, 계수된 펄스 수를 이용해 로봇의 현재 위치를 계산하며, 상기 계산된 위치정보를 이동로봇의 제어기와 송수신되도록 하는 컨트롤러를 포함하여 구성됨을 특징으로 한다.The position recognition device, the upper and lower plates are provided with a plurality of support at a predetermined interval; A pair of encoder fixing blocks penetrated through the support between the upper and lower plates; Encoders 1 and 2 which are arranged in parallel to the left and right sides of the encoder fixing block and are arranged in parallel; A pair of wheels axially extending from the encoders 1 and 2 and coupled to the respective rotating shafts passing through the encoder fixing block; And counting pulses generated by the encoders 1 and 2 as the wheels rotate in contact with the ground, calculate the current position of the robot using the counted pulse number, and transmit and receive the calculated position information to and from the controller of the mobile robot. Characterized in that configured to include a controller.
이하, 본 발명의 바람직한 실시 예에 따른 구성 및 작용에 대해 설명하면 다 음과 같다.Hereinafter, the configuration and operation of the preferred embodiment of the present invention will be described.
도 1은 본 발명에 따른 이동로봇의 위치인식장치에 대한 개략적 구성을 나타낸 사시도로서, 동 도면에서 보는 바와 같은 이동로봇(200)의 하부에 본 발명의 위치인식장치(100)가 설치되어 이동로봇(200)의 위치정보를 인식하는 역할을 수행하게 된다.1 is a perspective view showing a schematic configuration of the position recognition device of the mobile robot according to the present invention, the
이때, 상기 이동로봇(200)은 하부의 구조만이 간략하게 도시되고 있고, 이러한 이동로봇(200)의 정중앙에 위치인식장치(100)가 설치되도록 하고 있다.At this time, only the structure of the lower portion of the
이처럼, 위치인식장치(100)를 이동로봇(200)의 정중앙에 설치하게 되면 위치인식장치(100)와 이동로봇(200)의 중심이 일치하게 되어 위치인식장치(100)를 통해 계산된 현 위치를 이동로봇(200)의 위치로 동일하게 판단할 수 있게 된다.As such, when the
만약, 상기 위치인식장치(100)를 정중앙이 아닌 그 외의 곳에 설치하게 된다면, 이는 위치인식장치(100)로부터 계산된 현 위치 정보를 이동로봇(200)의 중심으로 재배치시키는 보정작업을 필요로 하게 된다.If the
이때, 상기 위치인식장치(100)는 최대한 지면과 가깝게 설치되도록 하고, 그 높이는 뒤에서 설명하게 될 바퀴(150)의 수직 자유도 범위를 넘지 않도록 하는 것이 바람직하다.At this time, the
다음, 도 2는 본 발명에 따른 위치인식장치의 세부구성을 나타내는 분해사시도로서, 동 도면에서 보는 바와 같은 본 발명의 위치인식장치(100)의 구성은 크게 인코더1(110), 인코더2(120), 컨트롤러(130), 인코더 고정블록(140), 바퀴(150), 탄성부재(160), 지지대(170), 상판(180), 및 하판(190)로 나눌 수 있고, 각 구성요소에 대한 자세한 설명은 다음과 같다.Next, Figure 2 is an exploded perspective view showing a detailed configuration of the position recognition device according to the present invention, the configuration of the
우선, 상기 인코더1, 2(110, 120)는 일종의 신호 변환기로 사용되는 것으로서, 바퀴(150)의 회전을 전기적 펄스신호로 변환하여 이를 컨트롤러(130)에 전송하게 된다.First, the encoder 1, 2 (110, 120) is used as a kind of signal converter, converts the rotation of the
이러한, 인코더1, 2(110, 120)는 각각 일측으로 회전축(111, 121)이 축 연장되고, 상기 각 회전축(111, 121)은 돌출된 상태로 한 쌍의 인코더 고정블록(140) 내측으로부터 관통 결합되어진다.The encoders 1 and 2 (110 and 120) are respectively extended to one side of the
상기 인코더 고정블록(140)의 전체적인 외형은 육면체 형상으로 제작될 수 있고, 상기 육면체의 내 측벽에는 인코더1(110) 또는 인코더2(120)가 수평방향으로 안내 결합되기 위한 인코더 결합홈(141)이 형성되며, 상기 육면체의 상면에는 지지대(170)가 수직 관통되기 위한 수직 관통홀(143)이 형성된다.The overall external shape of the
이때, 상기 인코더 결합홈(141)은 내측벽에는 큰 직경의 홀을 형성하게 되는 반면, 반대측 외벽에는 회전축(111, 121) 만을 돌출시키기 위한 작은 직경의 홀이 형성된다.In this case, the
여기서, 상기 외벽에 돌출되는 회전축(111, 121)에는 지면과 접지되어 구름운동되는 바퀴(150)가 한 개씩 결합된다. 상기와 같이 결합된 바퀴(150)들은 지면에 접촉되어 위치인식장치(100)를 부착한 이동로봇(200)이 움직일 때 회전운동이 이루어지게 되고, 회전축(111, 121)을 회전시키게 된다. 이때, 인코더1, 2(110, 120)에서는 바퀴(150)의 회전 수 즉, 이동거리에 비례하는 전기적 펄스신호를 발생 시키게 된다.Here, the
그리고, 상기 인코더 고정블록(140)에 형성된 수직 관통홀(143)에는 도 2에서 보는 바와 같은 지지대(170)가 관통 결합하게 된다.In addition, the
상기와 같은 지지대(170)는 복수 개가 상판(180) 및 하판(190) 사이에 수직하게 결합됨으로써, 수직방향의 하중을 지탱하게 되는 동시에 상판(180)과 하판(190) 사이에 설치되는 구조물들의 설치형태가 안전하게 보호되도록 하는 역할을 수행하게 된다.The
이때, 상기 수직 관통홀(143)을 관통하는 지지대(170)에는 코일형상으로 제작된 탄성부재(160)가 축 결합되어 상판(180)과의 사이에 탄성력을 제공하게 된다.At this time, the
여기서, 상기와 같이 탄성부재(160)를 축 결합시키는 이유에 대해 설명하면, 이동로봇(200)이 불균일한 노면상태를 갖는 굴곡 및 장애물 지역을 통과 할 때, 좌우측 바퀴(150)의 접지 높이가 변화하게 되는데, 이때, 상기 좌우측 바퀴(150)가 결합된 고정블록(140)이 지지대(170) 상에서 상하 축 방향으로의 슬라이드 운동이 이루어지게 되고, 상기 고정블록(140)과 상, 하판(180, 190) 사이에 설치된 탄성부재(160)의 탄성력이 작용됨에 따라 좌우측 바퀴(150)의 변위가 자동으로 복원되도록 하기 위함이다.Here, the reason for axially coupling the
이와 같은 본 발명은 한 쌍의 인코더 고정블록(140)이 상호 독립된 구조로 설치되어 바퀴(150)가 각기 자유 높낮이 조절됨에 따라 불균일한 노면상태에서도 양측 바퀴의 구동 펄스를 동일하게 측정할 수 있게 된다.In the present invention as described above, a pair of
마지막으로 상판(180)에는 컨트롤러(130)가 설치되어 상기 인코더1, 2(110, 120)로부터 전기적 펄스신호를 입력받게 된다.Finally, the
상기와 같은 컨트롤러(130)는 인코더1, 2(110, 120)에서 발생되는 펄스신호를 입력받아 이때의 펄스 수를 계수하는 카운터(131)와, 상기 카운터(131)에서 카운터된 펄스 수를 입력 값으로 하여 현재 위치를 연산하는 계산기(132)와, 상기 계산기(132)에서의 위치정보를 이동로봇(200)의 제어기(210)로 전송하는 통신수단(133)으로 이루어진다.The
이하, 상기 구성으로 이루어지는 본 발명의 작용에 대해 설명하면 다음과 같다.Hereinafter, the operation of the present invention having the above configuration will be described.
우선, 본 발명에 따른 위치인식장치(100)가 조립된 상태를 가정한다.First, it is assumed that the
이때, 상기 위치인식장치(100)는 한 쌍의 인코더1, 2(110, 120)가 각각 평행하게 배치되어 인코더 고정블록(140)에 결합되도록 하고, 각 인코더1, 2(110, 120)의 회전축(111, 121)에는 바퀴(150)가 결합되어 지면에 접촉하여 구름운동이 이루어지도록 하는데, 축 설치된 탄성부재(160)의 탄성력을 제공받게 됨으로써, 상하 수직방향으로의 높낮이가 자동 조절되도록 한다.At this time, the
다음, 이동로봇(200)이 구동되어 이동하게 되면, 상기 이동로봇(200)의 움직임에 따라 인코더1(110)과 인코더2(120)에서 각각 펄스신호를 발생하게 되고, 상기 펄스신호는 컨트롤러(130)의 카운터(131)에서 카운터(counter)된 다음 이를 바탕으 로 하여 현 위치정보를 계산기(132)에서 계산하게 된다.Next, when the
이때, 상기 계산기(132)를 통해 계산된 위치정보는 컨트롤러(130)에 마련된 통신수단(133)을 통해 로봇 제어기(210)로 전송된다. 여기서 사용되는 통신수단(133)은 RS-232C 인터페이스(Interface)가 사용될 수 있고, 이밖에 유무선 통신을 포함한 다양한 송수신장치가 이용될 수 있다.In this case, the position information calculated by the
여기서, 위치인식장치(100)가 로봇의 위치를 계산하기 위해서는 임의의 지점을 원점으로 정할 필요가 있으며, 편의상 이 원점의 위치는 다음과 같은 좌표로 정의하도록 한다.In order to calculate the position of the robot, the
원점좌표 : Xn = 0 , Yn = 0 , θn = 90ㅀ(또는 0ㅀ)Origin coordinates: Xn = 0, Yn = 0, θn = 90 ㅀ (or 0 ㅀ)
이러한 원점좌표는 로봇 제어기(210)에서 지정하게 되며, 상기 원점좌표를 기준으로 이동된 위치인식장치(100) 즉, 이동로봇(200)의 현 위치를 파악하게 된다.The origin coordinates are designated by the
이때, 로봇 제어기(210)는 상기 원점좌표를 위치인식장치(100)의 컨트롤러(130)에 인식된 현 위치로 초기화하여 재설정할 수 있다.At this time, the
도 3은 본 발명의 작동구조를 개략적으로 나타낸 블록도로서, 동 도면에서 보는 바와 같은 인코더1, 2(110, 120)를 통해 이동로봇(200)의 움직임에 대응하는 펄스가 발생된다. 그리고, 컨트롤러(130)는 이 펄스들의 수를 내부의 카운터(131)로 계수하여, 이를 바탕으로 로봇의 위치를 계산하게 되는데, 이때의 위치 계산식 에 대해 첨부도면을 참조하여 자세히 살펴보면 다음과 같다.FIG. 3 is a block diagram schematically illustrating an operation structure of the present invention, in which pulses corresponding to the movement of the
먼저, 상기 인코더1, 2(110, 120)에서 발생하는 펄스를 계수하여 샘플링 시간동안의 위치인식장치(100)의 이동거리와 위치인식장치(100)의 좌우측 바퀴(150', 150")의 이동 속도를 계산한다.First, the pulses generated by the encoders 1 and 2 (110 and 120) are counted so that the moving distance of the
도 4는 본 발명에 따른 위치인식장치(100)의 양 바퀴(150', 150'') 바깥쪽에 이동로봇의 순간회전중심(ICR)이 있는 경우의 회전 반경을 구하는 방법을 설명하기 위한 개념도로서, 동 도면에서 보는 바와 같이 왼쪽 바퀴(150')의 속도를 VL이라 하고, 오른쪽 바퀴(150")의 속도를 VR이라 할 때 양 바퀴(150', 150'')의 속도 VL과 VR은 도 4와 같이 순간회전중심(ICR)에서 바퀴(150', 150'') 중심까지의 거리 R1, R2와 비례한다. 이를 식으로 나타내면 (식 1)과 같다.4 is a conceptual diagram for explaining a method of obtaining a turning radius when the instantaneous center of rotation (ICR) of the mobile robot is located outside both wheels 150 'and 150''of the
(식 1)................ (Equation 1) ......
또한, 순간회전중심(ICR)에서 상기 바퀴(150', 150'') 중심까지의 거리 R1과 R2는 순간회전중심(ICR)에서 위치인식장치 중심(CT)까지의 거리 R과 다음 (식 2)와 같은 관계를 갖는다.In addition, the distances R 1 and R 2 from the instantaneous rotation center (ICR) to the center of the wheels 150 'and 150''are the distances R from the instantaneous rotation center (ICR) to the center of the position recognition device CT and Equation 2) has the same relationship.
(식 2)................ (Equation 2) ......
상기 (식 1)에 (식 2)를 대입하면 다음 (식 3)과 같은 관계식을 갖게 된다.Substituting (Formula 2) into (Formula 1) has a relational expression as shown in the following (Formula 3).
(식 3)................ (Equation 3) ...
또한, 상기 (식 3)은 다음 (식 4)와 같이 정리될 수 있다.In addition, (Equation 3) can be summarized as follows (Equation 4).
(식 4)................ (Equation 4) ...
도 5와 같이 순간회전중심(ICR)이 위치 인식 장치 안쪽에 있을 경우에는 (식 2), (식 3), (식 4)는 다음 (식 5), (식 6), (식 7)과 같이 표현된다. When the instantaneous rotation center (ICR) is inside the position recognition device as shown in Fig. 5, (Equation 2), (Equation 3), (Equation 4) are the following (Equation 5), (Equation 6), It is expressed as
(식 5)................ (Equation 5) ...
(식 6)................ (Equation 6) ...
(식 7)................ (Equation 7) ...
다음, 상기 위치인식장치(100) 좌우측 바퀴(150', 150")의 이동 속도와 순간회전중심(ICR)에서부터 위치인식장치(100)의 좌우 양 바퀴(150', 150")까지의 거리가 비례하는 것을 이용해 샘플링 시간 동안의 회전 반경을 계산한다.Next, the moving speed and distance from the instantaneous rotation center (ICR) of the left and
도 5는 본 발명에 따른 위치인식장치(100)의 양 바퀴(150', 150") 안쪽에 이동로봇(200)의 순간회전중심(ICR)이 있을 경우의 회전 반경을 구하는 방법을 설명하기 위한 개념도를 나타낸다.5 is a view for explaining a method of obtaining a turning radius when there is an instantaneous rotation center (ICR) of the
다음, 상기 회전하는 물체의 각도 변화량이 그 물체의 이동 거리에 비례하고 회전 반경(R)에 반비례하는 원리를 이용해 위치인식장치(100)의 샘플링 시간동안의 각도 변화량을 계산한다.Next, the angle change amount during the sampling time of the
도 6은 본 발명에 따른 위치인식장치(100)의 회전 반경(R)과 이동 거리를 이용해 위치 변화량을 구하는 방법을 설명하기 위한 개념도로서, 동 도면에서와 같이 위치인식장치(100)가 샘플링 시간 동안 회전 반경 R로 D만큼 회전하였다면 위치인식장치(100)의 회전각도 변화량(Δθ)은 다음의 관계식으로 나타낼 수 있다.6 is a conceptual diagram illustrating a method of obtaining a position change amount using a rotation radius R and a movement distance of the
(식 8)................ (Equation 8) ...
그리고, 왼쪽 바퀴(150')가 이동한 거리를 DL이라 하고, 오른쪽 바퀴(150")가 이동한 거리를 DR이라하면 D는 다음의 관계식으로 나타낼 수 있다.If the distance that the left wheel 150 'is moved is referred to as D L , and the distance the
(식 9)................ (Equation 9) ...
또한, 상기 DL과 DR은 각각 다음의 관계식으로 정리될 수 있다.In addition, the D L and D R can be summarized in the following relation, respectively.
(식 10)................ (Equation 10) ...
여기서 상기 EL은 인코더1(110)의 펄스 개수이고, DP는 펄스 사이의 구름거리이며, ER은 인코더2(120)의 펄스 개수이고, r은 바퀴(150',150")의 반지름이며, Res는 인코더1, 2(110, 120)의 분해능이다.Where E L is the number of pulses of encoder 1 (110), D P is the rolling distance between pulses, E R is the number of pulses of encoder 2 (120), and r is the radius of
다음, 상기 위치인식장치(100)의 각도 변화량을 이용하여 샘플링 시간 동안 의 위치인식장치(100)의 X좌표 변화량과 Y좌표 변화량을 계산하고, 상기 샘플링 시간동안 계산된 각도, X좌표, Y좌표 값과, 상기 각각에 대한 각도 변화량, X좌표 변화량, Y좌표 변화량을 합산해서 절대좌표계 상에서의 위치인식장치(100)의 각도, X좌표, Y좌표를 계산한다.Next, the X coordinate change amount and the Y coordinate change amount of the
상기한 관계식들로부터 절대 좌표계에서의 X, Y와 각도 θ는 각각 다음의 관계식들로 정의된다.From the above relations, X, Y and the angle θ in the absolute coordinate system are defined by the following relations, respectively.
(식 11)................ (Equation 11) ...
(식 12)................ (Equation 12) ...
(식 13)................ (Equation 13) ...
다음, 앞의 관계식들에 의해 유도된 위치 정보(Xn, Yn, θn)들과 인코더1(110)과 인코더2(120)로부터 개수한 펄스 수를 적절한 포맷의 패킷으로 만들어 상위의 로봇 제어기(210)로 전송한다. Next, the position information (Xn, Yn, θn) derived by the above relations and the number of pulses counted from the encoder 1 110 and the encoder 2 120 are made into packets of an appropriate format, and the
이때의 전송되는 데이터는 필요에 따라 위치 정보와 펄스 수들을 모두 포함하거나 어느 한가지일 수 있다.In this case, the transmitted data may include both the location information and the number of pulses as necessary or may be any one.
또한 위치인식장치(100)가 위치 정보를 상위 로봇 제어기(210)로 전송하는 방법으로는 일정시간 간격으로 자동 전송하는 방법, 위치 변화가 있을 때에 자동 전송하는 방법 및 로봇 제어기(210)의 요구에 따라 필요할 때마다 전송하는 방법이 있을 수 있다.In addition, the
이때, 일정시간 간격으로 자동 전송하는 경우는 실시간으로 위치 정보를 확인할 수 있으나 로봇 제어기(210)가 위치인식장치(100)와의 통신에 많은 시간을 할애해야 함으로 효율이 떨어지는 단점이 있고, 위치 변화가 있을 때에 자동 전송하는 방법은 로봇 제어기(210)의 통신에 대한 부담이 적으나 실시간으로 위치 정보를 확인하지 못해 원활한 피드백 제어가 곤란해지게 된다.At this time, when automatically transmitting at a predetermined time interval can check the location information in real time, but the
이에, 본 발명에 따른 위치인식장치(100)는 필요에 따라 로봇 제어기(210)의 선택에 따라 상기 두 가지 방법을 선택적으로 사용할 수 있도록 하는 선택수단을 제공하는 것이 바람직하다.Accordingly, the
상기와 같은 구성 및 작용을 갖는 본 발명은 앞서 설명한 다양한 실시 예를 통해 당 업자의 다양한 수정 및 변경이 가능하다. 이에, 본 발명의 진정한 기술적 범위는 명세서의 상세한 설명에 기재된 내용으로 한정되는 것이 아니라, 특허청구범위에 의해서 정해져야 할 것이다.The present invention having the configuration and operation as described above may be variously modified and changed by those skilled in the art through various embodiments described above. Therefore, the true technical scope of the present invention should not be limited to the contents described in the detailed description of the specification, but should be defined by the claims.
본 발명은 한 쌍의 인코더1, 2를 좌우 평행하게 배치하고, 상기 인코더1, 2에 축 결합된 한 쌍의 바퀴가 회전 할 때에 얻게 되는 펄스를 계수하고, 상기 카운터 정보를 이용하여 절대좌표계 상에서의 이동로봇의 위치가 계산되도록 함으로써, 이동로봇의 바퀴에 직접 인코더를 설치하여 위치를 계산하던 종전 방식에 비해, 모 터의 공회전 현상에 따른 오차 문제를 해결하게 되는 효과를 갖는다.According to the present invention, a pair of encoders 1 and 2 are arranged in parallel to the left and right, the pulses obtained when the pair of wheels coupled to the encoders 1 and 2 are rotated are counted, and the counter information is used on the absolute coordinate system. By calculating the position of the mobile robot has the effect of solving the error problem according to the motor idle phenomenon, compared to the conventional method of calculating the position by installing the encoder directly on the wheel of the mobile robot.
또한, 본 발명은 별개로 구동하는 한 쌍의 인코더를 이용하는 구조에 있어서, 한 쌍의 인코더를 평행 배치하게 됨으로써, 두 개의 인코더를 수직 배치하는 종래방식에 비해서 별도의 서보시스템과 고가의 센서를 갖추지 않고도 회전각도의 신속한 보상이 가능하게 되어 위치정보 획득에 뛰어난 성능을 발휘하게 된다.In addition, the present invention has a structure using a pair of encoders to drive separately, by arranging a pair of encoders in parallel, a separate servo system and expensive sensors compared to the conventional method of vertically placing two encoders It is possible to quickly compensate the rotation angle without exerting an excellent performance in obtaining position information.
그리고, 본 발명은 이동로봇의 위치 인식에 필요한 복잡한 계산을 위치인식장치의 컨트롤러에서 수행하게 됨으로써, 이동로봇의 제어기가 갖는 부담을 줄일 수 있게 되고, 이동로봇의 위치인식과정이 보다 안정적이며 쉽게 수행되는 효과를 갖는다.In addition, the present invention is to perform a complex calculation required for the position recognition of the mobile robot in the controller of the position recognition device, it is possible to reduce the burden on the controller of the mobile robot, the position recognition process of the mobile robot is more stable and easier to perform Effect.
Claims (4)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020060045662A KR100668788B1 (en) | 2006-05-22 | 2006-05-22 | Position recognition apparatus for mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020060045662A KR100668788B1 (en) | 2006-05-22 | 2006-05-22 | Position recognition apparatus for mobile robot |
Publications (1)
Publication Number | Publication Date |
---|---|
KR100668788B1 true KR100668788B1 (en) | 2007-01-12 |
Family
ID=37867977
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020060045662A KR100668788B1 (en) | 2006-05-22 | 2006-05-22 | Position recognition apparatus for mobile robot |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR100668788B1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100835952B1 (en) * | 2008-01-16 | 2008-06-09 | (주)엔티렉스 | Independence driving module for robot |
KR101081324B1 (en) * | 2011-03-11 | 2011-11-10 | 주식회사 에스엠이씨 | Robot equiped encoder |
KR101945734B1 (en) | 2012-08-16 | 2019-02-11 | 한화에어로스페이스 주식회사 | System for robot and method for driving the same |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61294512A (en) | 1985-06-24 | 1986-12-25 | Mitsui Miike Mach Co Ltd | Unmanned carrier |
JP2002039786A (en) | 2000-07-27 | 2002-02-06 | Sumitomo Heavy Ind Ltd | Travel distance measuring device for automatic guided vehicle |
KR200392635Y1 (en) | 2005-01-25 | 2005-08-17 | 황일규 | Absolute Position Recognition Device for the Mobile Robot |
-
2006
- 2006-05-22 KR KR1020060045662A patent/KR100668788B1/en not_active IP Right Cessation
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61294512A (en) | 1985-06-24 | 1986-12-25 | Mitsui Miike Mach Co Ltd | Unmanned carrier |
JP2002039786A (en) | 2000-07-27 | 2002-02-06 | Sumitomo Heavy Ind Ltd | Travel distance measuring device for automatic guided vehicle |
KR200392635Y1 (en) | 2005-01-25 | 2005-08-17 | 황일규 | Absolute Position Recognition Device for the Mobile Robot |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100835952B1 (en) * | 2008-01-16 | 2008-06-09 | (주)엔티렉스 | Independence driving module for robot |
KR101081324B1 (en) * | 2011-03-11 | 2011-11-10 | 주식회사 에스엠이씨 | Robot equiped encoder |
KR101945734B1 (en) | 2012-08-16 | 2019-02-11 | 한화에어로스페이스 주식회사 | System for robot and method for driving the same |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106323294B (en) | Positioning method and positioning device for substation inspection robot | |
KR100483548B1 (en) | Robot cleaner and system and method of controlling thereof | |
CN108710376A (en) | The mobile chassis of SLAM and avoidance based on Multi-sensor Fusion | |
US8970778B2 (en) | Camera support apparatus | |
CN103412565B (en) | A kind of robot localization method with the quick estimated capacity of global position | |
CN207164583U (en) | Indoor following device based on Mecanum wheel | |
JP2001199356A (en) | Omni-directional moving vehicle and method for controlling it | |
KR20090009172A (en) | Method and apparatus for measuring position of the mobile robot | |
KR100668788B1 (en) | Position recognition apparatus for mobile robot | |
CN106493725A (en) | A kind of industrial robot positioner based on omnidirectional's driven pulley and encoder | |
CN104089617A (en) | Locating device and method for mobile robot | |
US20070265004A1 (en) | System for measuring radio communicative region | |
CN102980555B (en) | Method and device for detecting direction of optical imaging type wheeled mobile robot | |
CN109176503B (en) | Intelligent path detection robot based on bionic tentacles and path detection method | |
WO2018129648A1 (en) | Robot and method thereof for establishing map by using deep camera and obstacle avoidance system | |
CN102582360A (en) | Universal castor with active driving device | |
CN109883395A (en) | A kind of automatic inclination measurement device | |
CN112162556A (en) | Navigation method, leveling robot, storage medium, processor and navigation system | |
JP3809698B2 (en) | Transport device | |
CN203053428U (en) | Detection device of azimuth of optical imaging type wheeled mobile robot | |
CN102419179A (en) | Method and device for positioning mobile robot and recording driving track | |
CN112904861A (en) | Two-dimensional positioning device and method for mobile robot based on passive orthogonal omni-wheel | |
CN204043675U (en) | A kind of mobile robot's locating device | |
CN207273234U (en) | A kind of guidance robot | |
CN206300622U (en) | Hole system multi-parameter detecting system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
A302 | Request for accelerated examination | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant | ||
FPAY | Annual fee payment |
Payment date: 20100108 Year of fee payment: 4 |
|
LAPS | Lapse due to unpaid annual fee |