Microsoft Word - 12_최병욱

Size: px

Start display at page:

Download "Microsoft Word - 12_최병욱"

민좌 이
8 years ago
Views:

1 Journal of Insiue of Conrol, Roboics and ysems (215) 21(5): hp://dx.doi.org/1.532/j.icro IN: ein: 이동로봇의 바퀴 속도 제한을 고려한 최대 속도궤적 생성 방법 Maximum Velociy Trajecory Planning for Mobile Robos Considering Wheel Velociy Limi 양 길 진, 최 병 욱 * (Gil Jin Yang 1 and Byoung Wook Choi 2,* ) 1 Graduae chool in Dep. of Elecrical Engineering, eoul Naional Universiy of cience and Technology 2 Dep. of Elecrical Engineering, eoul Naional Universiy of cience and Technology Absrac: This paper presens a maximum velociy rajecory planning algorihm for differenial mobile robos wih wheel velociy consrain o cope wih physical limis in he join space for wo-wheeled mobile robos (TMR). In previous research, he convoluion operaor was able o generae a cenral velociy ha deals wih he physical consrains of a mobile robo while considering he heading angles along a smooh curve in erms of ime-dependen parameer. However, he velociy could no rack he predefined pah. An algorihm is proposed o compensae an error ha occurs beween he acual and driven disance by he velociy of he cener of a TMR wihin a sampling ime. The velociy commands in Caresian space are also convered o acuaor commands o drive wo wheels. In he case ha he acuaor commands exceed he maximum velociy he rajecory is redeveloped wih he compensaed cener velociy. The new cener velociy is obained according o he curvaure of he pah o provide a maximum allowable velociy meaning a ime-opimal rajecory. The effeciveness of he algorihm is shown hrough numerical examples. Keywords: rajecory planning, ime-opimal rajecory, convoluion operaor, wheel velociy limi, mobile robos I. 서론 두 바퀴 이동로봇은 작업공간 내에서 목표 위치까지 이동 하여 주어진 작업을 수행할 수 있는 로봇으로 현재 지능형 서비스로봇, 로봇청소기 그리고 운반로봇 등으로 활용되고 있다. 이러한 이동로봇의 주행을 위해서 경로 계획 방법과 궤적 계획 방법, 궤적을 추종하는 추종 제어기 및 구동 제어 기의 연구와 함께 최적의 궤적을 생성하기 위한 연구가 진행 되고 있다[2-8]. 궤적 계획은 미리 알려진 작업공간의 상황 정 보를 이용하여 계획하는 오프라인 방식과 실시간으로 주변 상 황 정보를 인지하여 주행하는 온라인 방식이 있다. 오프라인 방식의 궤적 계획에서는 불확실한 상황 정보에 대한 적응성 이 없으며, 구동기의 동적인 특성을 고려하지 않을 경우 구 동기에서 실제로 추종하기 어려운 궤적이 생성될 수 있다[1]. 반면에 미리 알려진 작업공간내의 상황 정보를 이용하여 최 적의 궤적을 생성할 수 있으며, 시작 점부터 목표 위치까지 이동로봇의 주행을 미리 계획할 수 있다는 장점이 있다[7]. 최근 궤적 계획에서 로봇의 동적인 특성을 고려하기 위한 연구가 진행되고 있으며, 로봇 구동기의 물리적 제한을 고려 하기 위한 방법으로 컨볼루션 (Convoluion) 연산자의 특성을 이용한 궤적 생성방법이 제안되었다[1]. 하지만 이를 두 바퀴 * Corresponding Auhor Manuscrip received December 9, 214 / revised January 5, 215 / acceped January 3, 215 양길진: 서울과학기술대학교 일반대학원 전기공학과 (gjyang@seoulech.ac.kr) 최병욱: 서울과학기술대학교 전기정보공학과 (bwchoi@seoulech.ac.kr) 이 논문은 212년도 정부(교육과학기술부)의 재원으로 한국연구재 단 기초연구사업의 지원을 받아 수행된 연구임(NRF-212R1A1A 2657). 이동로봇에 적용하여 곡선의 경로를 주행할 경우 두 구동기 의 물리적 제한을 만족하지 못한다. 이러한 문제점을 해결하 기 위한 방법으로 곡선경로에 대하여 이동로봇의 물리적 제 한을 고려한 궤적 계획 방법이 선행 연구되었다[4]. 그러나 최소 주행 시간을 이루기 위한 두 바퀴의 최대 허용 속도를 구현하는 방법은 연구되지 않았다. 본 논문에서는 두 바퀴 이동로봇의 궤적 생성과정에서 이 동로봇의 두 바퀴의 물리적인 제한을 고려하여, 로봇의 구동 기가 추종할 수 있는 궤적 생성 방법을 연구한다. 이 때, 이 동로봇의 각 구동기의 최대 허용 속도를 고려하여 최소시간 주행이 가능한 궤적을 생성한다. II. 경로 및 궤적계획 1. 베지어 곡선기반 경로계획 로봇이 목표 위치까지 이동하여 주어진 작업을 수행하기 위해서는 미리 알려진 작업 공간 내의 환경 정보와 함께 로 봇의 상태 정보를 이용한 경로 계획 방법이 필요하다. 로봇 의 상태 정보 중 하나인 로봇의 자세를 고려한 경로 계획 방 법은 시작점과 목표위치에서의 로봇이 바라보고 있는 방향 각을 고려하여 궤적 추종제어기에서 추종 가능한 경로를 생 성 할 수 있다. 이를 위해 본 연구에서는 시작점과 목표점에 서의 방향각을 고려할 수 있으며, 연속적인 베지어 곡선 (Bezier curve)기반 경로 생성방법을 이용한다. 그림 1은 3차 베지어 곡선으로 생성된 경로이며, 다음 식 (1)은 베지어 곡 선의 방정식을 나타낸다. x( u) = x (1 - u) + 3 x u(1 - u) + 3 x u (1 - u) + x u s e y( u) = y (1 - u) + 3 y u(1 - u) + 3 y u (1 - u) + y u s e (1) Copyrigh ICRO 215

2,* ) 1 Graduae chool in Dep. of Elecrical Engineering, eoul Naional Universiy of cience and Technology 2 Dep.

2 466 Gil Jin Yang 양 길 and 진, Byoung 최 병 욱 Wook Choi y axis End poin θ f d 2 c 1 c 2 d 1 θ i ar poin 그림 1. 베지어 곡선 기반 -곡선 경로. Fig. 1. The -curve pah based on Bezier curve. x axis 그림 2. 컨볼루션 연산 기반 이동로봇의 중심 속도궤적. Fig. 2. The rajecory of mobile robo s cener velociy based on convoluion operaion. 여기서 x 1, y 1, x 2, y 2 는 제어점 c 1, c 2 의 좌표를 나타내며, 시작점 (x s, y s, θ s )에서 목표점 (x e, y e, θ e ) 까지의 경로를 나타낸다. 식 (1)에서 u는 u 1 의 값이며, 곡선 경로의 파라미터를 나 타낸다. 곡률 κ(u)는 베지어 곡선의 파라미터 u에대하여 식 (2)의 미분방정식으로 나타낼 수 있다. 1 x ( u) y ( u) - y ( u) x ( u) k ( u) = = r( u) x ( u) y ( u) 2 2 ( + ) 3 2 ìx1 = xs + d1 cosqs îy1 = ys + d1 sinqs ìx2 = xe + d2 cos(18 + qe) îy2 = ye + d2 sin(18 + qe) (2) (3) (4) 식 (3)과 (4)는 제어점 c 1 (x 1, y 1 )과 c 2 (x 2, y 2 )를 결정하는 식이 며, d 1, d 2 를 결정하는 방법에 따라 경로의 곡률이 결정된다. 변수 d 1, d 2 결정 방법은 이동로봇의 접선가속도 제한을 고려 하는 방법을 이용하였다[2]. 이는 시작점과 목표점에서 이동 로봇의 속도에 따른 접선 가속도 제한을 고려한 경로를 생성 할 수 있는 방법이다. 제어점을 찾은 후 식 (1)에 의해 베지 어 곡선의 경로를 파라미터화 할 수 있다. 2. 컨볼루션 기반 궤적 계획 파라미터화된 경로는 시작점부터 목표점까지의 이동로봇 이 주행할 위치를 나타내지만 시간에 따른 위치정보인 속도 정보는 없다. 이동로봇이 생성된 경로를 추종하기 위해서는 속도정보를 포함한 궤적 생성 방법이 필요하다. 로봇의 궤적 생성방법으로는 컨볼루션 연산자의 특성을 이용한 물리적 제한을 만족하는 궤적 생성 방법을 기반으로 한다[1]. 컨볼루션 기반 궤적 생성방법은 컨볼루션 연산의 특성을 이용하며 두 번의 연산을 통해 구동기의 가속도와 저크를 고 려, 최대 속도궤적을 생성하는 방법이다. 다음 식 (5)의 y ()는 물리적 제한을 고려하지 않고 일정한 속도 v 로 이동거리 만큼 이동하기 위한 사각파형 함수를 나타낸다. 이 때 = /v 이다. y ( ) ìv,, oherwise = (5) î 컨볼루션 연산은 y n ()와 h n ()의 컨볼루션이며, n = [, 1, 2] 일 때 구동기의 물리적 제한을 만족하는 속도궤적을 생성한다. h n ()는 사각파형 함수로 n 의 구간에서 다음 식 (5)와 같이 정의한다. y 1 ()는 y ()와 h 1 ()의 컨볼루션으로 가속도를 고려하기 위한 컨볼루션이며, y 2 ()는 y 1 ()와 h 2 ()의 컨볼루션 으로 가속도가 고려된 속도궤적 y 1 ()에서 저크를 고려하기 위한 컨볼루션이다. 도, 식 (6)에서 ì1/ n, n hn ( ) = (5) î, oherwise where, v n = (6) v ( n-1) max n max () vmax 는 구동기의 최대 속도, (1) vmax 는 최대 가속 (2) vmax 는 최대 저크를 나타낸다. 로봇의 구동기의 최대 속 도궤적을 생성하기 위한 v = v 이며, 2번의 컨볼루션 연산 () max 을 통해 물리적 제한이 고려된 미분 가능한 -곡선의 속도궤 적이 생성된다. 일반적인 로봇의 제어시스템은 일정한 샘플링 주기로 속 도명령을 처리함으로 컨볼루션 연산은 다음 식 (7)과 (8)의 디지털 컨볼루션 식을 이용한다[1]. y [ k] - y [ k - m ] y k = + - (7) n-1 n-1 n n[ ] yn[ k 1], mn k = [1 T ], m = [ T ], (8) s n n s 여기서 T s 는 샘플링 시간, [x]는 가우스 양자화 기호로 x보다 크지 않은 최대 정수를 나타내며, 위의 디지털 컨볼루션의 결과는 샘플링 시간에 따른 오차가 발생할 수 있다. 그림 2는 이동거리 = 4.63 m, v max =.5 m/s, a max =.2 m/s 2, j max =.2 m/s 3 일 때, 컨볼루션 연산 결과 이동로봇 중심의 속 도궤적을 나타내며 미분 가능한 -곡선의 속도궤적 y 2 ()이다. 3. 경로궤적 생성 방법 컨볼루션 연산자 기반 궤적 생성방법은 이동거리와 속도, 가속도, 저크를 기반으로 속도궤적을 생성하며, 이 때 이동로 봇의 방향각은 고려되지 않는다. 이동로봇의 물리적 제한과 방향각을 고려하기 위해서는 새로운 경로궤적의 생성이 필 요하며, 베지어 곡선의 매개변수 u를 결정하는 방법으로 경 로궤적을 생성하는 방법이 제안되었다[3]. 베지어 곡선의 경로에 대한 중심속도궤적을 생성하기 위 하여 식 (1)에 일정 매개변수 변위 du를 사용하여 생성된 경

여기서 x 1, y 1, x 2, y 2 는 제어점 c 1, c 2 의 좌표를 나타내며, 시작점 (x s, y s, θ s )에서 목표점 (x e, y e, θ e ) 까지의 경로를 나타낸다. 식 (1)에서 u는 u 1 의 값이며, 곡선 경로의 파라미터를 나 타낸다.

3 Maximum Velociy 이동로봇의 Trajecory Planning 바퀴 속도 for 제한을 Mobile 고려한 Robos 최대 Considering 속도궤적 Wheel 생성 방법 Velociy Limi 467 로를 R(u)라고 정의하며, 시작점부터 목표점까지의 경로 R(u) 의 길이 b 는 다음 식 (9)와 같이 정의한다. b = 1 ò R( u) du (9) R( u) = x ( u) + y ( u) 2 2 베지어 곡선의 매개변수 u를 결정하는 방법은 b 를 계산하 고, 컨볼루션기반 속도궤적의 이동거리 가 b 와 일치하도록 속도함수 y 2 ()를 생성한다. 생성된 y 2 ()의 적분과 b 를 이용하 여 에서 1까지의 범위로 속도함수를 변환하며, 식 (1)과 같 이 나타낼 수 있다. n ò y 2( ) u( n) = (1) 식 (1)에의하여 매개변수는 시간의 함수로 나타낼 수 있 으며, u( n )은 u() 1 구간에서 정의 된다. 이는 중심속도궤 적의 시간에 따른 이동거리를 고려하여 매개변수의 증가량 을 결정하는 것과 같은 의미이다. 매개변수 u()를 식 (1)에 대입하여 생성된 경로 R(u())는 물리적 제한인 속도, 가속도, 저크가 고려되었으며, R(u)를 시간의 함수로 나타낸 경로궤적 이다. 주어진 속도를 이용하여 이동로봇이 실제 주행하게 될 경로궤적을 생성하기 위해서는 베지어 곡선으로부터 방향각 을 식 (11)과 같이 계산하여 식 (12)와 (13)을 통해 실제 주행 하게 될 궤적을 계산할 수 있다. 1 æ y ( u( )) ö qc( ) = an ç è x ( u( )) ø b - v ( ) = v ( )cos( q ( )) x c c v ( ) = v ( )sin( q ( )) y c c x ( ) = v ( ) c y ( ) = v ( ) c ò ò x y (11) (12) (13) 그림 3은 이동로봇이 시작점 (,, )에서 목표점 (2, 4, ) 까지 계획된 베지어 곡선의 경로와 컨볼루션 연산으로 생성 된 속도궤적 y 2 ()를 수식 (12)의 v c ()로 하여 계산된 경로궤적 이다. 즉 중심속도는 컨볼루션에 의하여 만들어지고 로봇의 그림 3. 이동로봇 중심의 물리적 제한이 고려된 경로궤적. Fig. 3. The pah rajecory considering physical limi of mobile robo s cener. 그림 4. 에러 보정 u()에 의해 생성된 경로궤적. Fig. 4. Pah rajecory according o he error considered u(). 방향각 정보는 수식 (12)을 통하여 만들어진 경로이다. 생성 된 경로궤적의 마지막 점의 좌표는 (2.287, 3.745, )으로 기준 경로를 추종하지 못하며, 큰 오차를 갖는다. 이는 시간의 함 수로 생성된 베지어 곡선인 R(u())가 계획된 경로와 일치 하 지 못하여 발생하는 오차이다. 본 연구에서는 보다 정밀한 경로궤적을 생성하기 위해 u() 를 결정하는 방법을 제안한다. 수식 (1)에 의하여 y 2 ()를 통 해 계산된 u()와 u()에 의해 생성된 시간의 함수인 경로 R(u())를 이용하여 단위 시간 du = u( n ) u( n-1 ) 에서 곡률에 따른 에러를 보정하는 방식을 제안한다. ò n R( uk ( n)) n-1 e( n) = u( n) - (14) b u ( ) ( ) ( ) k + 1 n = uk n + e n (15) 식 (14)와 (15)를 이용하여 속도궤적에 적합한 경로궤적을 생성할 수 있는 u()를 계산한다. 여기서 k = [, 1, 2, 3, ]의 자연수로 보정 횟수를 의미한다. u ()는 식 (1)을 이용해 처 음 계산된 매개변수이며, 식 (14)는 u ()와 u k ()에 의해 생성 된 경로의 오차를 나타내는 에러 값이다. 최적의 경로궤적을 얻기 위한 u()로 max( e() ) <.5를 만족할 때까지 보정을 수행하며 보정횟수에 따른 경로궤적은 그림 4에 나타내었다. 그림 4는 최종적으로 결정된 u()에 의해 생성된 경로궤적 을 나타낸다. 제안된 방법을 통해 k = 3일 때까지 수행되었으 며, 생성된 궤적의 마지막 점의 좌표는 (2.4, 3.993, )으로 기준경로에 매우 근접하게 경로궤적이 생성되는 것을 확인 할 수 있다. III. 두 바퀴 이동로봇의 바퀴 속도 제한을 고려한 궤적 계획 1. 두 바퀴 이동로봇의 기구학 물리적 제한을 만족하는 속도궤적은 이동로봇의 중심을 기준으로 생성되었으며, 이를 이동로봇의 속도 명령으로 인 가하기 위해서는 두 바퀴 이동로봇의 기구학을 고려하여 관 절공간에서 두 바퀴의 속도명령으로 변환해 주어야 한다. 이동로봇의 위치는 전역 기준 좌표계와 로봇기준 좌표계 로 구성되며, 그림 5에서와 같이 X Y 직교 좌표계에서 이동 로봇의 파라미터들을 나타낼 수 있다. 이동로봇의 위치와 방

생성된 y 2 ()의 적분과 b 를 이용하 여 에서 1까지의 범위로 속도함수를 변환하며, 식 (1)과 같 이 나타낼 수 있다. n ò y 2( ) u( n) = (1) 식 (1)에의하여 매개변수는 시간의 함수로 나타낼 수 있 으며, u( n )은 u() 1 구간에서 정의 된다.

4 468 양 길 진, 최 병 욱 Y axis v l v c y c P c v r θ c 향각을 나타내는 P c 는 전역 기준 좌표계 상에서 다음 식 (16)과 같이 정의 된다. P = [ x, y, q ] T (16) c c c c 여기서 x와 y는 이동로봇의 위치를 나타내는 변수이며, θ R 은 이동로봇의 방향각을 나타낸다. 직교 좌표계 (Caresian coordinae)에서 이동로봇의 기구학은 식 (17)과 같이 나타낼 수 있으며, 이동로봇의 선속도는 식에 의해 시간의 함수로 표현이 가능하다. X axis é r r ù ê cosqc cosqc 2 2 ú évx ù ê ú r r é wr ù Pc = ê v ú ê y sinqc sinq ú ê ú = ê c 2 2 ú ê w ú l êw ë û ë ú c û ê ú ê r r - ú êë D D úû (17) 식 (17)에서 r은 바퀴의 반지름을 의미하고, D는 이동로봇 두 바퀴 사이의 거리를 의미한다. ω r 은 오른쪽 바퀴의 회전속 도, ω l 은 왼쪽 바퀴의 회전속도이다. 각 바퀴의 회전속도와 바퀴의 반지름을 이용하여 이동로봇의 각 구동 바퀴의 각속 도를 식 (18)과 같이 계산할 수 있으며, 두 바퀴의 선속도는 식 (19)로 계산할 수 있다. x c 그림 5. 직교 좌표계에서 두 바퀴 이동로봇의 파라미터. Fig. 5. The parameers of wo-wheeled mobile robo in Caresian coordinaes. 그림 6. 두 바퀴 이동로봇의 속도 명령. Fig. 6. The velociy commands for wo-wheeled mobile robo. 속도는 이동로봇 중심의 최대 속도인.5 m/s를 초과하는 속 도 명령이 존재하는 것을 확인할 수 있다. 2. 두 바퀴의 속도 제한을 고려한 궤적 계획 방법 차분 구동형 두 바퀴 이동로봇의 최대 속도는 일반적으로 두 바퀴 모두 최대 속도로 구동 되어 직선 주행을 하는 경우 의 속도를 의미하며, 곡선 주행에서 두 바퀴는 최대 속도를 넘는 속도명령은 구동기가 추종할 수 없다. 그림 6에서 이동 로봇의 기구학에 의해 생성된 두 바퀴의 속도 명령은 미리 설정된 최대속도.5 m/s를 만족하지 못하며, 이는 이동로봇 의 속도명령으로 적합하지 않다. 이러한 문제점을 해결하기 위한 방법으로 최대 속도를 재 설정하여 속도궤적의 전반적 인 속도를 작게 생성하는 방법이 선행 연구되었다[4]. 하지만 이 방법은 주행시간이 크게 증가하는 단점이 있다. 본 연구에서는 두 바퀴 이동로봇의 각 구동 바퀴의 물리적 제한을 만족하도록 두 바퀴의 최대 허용속도를 고려한 최대 속도궤적을 생성하기 위한 방법을 제안한다. 다음 식 (2)은 곡 선 경로의 곡률과 이동로봇의 두 바퀴 사이의 거리에 의해 물 리적 제한을 만족하지 못하는 v c ()를 보정하기 위한 식이다. D vc( ) ( ) = vc ( ) - sgn( k ( )) wc( ) (2) 2 식 (2)의 κ()는 u()에 의해 생성된 경로궤적의 곡률을 의 미하며 식 (2)에 의해 계산된다. v c() ()는 보정된 이동로봇의 중심속도이며, 그림 7은 v c() ()와 이를 기반으로 계산된 두 ì 1 æ D ö wr = ç vc + wc ï r è 2 ø ï 1 æ D ö wl = vc - wc ï ç î r è 2 ø ì D vr = r wr = vc + wc ï 2 ï D vl r wl vc wc ïî = = - 2 (18) (19) 이동로봇의 두 바퀴의 선속도는 이동로봇 중심의 속도인 v c 를 기준으로 방향각에 따라 다른 값을 갖게 된다. 그림 6은 속도 제한을.5 m/s로 가정하여 컨볼루션 연산 기반으로 생 성된 속도궤적 y 2 ()와 이동로봇의 기구학을 이용해 계산된 두 바퀴의 선속도 v r (), v l ()를 나타낸다. 계산된 두 바퀴의 선 그림 7. 두 바퀴의 물리적 제한을 고려한 속도 명령. Fig. 7. Velociy commands considering wo wheels velociy limis.

X axis é r r ù ê cosqc cosqc 2 2 ú évx ù ê ú r r é wr ù Pc = ê v ú ê y sinqc sinq ú ê ú = ê c 2 2 ú ê w ú l êw ë û ë ú c û ê ú ê r r - ú êë D D úû (17) 식 (17)에서 r은 바퀴의 반지름을 의미하고, D는 이동로봇 두 바퀴 사이의 거리를

5 이동로봇의 바퀴 속도 제한을 고려한 최대 속도궤적 생성 방법 469 (a) Convoluion-based. 그림 8. 이동거리 가 고려된 두 바퀴 이동로봇의 속도 명령. Fig. 8. Velociy commands considering he disance of for wowheeled mobile robo. (b) Wheel velociy limi consideraion. 바퀴의 속도궤적이다. 이동로봇 중심과 두 바퀴의 속도궤적 모두 물리적 제한을 만족하는 것을 확인할 수 있다. 그림 6과 그림 7에서 주행 시간은 동일하게 나타나며 속 도가 변화된 것은 결론적으로 보정된 중심속도궤적 v c() ()의 이동거리 가 v c ()의 이동거리 보다 적은 거리를 이동하는 것을 의미한다. 따라서 계획된 경로를 추종하기 위하여 와 가 같은 이동거리를 갖도록 하기 위해 식 (21)에 의해 샘 플링 시간 T s 의 비율을 조정한다. T s. = = nt Ts s. (21) 여기서 T s. 는 보정된 샘플링 시간, n은 속도궤적의 샘플의 수, 는 보정된 시간이다. 본 연구는 시작점 (,, )에서 목 표점 (4, 2, )까지 이동하는 경우 베지어 곡선의 d 1 과 d 2 는.883 m이며, 이동거리는 = 4.63 m이다. 이 때 T s 는.1 s, = s로 보정 전 n = 1278이다. 이 때 = 4.92 m이며, 식 (14)에 의해 보정된 시간은 s가 되며, n = 1446이다. 그림 8은 이동거리 를 고려하여 샘플링 시간이 보정된 두 바퀴 이동로봇의 속도 명령이며, 그림 7과 비교하여 주행 시간이 증가하였다. 이는 속도 명령의 면적인 거리를 동일하 게 하기 위해 그림 7의 낮아진 속도에 따라 주행 시간이 증 가된 것을 알 수 있다. 이 때, 속도 명령의 샘플링 주기는 식 (14)에 의해 s로 일정한 샘플링 시간을 갖지만 일반 적인 제어시스템에서 사용하는 샘플링 주기를 위해서 본 연 구에서는 선형 보간법 (Linear inerpolaion)으로.1 s 주기의 샘플링 시간에서 속도 값을 추정하여 실제 이동로봇의 속도 명령에 사용한다. 이 때 보간된 속도궤적과 함께 곡선 경로 의 θ 또한 선형보간법을 적용하여 식 (21)을 통해 두 바퀴의 속도궤적을 생성해야 한다. 보간된 속도와 각도는 보간법 오 차가 발생하지만 그림 8의 속도 명령과 거의 일치한다. IV. C-곡선 경로의 속도궤적 베지어 곡선의 경우 목표 위치에서 이동로봇의 방향각을 고려하여 경로를 생성 하며, 방향각에 따라 주행경로는 직 선 또는 C, 형태의 곡선으로 이루어 진다. 이 장에서는 C 형태의 곡선 경로에서 제안된 방법에 의해 속도궤적을 확인한다. (c) Adjusing Ts raio. 그림 9. C-곡선 경로에서의 속도궤적. Fig. 9. Velociy rajecory for C-curve pah. 그림 9는 시작점 (,, )에서 목표점 (2, 4, 9 )까지 이동로 봇의 주행을 계획할 경우 C 형태의 곡선 경로에 대한 속도 궤적이다. 그림 (a)와 같이 C-곡선의 경로에 대한 속도궤적에 서도 컨볼루션 기반의 궤적 계획을 통해서는 각 바퀴의 물리 적 제한을 모두 만족하지 못한다. 그림 (b)와 같이 속도를 조 절하면 실제 경로를 추종하지 못하며, 각 바퀴의 속도 제한 을 고려하기 위해 -곡선의 궤적 계획 방법과 동일한 방법으 로 그림 (c)와 같은 속도궤적을 생성해야 하며, 생성된 속도 궤적에 대하여 경로궤적을 생성해야 한다. 제안된 방법으로 생성된 경로궤적은 그림 1에 나타내었으며, 생성된 경로궤 적은 기준 경로와 매우 근사한 궤적을 갖는다. 그림 1. 수치적으로 계산된 경로궤적 (C-curve pah). Fig. 1. Numerically compued rajecory for C-curve pah.

그림 6과 그림 7에서 주행 시간은 동일하게 나타나며 속 도가 변화된 것은 결론적으로 보정된 중심속도궤적 v c() ()의 이동거리 가 v c ()의 이동거리 보다 적은 거리를 이동하는 것을 의미한다. 따라서 계획된 경로를 추종하기 위하여 와 가 같은 이동거리를 갖도록 하기 위해 식 (21)에 의해 샘 플링 시간 T s 의 비율을 조정한다. T s. = = nt Ts s.

6 47 Gil Jin Yang 양 길 and 진, Byoung 최 병 욱 Wook Choi V. 결론 본 논문 이동로봇의 두 바퀴의 속도 제한을 고려한 최대 속도궤적 생성 방법을 제안하였다. 물리적 제한을 만족하기 위하여 컨볼루션 기반 속도궤적 생성방법을 사용하였으며, 베지어 곡선의 경로를 추종하기 위한 매개변수 결정 방법으 로 기존에 제안된 매개변수를 시간의 함수로 변환하는 방법 에서 오차를 보정하는 방법을 제안하였다. 제안된 베지어 곡선의 매개변수를 결정하는 방법은 기존 의 매개변수를 시간의 함수로 변환하는 방법에서 매개변수 에 의해 생성되는 경로궤적을 주어진 속도궤적에 적합하도 록 생성하는 방법이며, 기존의 방법보다 정확히 경로를 추종 할 수 있다. 본 연구에서 적용된 속도궤적 생성방법은 컨볼루션 연산 자의 특성을 기반으로 두 바퀴 이동로봇의 구동기에서 주행 가능한 최대 속도궤적을 생성하는 방법이며, 곡선 경로에서 물리적 제한을 만족하지 못하는 구간에 대하여 곡선의 방향 각을 고려하여 속도제한을 만족하는 속도궤적을 생성하였다. 이는 두 바퀴 이동로봇의 구동기에서 실제로 구동 가능한 속 도궤적으로 이동로봇의 속도명령으로 사용이 가능하다. 또한 제안된 속도궤적은 구동기의 최대 허용속도를 고려하여 최 소 주행시간으로 주행이 가능하다. REFERENCE [1] G. Lee, D. Kim, and Y. Choi, Faser and smooher rajecory generaion considering physical sysem limis under disconinuously assigned arge angles, IEEE Inernaional Conference on Mecharonics and Auomaion, pp , Aug [2] K. G. Jolly, R.. Kumar, and R. Vijayakumar, A bezier curve based pah planning in a muli-agen robo soccer sysem wihou violaing he acceleraion limis, Roboics and Auomaion ysems, vol. 57, pp , Jan. 29. [3] G. J. Yang and B. W. Choi, mooh rajecory planning along bezier curve for mobile robos wih velociy consrains, Inernaional Journal of Conrol and Auomaion, vol. 6, no. 2, pp , Apr [4] G. J. Yang and B. W. Choi, Join space rajecory planning considering physical limis for wo-wheeled mobile robos, Journal of Insiue of Conrol, Roboics and ysems (in Korean), vol. 19, no. 6, pp , Jun [5] J. H. Han,. H. Park, D. H. Lee, K. W. Noh, and J. M. Lee, A mobile robo esimaing he real-ime moving sound sources by using he curvaure rajecory, Journal of Insiue of Conrol, Roboics and ysems (in Korean), vol. 2, no. 1, pp , 214. [6] J. H. Koh, G. J. Yang, and B. W. Choi, Elderly assisance sysem developmen based on real-ime embedded linux, Journal of Insiue of Conrol, Roboics and ysems (in Korean), vol. 19, no. 11, pp , 214. [7]. Y. Lee,. H. Lee, and Y.. Hong, A real-ime collision-free rajecory planning and conrol for a car-like mobile robo, Journal of Conrol, Auomaion and ysem Engineering (in Korean), vol. 5, no. 1, pp , Jan [8] M. Brezak and I. Perovic, Time-opimal rajecory planning along predefined pah for mobile robos wih velociy and acceleraion consrains, IEEE/AME In. Conf. on Advanced Inelligen Mecharonics, Budapes, Hungary, pp , 211. 최 병 욱 1988년~1992년 한국과학기술원 전기및 전자공학과 석사 및 박사졸업. 1988년 ~2년 LG산전 중앙연구소 책임연구 원. 2년~25년 선문대학교 제어계측 공학과 부교수. 23년~25년 임베디드 웹 대표이사. 27년~28년 Nanyang Technological Universiy, enior Fellow. 25년~현재 서울과학기 술대학교 전기정보공학과 교수. 관심분야는 실시간 시스템 설계, 임베디드 시스템, 임베디드 리눅스, 지능형 로봇 소프 트웨어. 양 길 진 213년 원광대학교 전자공학과 졸업. 215년 서울과학기술대학교 전기공학과 석사졸업. 215년~현재 세연테크 연구원. 관심분야는 실시간 시스템 설계, 임베 디드 리눅스, 지능형 로봇 소프트웨어.

제안된 베지어 곡선의 매개변수를 결정하는 방법은 기존 의 매개변수를 시간의 함수로 변환하는 방법에서 매개변수 에 의해 생성되는 경로궤적을 주어진 속도궤적에 적합하도 록 생성하는 방법이며, 기존의 방법보다 정확히 경로를 추종 할 수 있다.

회원번호 대표자 공동자 KR000****1 권 * 영 KR000****1 박 * 순 KR000****1 박 * 애 이 * 홍 KR000****2 김 * 근 하 * 희 KR000****2 박 * 순 KR000****3 최 * 정 KR000****4 박 * 희 조 * 제

회원번호 대표자 공동자 KR000****1 권 * 영 KR000****1 박 * 순 KR000****1 박 * 애 이 * 홍 KR000****2 김 * 근 하 * 희 KR000****2 박 * 순 KR000****3 최 * 정 KR000****4 박 * 희 조 * 제 KR000****4 설 * 환 KR000****4 송 * 애 김 * 수 KR000****4