KR20070073437A - The combine of stair climbing robot - Google Patents
The combine of stair climbing robot Download PDFInfo
- Publication number
- KR20070073437A KR20070073437A KR1020060001350A KR20060001350A KR20070073437A KR 20070073437 A KR20070073437 A KR 20070073437A KR 1020060001350 A KR1020060001350 A KR 1020060001350A KR 20060001350 A KR20060001350 A KR 20060001350A KR 20070073437 A KR20070073437 A KR 20070073437A
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- wheel assembly
- obstacle
- robot wheel
- vehicle body
- Prior art date
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A24—TOBACCO; CIGARS; CIGARETTES; SIMULATED SMOKING DEVICES; SMOKERS' REQUISITES
- A24F—SMOKERS' REQUISITES; MATCH BOXES; SIMULATED SMOKING DEVICES
- A24F19/00—Ash-trays
- A24F19/0078—Ash-trays comprising two separatable parts, e.g. coaxial
- A24F19/0085—Ash-trays comprising two separatable parts, e.g. coaxial one of the parts being covering or closing means
Abstract
Description
도 1a,b는 본 발명의 분리된 상태의 사시도.Figure 1a, b is a perspective view of the separated state of the present invention.
도 2는 본 발명의 합체된 상태의 사시도.Figure 2 is a perspective view of the combined state of the present invention.
도 3은 본 발명의 측면도.3 is a side view of the present invention.
도 4는 본 발명의 무한궤도부를 보인 사시도. Figure 4 is a perspective view of the caterpillar of the present invention.
도 5 및 본 발명의 평면도.5 and a plan view of the present invention.
도 6은 본 발명의 합체, 장애물 주파 및 분리 단계를 도시한 플로우 챠트.6 is a flow chart illustrating the coalescing, obstacle frequency and separation steps of the present invention.
도 7은 본 발명의 합체 과정을 나타낸 요부 발췌 평면도.7 is a plan view of the main portion excerpts showing the coalescence process of the present invention.
도 8은 본 발명의 주행방법을 설명하기 위한 플로우 챠트.8 is a flow chart for explaining the traveling method of the present invention.
도 9는 본 발명의 제 1, 2로봇의 합체과정 순서도.9 is a flow chart of the merge process of the first and second robot of the present invention.
도 10는 본 발명의 제 1로봇 차륜 어셈블리만의 계단 오르기 순서도.10 is a flowchart illustrating a step climbing of only the first robot wheel assembly of the present invention.
도 11은 본 발명의 제 1,2로봇 차륜어셈블리의 모두 계단 오르기 순서도.Figure 11 is a flow chart of both steps of the first and second robot wheel assembly of the present invention.
도 12은 본 발명의 제 2로봇 차륜어셈브리만의 계단 오르기 순서도12 is a flow chart for climbing the stairs of the second robot wheel assembly of the present invention.
도 13는 본 발명의 제 1로봇 차륜어셈브리만의 계단 내려오기 순서도Figure 13 is a flow chart of the steps down the first robot wheel assembly of the present invention
도 14은 본 발명의 제 1,2로봇 차륜어셈브리의 모두 계단 내려오기 순서도14 is a flowchart of descending all the steps of the first and second robot wheel assemblies of the present invention.
도 15는 본 발명의 제 2로봇 차륜어셈브리만의 계단 내려오기 순서도15 is a flowchart of stepping down the second robot wheel assembly of the present invention.
도 16은 본 발명의 제 1,2로봇의 분리과정 순서도.16 is a flow chart of the separation process of the first and second robots of the present invention.
도 17는 본 발명의 제 1로봇 차륜어셈브리가 계단을 오르는 상태의 플로우챠트17 is a flowchart of a state in which the first robot wheel assembly of the present invention climbs the stairs;
도 18은 본 발명의 제 2로봇 차륜 어셈브리가 계단을 오르는 상태의 플로우챠트18 is a flowchart of a state in which the second robot wheel assembly of the present invention climbs the stairs.
도 19,20은 종래의 장애물 주행 로봇을 도시한 사시도.19 and 20 are perspective views showing a conventional obstacle driving robot.
*도면이 주요부분에 대한 설명** Description of main parts of drawing *
1: 제 1로봇1: first robot
100: 차체 104: 삽입부 104a: 배면판100: vehicle body 104:
104b: 경사판 105: 합체수단 105a: 전자석104b: inclined plate 105: coalescing means 105a: electromagnet
105b: 전동실린더 105c: 로드 106: 카메라105b:
110: 차륜어셈블리 111: 좌측지지다리 112; 우측지지다리110: wheel assembly 111:
113: 차축113: axle
130: 차륜회동기구 131: 피동스프로켓 132: 체인130: wheel turning mechanism 131: driven sprocket 132: chain
133: 구동스프로켓 134: 모터133: drive sprocket 134: motor
160a,160b: 무한궤도부 161: 지지플레이트 162:한 쌍의 축160a and 160b: endless track portion 161: support plate 162: a pair of axes
163: 한 쌍의 휠 164: 궤도벨트 165a: 구동모터163: pair of wheels 164:
165b: 구동풀리 165c: 종동풀리 165d: 타이밍 벨트165b:
166a: 엔코더 166b: 제 1풀리 166c: 제 2풀리166a:
166d: 타이밍 벨트166d: timing belt
170: 센싱수단 171: 장거리 검출센서 172: 전방감지센서170: sensing means 171: long-range detection sensor 172: front detection sensor
173: 바닥감지센서 173: floor sensor
2: 제 2로봇2: second robot
200: 차체 204: 인입부 204a: 배면판200: body 204:
204b: 경사판 204c: 결합공 205: 제 1타겟204b:
206: 제 2타겟206: second target
210: 차륜어셈블리 211: 좌측지지다리 212; 우측지지다리210: wheel assembly 211:
213: 차축213: axle
230: 차륜회동기구 231: 피동스프로켓 232: 체인230: wheel turning mechanism 231: driven sprocket 232: chain
233: 구동스프로켓 234: 모터233: drive sprocket 234: motor
260a,260b: 무한궤도부 261: 지지플레이트 262:한 쌍의 축260a, 260b: caterpillar 261: support plate 262: a pair of axes
263: 한 쌍의 휠 264: 궤도벨트 265a: 구동모터263: pair of wheels 264:
265b: 구동풀리 265c: 종동풀리 265d: 타이밍 벨트265b:
266a: 엔코더 266b: 제 1풀리 266c: 제 2풀리266a:
266d: 타이밍 벨트266d: timing belt
270: 센싱수단 271: 장거리 검출센서 272: 전방감지센서270: sensing means 271: long range detection sensor 272: front detection sensor
273: 바닥감지센서273: floor sensor
본 발명은 합체형 장애물 주행 로봇에 관한 것으로, 특히 개별적으로 정찰 및 탐사 임무를 수행하는 한 쌍의 로봇이 혼자서 극복 불가능한 장애물을 극복하여야 할 경우 서로 합체하여 장애물을 극복하며, 다시 분리되어 각각 개별적으로 정찰 및 탐사임무를 수행하는 합체형 장애물 주행 로봇에 관한 것이다.The present invention relates to an integrated obstacle driving robot, in particular, when a pair of robots individually performing reconnaissance and exploration missions must overcome obstacles that cannot be overcome by themselves, they merge with each other to overcome obstacles, and are separated from each other individually. An integrated obstacle driving robot for reconnaissance and exploration missions.
일반적으로 정찰 및 탐사 수행을 하면서 장애물을 주파하는 기능을 갖는 로봇은 무한궤도를 갖춘 차체에 감시 센서 및 감시 카메라 등을 구비하여 구성되는 등 실로 다양한 로봇들이 제시되어 있다. In general, a variety of robots have been proposed, including surveillance sensors and surveillance cameras, which are equipped with a caterpillar while surveillance and exploration are performed.
그중에서 국내특허등록 10-0477044호(계단 주행 로봇 및 그 주행방법)를 예를 들어 살펴보면 다음과 같다.Among them, look at the domestic patent registration No. 10-0477044 (stair running robot and its driving method) as an example.
상기 종래의 장애물 주행 로봇의 구성은 도 19 및 도 20에서와 같이, 차체(100)와, 차체 전방에 설치되며 전방 좌,우 무한궤도부(160a,160b)를 갖는 전륜 어셈블리(110)와, 상기 전방 좌,우 무한궤도부를 축 회동시키는 전륜회동기구(130)와, 차체 후방에 설치되며 후방 좌, 무한궤도부(160c,169d)를 갖는 후륜어셈블리(120)와, 상기 후방 좌우 무한궤도부를 축 회동시키는 후륜회동기구(140)와, 상기 후륜어셈블리를 전륜어셈블리에서 상대적으로 멀어지거나 가깝게 이동시키는 축간거리조절기구(150)와, 주행시 각종 장애물등을 감지하는 센싱수단(200)으로 구성된다.19 and 20, the configuration of the conventional obstacle driving robot, the
이와 같이 구성되는 상기 종래의 로봇은 탐사및 정찰등의 임무를 수행하기위하여 4개의 무한궤도를 구동시켜 일반적인 노면을 주행하다 계단등의 장애물을 만나면 4개의 무한궤도를 이용하여 장애물을 극복한 후 다시 원래의 탐사 및 정찰등의 임무를 수행하기 위하여 계속 주행하게 된다.The conventional robot configured as described above drives four endless tracks to drive a general road surface in order to perform a mission such as exploration and reconnaissance. They will continue to drive their original exploration and reconnaissance missions.
그러나, 상기 종래의 로봇은 일반적인 노면의 주행시에도 4개의 무한궤도를 개별적으로 각각 구동시켜야 하므로 통상 일반적인 한 쌍의 무한궤도를 갖춘 탐사로봇에 비해 구조가 복잡하며, 이동시 신속하지 못하며, 유지보수 및 관리운영에 비경제적인 문제점이 발생한다.However, the conventional robot has to drive four endless tracks separately even when driving on a general road surface, and thus, the structure of the conventional robot is more complicated than a general exploration robot having a pair of endless tracks, and it is not fast during movement, maintenance and management. Uneconomical problems arise in operation.
이에 본 발명은 상기한 문제점을 해결하고자 안출한 것으로, 한 쌍의 무한궤도를 갖춘 복수의 로봇이 평상시 개별적으로 정찰 및 탐사임무를 수행하다 어느하나가 장애물을 만날경우 두 로봇이 서로 합체하여 장애물을 극복한 후 다시 분리되어 정찰 및 탐사임무를 수행하게 하므로서 신속한 이동성과 제작 및 운영이 경제적인 합체형 장애물 주행 로봇을 제공하는데 있다.Accordingly, the present invention has been made to solve the above problems, a plurality of robots having a pair of crawlers usually performs the reconnaissance and exploration missions individually, when one encounters an obstacle, the two robots merge with each other to solve the obstacle. After overcoming and re-separating to perform reconnaissance and exploration missions, it is to provide an economical combined obstacle driving robot with rapid mobility, manufacturing and operation.
상기한 목적을 달성하기 위한 본 발명의 특징은 차체의 양측에 구비되는 좌,우측 무한궤도부와, 상기 차체의 배면측 중앙에 돌출되게 형성된 배면판과, 상기 배면판 양측에 차체 내측으로 경사지게 형성된 경사판으로 이루어진 삽입부와, 상 기 삽입부에 설치되어 상기 삽입부가 후술할 제 2로봇의 인입부에 서로 요철 결합하므로서 합체되어 장애물을 주파하도록 하는 합체수단과, 차체의 상측에 구비되는 카메라를 포함하는 제 1로봇과; 차체의 양측에 구비되는 좌,우측 무한궤도부와, 상기 차체의 배면측은 상기 삽입부와 대응되는 형상으로 그 중앙에 인입되게 형성되는 배면판과, 이 배면판 양측에는 차체 외측으로 경사지게 형성되되, 다수의 결합공을 갖는 경사판으로 이루어진 인입부와, 차체의 상측에 구비되는 원통형의 제 1타겟과, 상기 배면판 외측에 설치되는 제 2타겟을 포함하는 제 2로봇;으로 구성되는 합체형 장애물 주파로봇에 있다.Features of the present invention for achieving the above object is a left and right endless track portion provided on both sides of the vehicle body, a back plate formed to protrude in the center of the rear side of the vehicle body, and formed on both sides of the rear plate to be inclined inside the vehicle body Insertion portion consisting of the inclined plate, the insertion portion is installed in the insertion portion of the second robot which will be described later, the coalescing means to be combined with each other so as to frequency the obstacle, and a camera provided on the upper side of the vehicle body A first robot to make; The left and right endless track portion provided on both sides of the vehicle body, the rear side of the vehicle body is formed to be introduced into the center in a shape corresponding to the insertion portion, and the rear plate is formed to be inclined to the outside of the vehicle body, Coalesced obstacle frequency consisting of; an inlet portion consisting of an inclined plate having a plurality of coupling holes; a second robot including a cylindrical first target provided on the upper side of the vehicle body; and a second target provided outside the rear plate. It's on the robot.
이하 본 발명의 구성 및 작동 과정을 첨부도면에 의거하여 상세히 설명한다.Hereinafter, the configuration and operation of the present invention will be described in detail with reference to the accompanying drawings.
우선 도 1a,b는 본 발명의 합체전 상태의 사시도이며, 도 2는 본 발명의 합체된 상태의 사시도이며, 도 3은 본 발명의 측면도이며, 도 4는 본 발명의 무한궤도부를 보인 사시도이며, 도 5는 본 발명의 평면도 이며, 도 6은 본 발명의 합체, 장애물 주파 및 분리 단계를 나타낸 플로우 챠트이며, 도 7은 본 발명의 합체 과정을 나타낸 요부 발췌 평면도이며, 도 8은 본 발명의 주행방법을 설명하기 위한 플로우챠트이며, 도 9는 본 발명의 제 1,2로봇의 합체과정을 나타낸 순서도 이며, 도 10는 본 발명의 제 1로봇 차륜 어셈블리만의 계단 오르기 순서도이며, 도 11은 본 발명의 제 1,2로봇 차륜어셈블리의 모두 계단 오르기 순서도이며, 도 12은 본 발명의 제 2로봇 차륜어셈브리만의 계단 오르기 순서도이며, 도 13는 본 발명의 제 1로봇 차륜어셈브리만의 계단 내려오기 순서도이며, 도 14은 본 발명의 제 1,2로봇 차 륜어셈브리의 모두 계단 내려오기 순서도이며, 도 15는 본 발명의 제 2로봇 차륜어셈브리만의 계단 내려오기 순서도이며, 도 16은 본 발명의 제 1,2로봇의 분리과정 순서도이며, 도 17는 본 발명의 제 1로봇 차륜어셈브리가 계단을 오르는 상태의 플로우챠트이며, 도 18은 본 발명의 제 2로봇 차륜 어셈브리가 계단을 오르는 상태의 플로우챠트이다.First, Figures 1a, b is a perspective view of the state before the coalescence of the present invention, Figure 2 is a perspective view of the coalesced state of the present invention, Figure 3 is a side view of the present invention, Figure 4 is a perspective view showing the endless track of the present invention. 5 is a plan view of the present invention, Figure 6 is a flow chart showing the coalescing, obstacle frequency and separation step of the present invention, Figure 7 is an excerpt of the main part showing the coalescence process of the present invention, Figure 8 is a view of the present invention 9 is a flowchart illustrating a driving method, FIG. 9 is a flowchart illustrating a process of incorporating the first and second robots of the present invention, FIG. 10 is a flowchart of the stairs climbing of the first robot wheel assembly of the present invention, and FIG. Steps of the first and second robot wheel assembly of the present invention is a step-up flow chart, Figure 12 is a step-up flow chart of only the second robot wheel assembly of the present invention, Figure 13 is a first robot wheel assembly of the present invention only Down the stairs Fig. 14 is a flowchart for descending all the steps of the first and second robot wheel assemblies of the present invention, and Fig. 15 is a flowchart for descending the steps of only the second robot wheel assembly of the present invention. 17 is a flow chart of the separation process of the first and second robots of the present invention, and FIG. 17 is a flowchart of a state in which the first robot wheel assembly of the present invention is climbing a step, and FIG. 18 is a second robot wheel assembly of the present invention. It is a flowchart of a rising state.
우선 본 발명의 합체형 장애물 주행 로봇의 구성은 크게 차체(100)의 양측에 구비되어 개별 주행 및 일정 높이 이하의 장애물을 주파하도록 하는 좌,우측 무한궤도부(160a,160b)와, 차체(100)의 배면측에 형성되어 후술할 제 2로봇(2)의 인입부(204)와 요철결합되는 삽입부(104)와, 상기 삽입부(104)에 설치되어 상기 제 2로봇(2)과 합체되는 합체수단(105)을 포함하여 이루어진 제 1로봇(1)과;First, the configuration of the integrated obstacle driving robot of the present invention is largely provided on both sides of the
차체(200)의 양측에 구비되어 개별주행 및 일정 높이의 장애물을 주파하도록 하는 좌,우측 무한궤도부(260a,260b)와, 차체(200)의 배면측에 형성되어 상기 제 1로봇의 삽입부(104)가 삽입되어 요철결합되는 인입부(204)를 포함하여 이루어진 제 2로봇(2);으로 이루어진다.Left and right endless track parts (260a, 260b) provided on both sides of the
특히, 상기 제 1로봇(1)의 차체(100)는 함체 형상으로 이루어지되, 상기 차체(100)의 배면측을 이루는 삽입부(104)는 배면측 중앙에 돌출되게 형성된 배면판(104a)과, 상기 배면판(104a) 양측에 차체 내측으로 경사지게 형성된 경사판(104b)으로 이루어진다.In particular, the
그리고, 상기 합체수단(105)는 상기 제 1로봇 배면판(104a) 내측에 설치되어 상기 제 2로봇 배면판(104b)과 자력으로 결합되게 하는 전자석(105a)과, 상기 제 1로봇 경사판 외면으로 실린더 로드(105c)가 출몰되어 상기 제 2로봇 경사판의 결합공(204c)에 삽입지지되도록 제 1로봇 경사판 내측에 설치되는 다수의 전동실린더(105b)로 이루어진다.In addition, the coalescing means 105 is installed inside the first robot back
또한, 상기 차체(100)의 상부에는 제 2로봇(2)을 인지하는 카메라(106)가 설치된다.In addition, a
상기 제 2로봇(2)의 차체(200)는 함체 형상으로 이루어지되, 상기 차체(200)의 배면측을 이루는 인입부(204)는 상기 삽입부(104)와 대응되는 형상으로 그 중앙에 인입되게 형성되는 배면판(204a)과, 이 배면판 양측에는 차체 외측으로 경사지게 형성되되, 다수의 결합공(204c)을 갖는 경사판(204b)으로 이루어진다.The
그리고, 상기 차체(200)는 그 상측에 구비되어 상기 제 1로봇(1)의 카메라(206)가 원거리에서 제 2로봇(2)을 인지하여 접근하도록 하는 제 1타겟(205)과, 제 2로봇에 접근한 제 1로봇의 삽입부(104)가 제 2로봇의 인입부(204)를 찾아서 마주보도록 상기 배면판(204a) 외측에 설치되는 제 2타겟(206)을 갖는다.In addition, the
여기서, 상기 제 1,2로봇의 배면판(104a,204a)는 금속재질로 구성함이 바람직하다. 이는 상기 제 1,2로봇의 삽입부(104),인입부(204)가 서로 요철결합시 상기 제 1로봇 전자석(105a)의 자력에 의해 제 2로봇 배면판(204a)이 제 1로봇 배면판(104a)에 달라붙어야 하기 위함이다.Here, the
다시, 상기 제 1,2로봇의 무한궤도부와 그 주위 구성에 대해 보다 구체적으로 설명하면 다음과 같다.Again, the infinite track portion and the surrounding configuration of the first and second robots will be described in more detail as follows.
상기 제 1로봇은 상기 차체(100)의 전방부분 좌,우측 양측에 고정되는 좌,우측 차륜지지다리(111,112)와, 상기 좌,우측 차륜지지다리에 양 측이 축 지지되는 차축(113)과, 상기 차축 양측에 축설되는 좌,우측 무한궤도부(160a,160b)로 이루어진 차륜어셈블리(110), 상기 차축에 축착되는 피동스프로켓(131)과, 이 피동스프로켓과 체인(132)으로 연결되는 구동스프로켓(133)과, 상기 구동스프로켓을 축 결합하며 차체에 고정되는 모터(134)로 이루어진 차륜회동기구(130), 차체 전면에 부착되는 장거리 검출센서(141)와, 좌,우측 무한궤도부(160a,160b)에 각각 부착되는 전방감지센서(142)와, 상기 차륜어셈블리(110)에 구비한 바닥감지센서(143)를 포함한 센싱수단(140),으로 이루어진다.The first robot includes left and right
여기서, 상기 제 1로봇의 무한궤도부(160a,160b)는 한 쌍의 지지플레이트(161)와, 상기 지지플레이트 양측에 축결합하는 한 쌍의 축(162)과, 상기 한 쌍의 축에 결합되는 한 쌍의 휠(163)과, 상기 한 쌍의 휠의 둘레에 감아 서로 연결한 궤도벨트(164)와, 상기 지지플레이트에 고정되는 구동모터(165a)와, 상기 구동모터에 축결합되는 구동풀리(165b)와, 상기 어느 한 축에 축 결합된 종동풀리(165c)와, 상기 구동,종동풀리를 연결한 타이밍 벨트(165d)와, 상기 지지플레 이트에 고정되어 상기 휠의 회전수를 감지하 엔코더(166a)와, 상기 엔코더에 결합되는 제 1풀리(166b)와, 상기 다른 한 축에 축 결합된 제 2풀리(166c)와, 상기 제 1,2풀리를 연결한 타이밍 벨트(166d)로 이루어져 개별 구동이 가능하도록 한 것이다.Here, the endless track portion (160a, 160b) of the first robot is a pair of support plates 161, a pair of shafts 162 coupled to both sides of the support plate and coupled to the pair of shafts A pair of wheels 163, a track belt 164 wound around the pair of wheels and connected to each other, a
또한, 상기 제 2로봇은 상기 차체의 전방부분 좌,우측 양측에 고정되는 좌,우측 차륜지지다리(211,212)와, 상기 좌,우측 차륜지지다리에 양 측이 축 지지되는 차축(213)과, 상기 차축 양측에 축설되는 좌,우측 무한궤도부(260c,260d)로 이루어진 차륜어셈블리(210), 상기 차축에 축착되는 피동스프로켓(231)과, 이 피동스프로켓과 체인(232)으로 연결되는 구동스프로켓(233)과, 상기 구동스프로켓을 축 결합하며 차체에 고정되는 모터(234)로 이루어진 차륜회동기구(230), 차체 전면에 부착되는 장거리 검출센서(271)와, 좌,우측 무한궤도부(260a,260b)에 각각 부착되는 전방감지센서(272)와, 상기 차륜어셈블리(210)에 구비한 바닥감지센서(273)를 포함한 센싱수단(270),으로 이루어진다.In addition, the second robot includes left and right
특히, 상기 제 2로봇의 무한궤도부(260a,260b)는 한 쌍의 지지플레이트(261)와, 상기 지지플레이트 양측에 축결합하는 한 쌍의 축(262)과, 상기 한 쌍의 축에 결합되는 한 쌍의 휠(263)과, 상기 한 쌍의 휠의 둘레에 감아 서로 연결한 궤도벨트(264)와, 상기 지지플레이트에 고정되는 구동모터(265a)와, 상기 구동모터에 축결합되는 구동풀리(265b)와, 상기 축에 축 결합된 종동풀리(265c)와, 상기 구동,종 동풀리를 연결한 타이밍 벨트(265d)와, 상기 지지플레이트에 고정되어 휠의 회전수를 감지하는 엔코더(266a)와, 상기 엔코더에 결합되는 제 1풀리(266b)와, 상기 축에 축 결합된 제 2풀리(266c)와, 상기 제 1,2풀리를 연결한 타이밍 벨트(266d)로 이루어져 개별 구동이 가능하도록 한 것이다.In particular, the endless track portion (260a, 260b) of the second robot is a pair of support plates 261, a pair of shafts 262 coupled to both sides of the support plate, coupled to the pair of shafts A pair of wheels 263, a track belt 264 wound around the pair of wheels and connected to each other, a
이하 본 발명의 작동상태를 설명한다.Hereinafter will be described the operating state of the present invention.
우선, 제 1로봇과 제 2로봇이 합체전 개별 주행시의 작동과정과, 도 6을 참조하여 제 1,2로봇의 합체과정, 그리고 합체된 제 1,2로봇의 장애물 주행과정 및 합체된 제 1,2로봇의 분리 과정을 중심으로 상세히 설명한다.First, the operation process of the first robot and the second robot before the coalescing, the coalescing process of the first and second robots, and the obstacle driving process of the coalescing the first and second robots with reference to FIG. 2, the robot will be described in detail with the separation process.
우선 상기 제 1로봇과 제 2로봇의 개별 주행은,First, the individual driving of the first robot and the second robot,
상기의 제 1로봇의 좌측 무한궤도부(160a)와 우측 무한궤도부(160b), 그리고 상기의 제 2로봇의 좌측무한궤도부(260a)와 우측 무한궤도부(260b)는 각각 독립적으로 구동된다. 즉, 제 1로봇 좌측 무한궤도부(160a)를 예로서 설명하면, 양쪽 지지플레이트(161)의 사이에 설치된 구동모터(165a)가 전원을 공급받아 구동되면, 그 축에 축착된 구동풀리(165b)가 회전하고, 이 구동풀리(165b)와 타이밍벨트(165d)로써 연결된 종동풀리(165c)가 회전하며, 이 종동풀리와 같이 어느 한 축(162)에 축착된 어느 한 휠(163)이 회전하고, 이 휠(163)과 궤도벨트(164)로써 연결된 다른 한 휠(163)이 같이 회전하며, 이때의 궤도벨트(164)는 말그대로 무한궤도이기 때문에 차체를 이동시키는 것이 가능하다. 이때, 상기 차축(113)은 회전하지 않는다.The left
이와 같이, 상기 제 1로봇(1)은 좌우측 무한궤도부가 동시에 일측방향으로 구동하면 직진하며, 서로 반대로 구동하면 제자리에서 선회하며, 동시에 타측방향으로 구동하면 후진하는 동작으로 주행하게 된다.As described above, the
또한 상기 제 2로봇도 상기 제 1로봇과 같은 방식으로 주행하게 된다.The second robot also travels in the same manner as the first robot.
즉, 제 1,2 로봇의 개별적 주행은 상기 무한궤도부의 구동으로서 상기와 같이 방향전환 및 직진 후진등을 하며 주행하게 되는 것이다.That is, the individual driving of the first and second robots is to drive while turning the direction and go straight back as described above as the drive of the crawler.
여기서 상기 제 2로봇(2)이 주행중에 주행로 상에 위치한 장애물을 센싱수단(170)으로 감지하여 장애물의 높이가 단독으로 주파가능한 일정높이 이상인지 이하인지를 판단하여 일정높이 이하이면 그대로 주행하면서 장애물을 주파하게 되며, 만약 장애물이 주파가능한 일정높이 이상으로 판단되면 개별주행중인 제 1로봇과 합체하여 후술할 장애물 주파과정으로 주파하게 된다.Here, the
이하, 상기 제 1로봇과 상기 제 2로봇의 합체, 장애물 주파 및 분리 과정은 도 6의 플로우 챠트 및 도 7의 결합순서도를 참조하여 설명하면 다음과 같다.Hereinafter, the merging, obstacle frequency, and separation process of the first robot and the second robot will be described with reference to the flowchart of FIG. 6 and the coupling flowchart of FIG. 7.
우선 상기 제 1로봇(1)과 제 2로봇(2)이 개별적으로 서로 다른 장소에서 탐사 및 정찰 임무를 수행중 두 로봇이 서로 합체하기 위한 합체 과정은 제 1타겟 서치 단계, 제 2타겟 서치 단계, 접근 단계, 합체완료단계로 진행된다.First of all, the first robot search unit and the second robot search unit perform the exploration and reconnaissance mission in different locations, respectively, in the first target search step and the second target search step. , Access, and coalescing.
여기서 제 1타겟 서치단계는 제 1로봇의 카메라(106)가 원거리에서 서치(search)하여 제2 로봇의 원통형인 제 1 타겟(205)을 인지하여 제 2로봇 측으로 이동시키는 단계이다. Here, the first target search step is a step in which the
그리고, 여기서 제 1타겟이 원통형인 이유는 카메라(106)가 제 2로봇의 어느 방향으로 서치하여도 그 타겟 형상이 2차원적인 사각형으로 인지할 수 있기 때문이다.The reason why the first target is cylindrical is that the target shape can be recognized as a two-dimensional quadrangle even when the
다음 제 2타겟 서치 단계는 제 2로봇(2) 근처까지 이동한 제 1로봇(1)이 제 2로봇의 인입부(204)를 인지하도록 제 2로봇을 중심으로 선회하여, 제 1로봇의 삽입부(104)와 제 2로봇의 인입부(204)가 서로 마주보게 위치하도록 제 1로봇(1)을 이동시키는 단계이다.Next, the second target search step pivots about the second robot so that the
다음 접근단계는 제 1로봇(1)이 제 2로봇(2)에 접근하는 단계이다.The next approach step is for the
즉 제 1로봇 삽입부(104)가 제 2로봇 배면부(204)로 접근하는 것으로, 이때 노면환경에 따라 접근시 그 위치를 벗어날 수 있으므로, 제 1로봇은 계속 제 2로봇 인입부(204)를 주시하면서 접근중 예상 결합위치에서 벗어나면 다시 예상 결합위치로 보정하면서 접근한다.That is, the first
다음 합체 단계는 상기 제 1,2로봇 삽입,인입부(104,204)가 서로 요철 결합되는 것으로, 도 7에서와 같이 전자석(105a)에 전류를 공급하여 자력을 형성시키면 그 자력에 의해 제 2로봇 배면판(204a)이 제 1로봇 배면판(104a)에 달라붙게되며, 이와 동시에 전동실린더(105b)에서 로드(105c)가 돌출되어 제 2로봇 경사판(204b)의 결합공(204c)에 삽입지지 된다. 이후 전자석(105a)에 전류를 끊어 자력을 차단하더라도 양 경사판(104b,204b)이 로드(105c)로 서로 결합되므로, 제 1로봇(1)과 제 2로봇(2)이 서로 견고하게 합체되는 것이다.In the next coalescing step, the first and second robot insertions and
그리고, 상기 합체된 제 1,2로봇의 장애물 주파단계는 후술할 장애물 주행과정에서 상세히 설명한다. The obstacle frequency step of the combined first and second robots will be described in detail in the obstacle driving process to be described later.
그리고, 분리단계는 도 16에서와 같이, 상기 결합공(204c)에 삽입지지된 전동실린더 로드(105c)를 결합공(204c)에서 이탈되게 수축시켜 상기 제 1,2로봇의 삽입부(104), 인입부(204)를 분리시켜 다시 제 1,2로봇이 개별 주행하는 것이다.And, in the separation step, as shown in Figure 16, the
이하 상기와 같이 합체된 상태의 본 발명의 주행방법 및 장애물 주행을 도 8에서 보는 바와 같은 플로우챠트에 따라 설명한다.Hereinafter, the driving method and the obstacle driving of the present invention in the coalesced state will be described according to the flowchart as shown in FIG. 8.
우선, 상기 제 1로봇 차륜회동기구(130)는 모터(133)가 전원을 공급받아 구동될 때, 원동스프로켓(132)이 회전하고, 이 원동스프로켓(132)과 체인(134)으로써 연결된 피동스프로켓(131)이 회전하며, 따라서 피동스프로켓(131)이 축착된 차축(113)의 회전량 만큼 좌측 무한궤도부(160a) 및 우측 무한궤도부(160b)가 리프팅 업/다운(Lifting-Up/Down)될 수 있다. First, when the
상기 제 2로봇 차륜회동기구(230)도 모터(233)가 전원을 공급받아 구동될 때, 원동스프로켓(232)이 회전하고, 이 원동스프로켓(232)과 체인(234)으로써 연결된 피동스프로켓(231)이 회전하며, 따라서 피동스프로켓(231)이 축착된 차축(213)의 회전량 만큼 제 2로봇의 좌측 무한궤도부(260a) 및 우측 무한궤도부(260b)가 리프팅 업/다운(Lifting-Up/Down)될 수 있다.When the
본 발명의 합체된 상태에서의 주행방법 중에는 상기 센싱수단(200)에 전방 장애물이 나타나지 않았을 경우, 제 1로봇의 차륜 어셈브리(110) 및 제 2로봇의 차륜 어셈브리(210)의 무한궤도부(160a,160b,260a,260b)를 구동시켜 이동하는 평지주 행단계가 있다. In the traveling method of the combined state of the present invention, when the front obstacle does not appear in the sensing means 200, the endless track portion of the
이 평지주행단계에서는 전진, 후진, 선회가 가능하며, 선회시에는 제 1로봇 차륜 어셈브리 (110)및 제 2로봇 차륜 어셈브리(210)의 좌, 우 무한궤도부를 서로 다른 방향으로 구동시켜 좌회전 및 우회전 할 수 있다.In this flat driving stage, forward, backward, and turning are possible, and when turning, the left and right endless tracks of the first
이와 같은 평지주행단계에서 주행하다가 장애물을 접하게 되면 그 장애물을 상기 센싱수단이 감지하게 된다. 즉, 전방을 향해 제 1로봇 차체(100)의 앞쪽에 설치된 장거리검출센서가 이를 감지하며, 즉시 극복 가능 또는 극복 불가능을 판단하는데 이것이 1차장애물판단단계이다.When the vehicle encounters an obstacle while driving in the flat driving stage, the sensing means detects the obstacle. That is, the long-range detection sensor installed in front of the
상기 1차장애물판단단계에서 장애물 극복 가능의 값이 나왔을 경우, 상기 센싱수단의 전방감시센서(172,272)로써 그 높이를 측정파악하는 2차장애물판단단계로 넘어가고, 상기 1차장애물판단단계 및 상기 2차장애물판단단계에서 장애물 극복 불가능의 값이 나왔을 경우, 장애물을 우회하여 주행하는 우회주행단계를 실시한다.In the first obstacle determination step, when the value of the obstacle overcoming is obtained, the process proceeds to the second obstacle determination step of measuring the height by the
반대로 상기 2차장애물판단단계에서 장애물 극복 가능의 값이 나왔을 경우 장애물극복단계를 실시한다.On the contrary, when the obstacle overcoming value is obtained in the second obstacle determination step, the obstacle overcoming step is performed.
상기 장애물극복단계를 실시하되 장애물이 올라가야하는 계단일 경우, 제 1로봇 차륜어셈브리(110)의 장애물 등판과정과 제 2로봇 차륜 어셈브리(210)의 장애물 등판과정을 반복하여 오르기를 하게 되고, 상기 장애물이 내려가야하는 계단일 경우, 제 1로봇 차륜 어셈브리(110)의 장애물 하강과정과 제 2로봇 차륜 어셈브리(210)의 장애물 하강과정을 반복하여 돌파하게 된다.When performing the obstacle overcoming step, but the obstacle is to climb the stairs, the climbing process of the obstacle climbing process of the first
장애물극복단계중 하나인 계단 오르기 과정을 설명한다.Explain the process of climbing stairs, one of the obstacle avoidance steps.
계단 오르기 과정은 제 1로봇 차륜 어셈브리(110)의 장애물 등판과정, 제 1로봇 차륜 어셈브리(110) 및 제 2로봇 차륜 어셈브리(210)의 장애물 동시 등판과정, 제 2로봇 차륜 어셈브리(210)의 장애물 등판과정으로 이루어 진다.The stair climbing process includes the obstacle climbing process of the first
먼저, 제 1로봇 차륜어셈브리(110)의 장애물 등판과정은 도 10에서 보는 바와 같이 상기 센싱수단(170)으로써 최초 전, 후의 전위차계를 확보한 후, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 장애물 앞까지 전진하는 단계로부터 시작한다. First, the obstacle climbing process of the first
그리고 상기 전진단계를 거쳐 장애물 앞에 이르면 제 1로봇 차륜 어셈브리 및 제 2로봇 차류 어셈브리 무한궤도부를 모두 정지하고, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 상향 리프팅시키는 리프팅업단계를 거친다.When the vehicle reaches the obstacle through the advance step, both the first robot wheel assembly and the second robot vehicle assembly endless track portion are stopped, and the first robot
상기 리프팅업단계를 거쳐 제 1로봇 차륜어셈브리(110)의 무한궤도부가 계단의 모서리보다 높아졌을 때, 제 1로봇 차륜회동기구(130)를 정지시키고, 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 구동시켜 제 1로봇 차륜 어셈브리(110)가 계단모서리에 걸치도록 전진하는 1차 등판전진단계를 거친다.When the endless track portion of the first
상기 1차 등판전진단계를 거쳐 제 1로봇 차륜 어셈브리(110)가 계단모서리에 걸쳐 졌을 때, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜 어셈브리를 하향리프팅시키되, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜 어셈브리의 전위차계 값이 같아 졌을 때까지 리프팅하는 리프팅다운단계를 거친다. When the first
그리고 상기 리프팅다운단계를 거쳐 제 1로봇 차륜 어셈브리(110)가 수평이 되었을 때, 제 1로봇 차륜회동기구(130)를 정지시키고 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하는 2차 등판전진단계를 차례로 거치는 것이다.When the first
이 과정은 도 17의 진행과정이다.This process is the process of FIG.
다음으로 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 장애물 동시 등판과정을 보면, 도 11에서 보는 바와 같이 상기 제 1로봇 차륜어셈브리의 장애물 등판과정의 2차 등판전진단계를 거친 후, 다음단계의 계단이 나타나면 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 정지시키고, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜 어셈브리를 상향 리프팅시키는 제 1로봇 차륜리프팅업단계를 거친다. Next, when the obstacle climbing process of the first robot wheel assembly and the second robot wheel assembly is simultaneously viewed, as shown in FIG. 11, after the second climbing advance step of the obstacle climbing process of the first robot wheel assembly, When the step of the next step appears, all the endless track portion of the first
그리고 상기 제 1로봇 차륜어셈브리의 제 1로봇 차륜 리프팅업단계와 동시에 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 상향 리프팅시키는 제 2로봇 차륜리프팅업단계를 거친다.In addition, a second robot wheel lifting up step of lifting the second robot wheel assembly by driving the second robot
상기 제 1로봇 차륜 리프팅업단계 및 제 2로봇 차륜리프팅업단계를 거친 후, 제 1로봇 차륜어셈브리(110)의 무한궤도부가 계단의 모서리보다 높아졌을 때 제 1로봇 차륜회동기구(130)를 정지시키고, 제 2로봇 차륜어셈브리(210)의 무한궤도부가 계단의 모서리보다 높아졌을 때 제 2로봇 차륜회동기구(230)를 정지시킨 후, 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 구동시켜 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)가 계단모서리에 걸치도록 전진하는 1차 등판전진단계를 거친다. After the first robot wheel lifting up step and the second robot wheel lifting up step, when the endless track portion of the first
상기 1차 등판전진단계를 거친 후에는 제 1로봇 차륜어셈브리(110)가 계단모서리에 걸쳐 졌을 때, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 하향리프팅시키되, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 전위차계값이 같아 졌을 때까지 하향리프팅하고, 이와 동시에 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 하향리프팅시키되, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 전위차계값이 같아 졌을 때까지 하향리프팅하는 리프팅다운단계를 거친다. After the first climbing forward step, when the first
이어서 상기 리프팅다운단계를 거쳐 제 1로봇 차륜어셈브리(110)와 제 2로봇 차륜어셈브리(210)가 모두 수평이 되었을 때, 제 1로봇 차륜회동기구(130) 및 제 2로봇 차륜회동기구(230)를 모두 정지시키고 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하는 2차 등판전진단계를 차례로 거치는 것이다.Subsequently, when both the first
다음으로, 상기한 장애물 극복단계의 제 2로봇 차륜어셈브리의 장애물 등판과정은 도 12에서 보는 바와 같으며, 상기 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 장애물 동시 등판과정을 거친 다음이다.Next, the obstacle climbing process of the second robot wheel assembly of the obstacle overcoming step is as shown in FIG. 12, and the obstacle climbing process of the first robot wheel assembly and the second robot wheel assembly is performed simultaneously. to be.
즉, 상기 2차 등판전진단계를 거쳐 다음단계의 계단이 나타나지 않으면 제 1 로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 정지시키고, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리(210)만을 상향 리프팅시키는 제 2로봇 차륜리프팅업단계를 시작한다.That is, if the next step does not appear through the second climbing forward step, the endless track portions of the first
상기 제 2로봇 차륜리프팅업단계를 거친 후에는 제 2로봇 차륜어셈브리(210)의 무한궤도부가 계단의 모서리보다 높아졌을 때 제 2로봇 차륜회동기구(230)를 정지시킨 후, 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 구동시켜 제 2로봇 차륜어셈브리(210)가 계단모서리에 걸치도록 전진하는 1차 등판전진단계를 거친다.After the second robot wheel lifting up step, when the endless track portion of the second
그리고 상기 1차 등판전진단계를 거친 후, 제 2로봇 차륜어셈브리(210)가 계단모서리에 걸쳐 졌을 때, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 하향리프팅시키되, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 전위차계값이 같아 졌을 때까지 하향리프팅하는 리프팅다운단계를 거친다.After the first climbing step, when the second
상기 리프팅다운단계를 거쳐 제 1로봇 차륜어셈브리(110)와 제 2로봇 차륜어셈브리(210)가 모두 수평이 되었을 때, 제 2로봇 차륜회동기구(230)를 정지시키고 제 1로봇 치륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하는 2차 등판전진단계를 차례로 거쳐 장애물을 등판하는 것이다.When both the first
이는 도 18의 진행과정이다.This is the process of FIG. 18.
다음은 장애물극복단계중 하나인 계단 내려오기 과정을 설명한다.The following describes the process of descending the stairs, which is one of the obstacle avoidance steps.
계단내려오기 과정은 제 1로봇 차륜어셈브리(110)의 장애물 하강과정, 제 1 로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 장애물 동시 하강과정, 제 2로봇 차륜어셈브리(210)의 장애물 하강과정을 거쳐 진행된다.The step down process includes the obstacle lowering process of the first
먼저, 제 1로봇 차륜어셈브리의 장애물 하강과정은 도 13에서 보는 바와 같이 센싱수단(170)에 의해 하강할 계단에 도달하면, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 장애물 앞까지 전진하는 단계와, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 장애물 앞까지 전진하되, 제 1로봇 차륜어셈브리(110)의 바닥감지센서가 OFF될때 까지 전진하는 하강예비전진단계와, 상기 하강예비전진단계를 거친 후, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 하향 리프팅시키되, 제 1로봇 차륜어셈브리(110)가 바닥에 닿을 때까지 하향리프팅시키는 리프팅다운단계를 거친다.First, when the obstacle descending process of the first robot wheel assembly reaches the stairs to descend by the sensing means 170 as shown in FIG. 13, the endless track parts of the first robot wheel assembly and the second robot wheel assembly are shown. Driving both the front and the front of the obstacle, and driving both the endless track portions of the first robot wheel assembly and the second robot wheel assembly to advance to the obstacle, but the bottom of the first
상기 리프팅다운단계를 거친 후, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 구동바퀴들을 모두 구동시켜 장애물 앞까지 전진하되, 제 2로봇 차륜어셈브리(210)의 바닥감지센서가 ON될때 까지 전진하는 하강전진단계를 거친다.After the lifting down step, the driving wheels of both the first robot wheel assembly and the second robot wheel assembly are driven to the front of the obstacle, but when the bottom sensor of the second
상기 하강전진단계를 거친 후, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 상향 리프팅시키되, 제 1로봇 차륜어셈브리(110)가 바닥에 닿을 때까지 상향리프팅시키는 제 1로봇 차륜 리프팅업단계를 거치고, 제 1로봇 차륜 리프팅업단계를 거친 후에는 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 다음 계단 앞까지 전진하는 2차 하강전진단계를 차례로 거치는 것이다.After the descending forward step, driving the first robot
이어서, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 장애물 동시 하강과정은 도 14에서 보는 바와 같이 상기 제 1로봇 차륜어셈브리의 장애물 하강과정을 거친 다음 단계이다.Subsequently, the obstacle lowering process of the first robot wheel assembly and the second robot wheel assembly are the next steps after the obstacle lowering process of the first robot wheel assembly as shown in FIG. 14.
즉, 상기 2차 하강전진단계를 거쳐 다음단계의 계단이 나타나면 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 정지시키고, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 하향 리프팅시키는 제 2로봇 차륜리프팅다운단계로부터 시작한다.That is, when the next step is passed through the second descending forward step, all the track parts of the first
상기 제 2로봇 차륜리프팅다운단계를 거친 후, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하되, 제 1로봇 차륜어셈브리(110)의 바닥감지센서가 OFF될때 까지 전진하는 2차 하강예비전진단계를 거치고, 2차 하강예비전진단계를 거친 다음에는 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 정지시키고, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 하향 리프팅시키는 제 1로봇 차륜리프팅다운단계를 거친다.After the second robot wheel lifting down step, both of the endless track portions of the first robot wheel assembly and the second robot wheel assembly are driven to move forward, but the bottom sensor of the first
그리고 상기 제 1로봇 차륜리프팅다운단계를 거친 다음에는 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하되, 제 2로봇 차륜어셈브리(210)의 바닥감지센서가 OFF될때 까지 전진하는 3차 하강예비전진단계, 3차 하강예비전진단계를 거친 후, 제 1로봇 차륜회동기구(130)를 구동시켜 제 1로봇 차륜어셈브리를 상향 리프팅시키되, 제 1로봇 차륜어셈브리(110)가 바닥 에 닿을 때까지 상향리프팅시키고, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 상향 리프팅시키되, 제 2로봇 차륜어셈브리(210)가 바닥에 닿을 때까지 상향리프팅시키는 제 1로봇 차륜/제 2로봇 차륜 리프팅업단계를 모두 거치는 것이다.After the first robot wheel lifting down step, all of the endless track portions of the first robot wheel assembly and the second robot wheel assembly are driven to move forward, but the bottom sensing sensor of the second
또한, 제 2로봇 차륜어셈브리의 장애물 하강과정은 도 15에서 보듯이 상기 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 장애물 동시 하강과정을 거친 다음이며, 이 상태에서 다음단계의 계단이 나타나지 않으면 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 정지시키고, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 하향 리프팅시키는 제 2로봇 차륜리프팅다운단계, 그리고 상기 제 2로봇 차륜리프팅다운단계를 거친 후, 제 1로봇 차륜어셈브리 및 제 2로봇 차륜어셈브리의 무한궤도부들을 모두 구동시켜 전진하되, 제 1로봇 차륜어셈브리(110)의 바닥감지센서가 OFF될때 까지 전진하는 하강예비전진단계를 거친다.In addition, the obstacle lowering process of the second robot wheel assembly is after the obstacle lowering process of the first robot wheel assembly and the second robot wheel assembly as shown in Figure 15, the step of the next step in this state If it does not appear, all the track parts of the first
이어서, 하강예비전진단계를 거친 후, 제 2로봇 차륜회동기구(230)를 구동시켜 제 2로봇 차륜어셈브리를 상향 리프팅시키되, 제 2로봇 차륜어셈브리(210)가 바닥에 닿을 때까지 상향리프팅시키는 제 2로봇 차륜 리프팅업단계를 거친다.Subsequently, after the descending preliminary advance step, the second
이와 같이 하여 계단 하강이 끝나면 제 1로봇 차륜어셈브리(110) 및 제 2로봇 차륜어셈브리(210)의 무한궤도부들을 모두 구동시켜 다시 정상주행하는 정상전진단계로 가는 것이다.In this manner, when the stairs are lowered, all of the endless track parts of the first
상기한 바와 같이 본 발명은 한 쌍의 무한궤도부를 갖춘 복수의 로봇이 평상시 개별적으로 정찰 및 탐사임무를 수행하다 어느하나가 장애물을 만날경우 두 로봇이 서로 합체하여 장애물을 극복한 후 다시 분리되어 정찰 및 탐사임무를 수행하게 하므로서 신속한 이동성과 제작 및 운영이 경제적인 효과가 있다.As described above, in the present invention, a plurality of robots having a pair of tracked tracks normally perform reconnaissance and exploration missions individually. If any one encounters an obstacle, the two robots merge with each other to overcome the obstacle, and then separate and reconnaissance. And exploration missions enable economical and rapid mobility and production and operation.
Claims (2)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020060001350A KR20070073437A (en) | 2006-01-05 | 2006-01-05 | The combine of stair climbing robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020060001350A KR20070073437A (en) | 2006-01-05 | 2006-01-05 | The combine of stair climbing robot |
Publications (1)
Publication Number | Publication Date |
---|---|
KR20070073437A true KR20070073437A (en) | 2007-07-10 |
Family
ID=38508038
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020060001350A KR20070073437A (en) | 2006-01-05 | 2006-01-05 | The combine of stair climbing robot |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR20070073437A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100915801B1 (en) * | 2008-12-12 | 2009-09-07 | 동국대학교 산학협력단 | Docking system and method for cooperating mobile robots |
WO2011129572A2 (en) * | 2010-04-13 | 2011-10-20 | 주식회사 한울로보틱스 | Tracked robot which adapts easily to terrain |
KR20190097885A (en) * | 2018-02-13 | 2019-08-21 | 영남대학교 산학협력단 | Climbing robot and climbing method using it |
KR102585469B1 (en) * | 2023-04-03 | 2023-10-05 | 동명대학교산학협력단 | Logistics transport system with picking robot |
-
2006
- 2006-01-05 KR KR1020060001350A patent/KR20070073437A/en active IP Right Grant
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100915801B1 (en) * | 2008-12-12 | 2009-09-07 | 동국대학교 산학협력단 | Docking system and method for cooperating mobile robots |
WO2011129572A2 (en) * | 2010-04-13 | 2011-10-20 | 주식회사 한울로보틱스 | Tracked robot which adapts easily to terrain |
WO2011129572A3 (en) * | 2010-04-13 | 2012-01-26 | 주식회사 한울로보틱스 | Tracked robot which adapts easily to terrain |
KR20190097885A (en) * | 2018-02-13 | 2019-08-21 | 영남대학교 산학협력단 | Climbing robot and climbing method using it |
KR102585469B1 (en) * | 2023-04-03 | 2023-10-05 | 동명대학교산학협력단 | Logistics transport system with picking robot |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108556938B (en) | All-terrain robot | |
KR20070073437A (en) | The combine of stair climbing robot | |
CN103459771B (en) | For continuous opencast conveyer system | |
EP1338548B1 (en) | Passenger conveyor device | |
US8162083B2 (en) | Crawler device and automatic attitude control of the same | |
EP0517920B1 (en) | Driving mechanism of motor vehicle conveying truck for multistory parking system | |
KR100477044B1 (en) | The stair climbing robot and traveling method | |
JP5978422B2 (en) | Crawler travel device | |
JP2014019210A (en) | Crawler traveling type searching robot | |
CN108556939B (en) | All-terrain mobile detection robot | |
CN110860544A (en) | Bridge type continuity of operation's photovoltaic cleaning machines people is crossed to biped | |
CN110882967A (en) | Photovoltaic cleaning robot of continuity of operation | |
CN110882969A (en) | Photovoltaic cleaning robot capable of automatically walking along bridge floor | |
US20220043450A1 (en) | Systems and methods of operating automatic swimming pool cleaners, especially when approaching walls or other objects | |
CN201619622U (en) | Robot composite chassis | |
CN112529495B (en) | Community logistics distribution method and robot | |
CN106567570A (en) | Automatic vehicle moving device | |
CN211163975U (en) | Photovoltaic cleaning robot capable of automatically cleaning | |
CN110919666A (en) | Photovoltaic cleaning robot capable of automatically cleaning | |
KR20160059238A (en) | Driving Apparatus | |
CN211275613U (en) | Photovoltaic cleaning robot capable of automatically walking along bridge floor | |
CN1321251C (en) | Stereo parking appts. | |
CN110304172B (en) | Mechanical device with obstacle crossing and moving functions | |
KR200175543Y1 (en) | Apparatus for going up stairs | |
JP7434650B1 (en) | Passenger conveyor system and moving objects |
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 | ||
NORF | Unpaid initial registration fee |