Journal of Korea Robotics Society
[ ARTICLE ]
The Journal of Korea Robotics Society - Vol. 17, No. 1, pp.48-57
ISSN: 1975-6291 (Print) 2287-3961 (Online)
Print publication date 28 Feb 2022
Received 16 Dec 2021 Revised 17 Jan 2022 Accepted 18 Jan 2022
DOI: https://doi.org/10.7746/jkros.2022.17.1.048

선박 위 착륙을 위한 임피던스 제어기반 쿼드콥터 족형 랜딩플랫폼 제어 전략

황성현1 ; 이승현1 ; 진성호1 ; 이인호
Control Strategies for Landing Quadcopters on Ships with Legged Platform Based on Impedance Control
Seonghyeon Hwang1 ; Seunghyeon Lee1 ; Seongho Jin1 ; Inho Lee
1MS Student, Pusan National University, Busan, Korea seonghyeon7379@pusan.ac.krseunghyeon1696@pusan.ac.krseongho1696@pusan.ac.kr

Correspondence to: Assistant Professor, Corresponding author: Department of Electronics Engineering Pusan National University, Busan, Korea ( inholee8@pusan.ac.kr)

CopyrightⓒKROS

Abstract

In this paper, we propose a legged landing platform for the quadcopter taking off and landing in the ship environment. In the ship environment with waves and winds, the aircraft has risks being overturned by contact impact and excessive inclination during landing on the ship. This landing platform has four landing legs under the quadcopter for balancing and shock relief. In order to make the quadcopter balanced on ships, the position of each end effector was controlled by PID control. And shocks have mainly happened when quadcopter contacts the ship’s surface as well as legs move fast. Hence, impedance control was used to cope with the shocks. The performance of the landing platform was demonstrated by a simulation and a prototype in three sea states based on a specific size of a ship. During landing and tracking the slope of the ship’s surface, oscillations of rotation and translation from the shock were mitigated by the controller. As a result, it was verified that transient response and stability got better by adding impedance control in simulation models and prototype experiments.

Keywords:

Shipboard Landing, Landing Gear, Legged Robot, Shock Mitigation

1. 서 론

UAV (Unmanned Aerial Vehicle)는 실제 조종사가 탑승하지 않고, 지상에서 사전에 프로그래밍 된 경로를 자동 또는 반자동으로 비행할 수 있는 비행체를 말한다. UAV 기술은 고정익 및 회전익 비행체에 모두 적용 가능하나, 하드웨어의 구조적인 간단함과 쉬운 조종 때문에 쿼트콥터(Quadcopter), 헥사콥터(Hexacopter) 등 과 같은 멀티콥터(Multicopter) 형태의 비행체가 산업용 및 소비자용으로 많이 사용되고 있다[1,2].

UAV는 자동비행이 가능하다는 특수성을 갖기 때문에, 이에 대한 활용은 군사, 배송, 시설물 진단, 레저, 농업, 등 다양한 분야에서 점차 증가하고 있다[1,3,4]. 이에 따라 UAV를 위한 다양한 환경에서 이착륙하는 방법에 관해서 연구되고 있다. 레그의 엔드이팩터에 IMU 센서를 설치하여 지면의 기울기를 Sensing하고 적절한 자세로 만들어 안정적으로 착륙하고 걷는 연구[5], 3D Sensing 을 통해 착륙을 위한 적절한 접지점을 찾아 해당 지점으로 레그를 내리는 연구[6], 엑츄에이터 없이 기계적으로 경사면에 착륙 시 기체의 수평을 유지하는 연구[7], 이동 중인 주행체 위에 착륙을 위한 연구[8-11], 험지 착륙을 위한 랜딩 기어 연구[12] 등이 진행되었다. 상용 UAV에 설치되는 랜딩기어는 주로 고정형 4점 접지식과 리트렉터형(Retractor)이 주로 사용되고 있다. 리트렉터형은 카메라의 시야 확보와 비행 효율을 위해 랜딩기어가 들어 올려지는 형태이다.

랜딩기어는 건물 위, 지상, 수상, 선상 등 기체가 안정적으로 이착륙을 할 수 있도록 돕는 역할을 한다. 그중 선박 위에 이착륙하는 것은 바람과 파도에 의해서 불규칙적으로 흔들리는 문제 때문에 기존의 랜딩기어로 이착륙하는 것은 어렵다. 예를 들어, 선박의 과한 회전속도에 의한 랜딩기어와의 충격에 의한 사고와 과도한 기울기 때문에 기체가 중심을 잃으면서 뒤집힐 수도 있다. 이 때문에 선박에서도 안정적인 이착륙을 할 수 있도록 새로운 형태의 랜딩플랫폼에 대해선 연구할 필요가 있었다[13].

흔들리는 지면의 기울기에 대해 랜딩플랫폼의 롤(Roll), 피치(Pitch)를 보상하기 위해 ‘X’ 형태로 2-link 레그를 구성하였다. 그리고 쿼드콥터의 프레임을 ‘+’ 로 구성하면 ‘X’ 형태와 같이 대칭으로 구성할 때 보다 더 큰 레그의 Workspace를 갖게 된다는 장점이 있다. 하지만 기체 아래에 카메라를 설치되어 있다고 가정할 때, 기체가 전방으로 가속하기 위해 기울 면 큰 프로펠러에 의해 정면 시야가 다소 가려질 우려가 있다. 그러므로 [Fig. 1]과 같이 레그와 대칭으로 구성하였다.

[Fig. 1]

Quadcopter landing platform & 2-link leg detail

각 레그의 위치제어는 지면의 기울기를 추종하여 선박의 불규칙적으로 흔들리는 표면에 대해서 수평을 잘 유지할 수 있도록 각 PID 제어를 통해 레그를 제어하였다. 그리고 지면과 접촉하면서 발생하는 외부 충격과 레그가 빠르게 움직이면서 발생하는 내부 충격을 완화하기 위해 능동적인 완충기 역할을 하는 임피던스 제어기(Impedance control)가 적용되었다.

선박의 흔들림은 파도와 선박의 크기에 의해 달라진다. 따라서 선박의 크기는 한국항공우주연구원에서 수직이착륙기의 선박 착륙실험을 위해 사용되었던 배의 크기를 참고하였고, 세계기상기구(WMO)에서 파도의 크기를 정의한 Sea state (SS) 중 코드 3, 4, 5를 선박의 동특성을 결정하는 기준으로 하였다. 선박의 동특성은 노르웨이의 Ship Design and Operation Lab (NTNU in Ålesund) 연구실에서 제공하는 선박의 운동 시뮬레이션으로 실험환경을 구성하였다[14,15].

실험은 컴퓨터 시뮬레이션과 실제 실험을 각각 수행하였다. 시뮬레이션 실험을 진행하기 위해서, Simulink/Simscape를 활용하여 랜딩플랫폼 모델을 구현하였고, 선박의 동특성을 시뮬레이션에 입력하여 착륙실험을 진행하였다. 그리고 실제 실험을 진행하기 위해서 프로토타입(Prototype) 랜딩플랫폼을 제작하였고, 파도에 의해 흔들리는 선박을 시뮬레이션하기 위해 모터를 구동하여 롤, 피치 회전이 가능한 테스트베드(Testbed) [Fig. 2]를 제작하여 실험을 진행하였다[16].

[Fig. 2]

The testbed for a quadcopter landing platform

2장에서는 라그랑주 방법을 통해 랜딩플랫폼의 동역학 방정식을 유도하고, 3장에서는 각 레그 엔드이팩터 위치제어를 통한 랜딩플랫폼의 균형제어, 착륙과 균형제어 중 나타나는 내/외부 진동 및 충격을 완화하기 위해 임피던스 제어, 그리고 센서의 노이즈를 극복하기 위한 상태 추정기를 설계하는 것에 대해 살펴보고, 4장에서는 시뮬레이션 및 실제 실험을 통해 성능을 확인하고, 결론 및 향후 연구계획을 제시한다.


2. 동역학 모델

2.1 랜딩플랫폼 구조

랜딩 플랫폼은 쿼드콥터의 자세를 만들고 지면에 의한 충격을 흡수하기 위해 롤, 피치의 회전운동과 상하운동으로 움직임이 가능하도록 하였다. 그래서, 4개의 레그로 구성하였으며, 레그 1개는 2개의 링크와 2개의 회전 조인트로 구성되었다. [Fig. 3]에서 Body frame은 Inertial frame에 대한 랜딩플랫폼의 상대 위치를 나타내는 좌표계를 의미한다.

[Fig. 3]

Floating based robot coordinate

매니퓰레이터처럼 지면에 고정되지 않은 시스템을 표현하기 위해서, Body frame에 토크와 힘을 가질 수 없는 3개의 직선 운동 조인트와 3개의 회전운동 조인트를 가진 가상의 매니퓰레이터(Virtual manipulator)로 상태(State)를 나타낼 수 있으며, 아래와 같다.

qb=qbPqbRR6(1) 

Inertial frame에 대하여 qbP = [xb yb zb]T는 가상의 매니퓰레이터의 직선운동을, qbR = [ϕ θ ψ]T은 회전운동을 나타낸다.

각 레그를 구분하기 위해 i = RF, LF, LB, RB 라고 하고, 각 레그에 대한 파라미터는 [Fig. 1]의 레그 파라미터는 다음 설명과 같다.

l1, l2 : 각 링크의 길이
l1,cm, l2,cm : 조인트로부터 질량 중심까지 길이
xi,p, yi,p : 각 레그의 엔드이팩터의 위치
qi,j = [qi,1 qi,2]T : 조인트 위치
fi = [fi,x, fi,y, fi,z]T : 엔드이팩터에 가해지는 힘
m1, m2 : 각 링크의 질량
m :=m0 + 4m1 + 4m2 : 전체 질량

그리고, qi=qbqi,jTR8로 다시 쓸 수 있다.

또한, 모든 레그를 받쳐주고 드론의 질량이 포함되어 있다고 가정한 중간프레임의 질량을 m0라 하고, 가상의 매니퓰레이터의 끝에 중간프레임의 질량 중심이 있다고 가정한다. 중간프레임의 질량 중심으로부터 qi,1 조인트까지의 길이를 r 이라고 한다.

2.2 동역학 방정식

랜딩플랫폼의 동역학 방정식은 라그랑주 방법(Lagrange Method)을 통해 유도 되어 졌다. 라그랑주는 구하고자 하는 매니퓰레이터의 운동에너지(K)와 위치에너지(P)의 차로 구해지며, 각 조인트의 속도 및 위치에 대해 편미분을 통하여 각 조인트에 필요한 토크 및 힘(τi)을 구할 수 있다.

L=K-P(2) 
tLq˙-Lq=τ(3) 

위 식을 엔드이팩터에 가해지는 외력을 포함한 형태로 전개하면 아래의 벡터-행렬식으로 표현할 수 있다.

Miqiqi¨+Ciqi,qi˙+Giqi=SiTτi+JiTfi(4) 
τiR2 : 조인트 토크 벡터
MiqiR8×8 : 질량-관성 행렬
Ciqi,qi˙R8 : 코리올리-원심력 벡터
GiqiR8 : 중력 벡터
Si = [02×6 I2×2] : 선택(Selection) 행렬
Ji=JibodyJilegR3×8 : 자코비안(Jacobian) 행렬

그리고 벡터-행렬식을 가상 매니퓰레이터와 레그에 대해 분해하면,

MibMibjMijbMijqb¨qb¨+CibCij+GibGij=JibodyTfiτi+JiTfi(5) 

이 된다. 독립변수 백터 qi,qi˙는 표기를 생략하였다.

따라서, 전체 시스템에 대한 동역학 방정식은 모든 i의 레그의 동역학 방정식을 더한 것과 같다.

Mq¨+C+G=STτ+JcTf(6) 
q=qbTqRFTqLFTqLBTqRBTTR14(7) 
τ=τRFTτLFTτLBTτRBTTR8(8) 
M=i=RFRBMibMRFbjMLFbjMLBbjMRBbjMRFjbMRFj000MLFjb0MLFj00MLBjb00MLBj0MRBjb000MRBjR14×14(9) 
C=i=RFRBCibCRFjCLFjCLBjCRBj TR14(10) 
G=i=RFRBGibGRFjGLFjGLBjGRBj TR14(11) 
JcR3nc×14,fR3nc(12) 

nc 는 지면에 접촉하고 있는 엔드이팩터의 개수이다.

접촉힘(Contact force)은 지면에 접촉한 엔드이팩터에 대해서만 발생하기 때문에, Jc는 접촉한 레그에 대해서만 Ji 를 포함한다. 따라서, nc의 값에 따라 Jc의 차원은 변하게 되고, 지면에 접촉한 각 엔드이팩터의 접촉힘 fi 역시 nc에 비례하여 f의 차원이 변화 되어야 한다.


3. 제어 알고리즘

랜딩플랫폼은 지면의 기울기에 대해 수평을 유지하기 위해서 각 레그의 적절한 위치를 결정해야 한다. 실시간으로 자세 오차를 피드백 받아 PID 제어기와 기구학(Kinematics)을 통해 레그 제어가 이루어진다.

그리고 랜딩플랫폼이 지면에 접촉할 때, 혹은 레그가 급작스럽게 움직일 때 발생할 수 있는 충격을 감쇠하기 위하여 임피던스 제어기(Impedance controller)를 적용하였다.

그리고 포스 센서, IMU 센서에 발생하는 노이즈에 대해 강인하게 만들기 위해 상태 추정기(Estimator)를 추가하였다. 랜딩플랫폼의 전체 블록 다이어그램은 [Fig. 4]와 같다.

[Fig. 4]

Control block diagram

3.1 레그 제어

2차원 평면으로 봤을 때 랜딩플랫폼의 자세를 수평으로 만들기 위해서, 한쪽 레그를 수직으로 들어 올림으로써 랜딩플랫폼을 수평으로 만들 수 있다[Fig. 5].

[Fig. 5]

Landing platform balancing principle

자세를 수평으로 추종하기 위해서 목표 자세와 현재 자세에 대한 차를 PID 제어기의 입력으로 넣고, 출력으로 나온 제어치는 랜딩플랫폼이 수평을 유지하기 위한 엔드이팩터의 위치를 결정하는 기구학 계산을 위한 입력으로 사용한다. 엔드이팩터의 초기 위치 xi,0, yi,0를 시작으로, PID 제어기로부터 출력된 각축에 대한 제어치 dϕ, dθ 만큼 xi,p, yi,p가 보상된다. dϕ, dθ를 각 레그에 [Table 1], [Table 2]와 같이 분배하는 기준은 랜딩플랫폼의 자세(ϕ, θ) 와 y~ϕ,y~θ 이다. y~ϕ,y~θ는 다음 식과 같다.

y~ϕ=yLF,p+yLB,p-yRF,p+yRB,p(13) 
y~θ=yRF,p+yLF,p-yRB,p+yLB,p(14) 

Operations with regard to ϕ,y~ϕ

Operations with regard to θ,y~θ

y~ϕ,y~θ는 특정 회전축 기준의 한쪽 레그 만 움직이도록 만드는 제약의 기준이 된다. ϕ = ϕref, θ = θref일 때 dϕ, dθ는 0 이다. xi,p = xi,0로서, 변하지 않도록 하였다. yi,p-는 제어주기의 한 주기 이전 위치를 말한다.

3.2 임피던스 제어

R3 공간에서 엔드이팩터에 걸리는 힘(fe)을 입력으로 하고, 작업공간(Task space)에서 기준 위치(xref)에 대한 변위(x)를 출력으로 하는 임피던스 제어를 방정식으로 표현하면 아래와 같다[17].

fe=Mx¨-x¨ref+Dx˙-x˙ref+Kx-xref(15) 

fe,x,xrefR3,M,D,KR3×3이며, M은 질량 행렬, D는 댐핑 상수 행렬, K는 스프링 상수 행렬이다.

하지만, 랜딩플랫폼에 사용된 힘센서는 1축에 대해서만 측정할 수 있다. 따라서 질량, 댐핑, 스프링 상수 및 상태변수는 R1 공간에서 다시 임피던스 방정식을 유도하였다. 그리고 엔드이팩터의 궤적은 위치제어만 하기 때문에 xref에 대한 미분 항은 무시하였다.

fe,x,xrefR,m,d,kR, xref = 0 라고 할 때, 전달함수 G(s)는 다음과 같다.

Gs=XsFes=1ms2+ds+k(16) 

위의 전달함수 식을 감쇠비(ζ) 와 자연주파수(wn)으로 구성된 2차 시스템의 전달함수로 표현할 수 있다.

Gs=1m1s2+dms+km=1awn2s2+2ζwns+wn2(17) 

식 (17)에 대해서 각 항을 대응시키면 식 (18), (19), (20)을 얻을 수 있다.

a=mwn2(18) 
k=mwn2(19) 
d=2mζwn(20) 

따라서 ζ, wn를 조정하여 a, d, k를 얻고, 과도응답 특성을 결정할 수 있다.

랜딩플랫폼에 적용되는 임피던스 제어기는 물리적으로 랜딩플랫폼이 질량 그 자체로 존재하기 때문에 m항을 뺀 나머지 항으로 제어기를 설계한다.

x˙=-kdx-xref+fed(21) 

위 식을 블록 다이어그램으로 표현하면 [Fig. 6]와 같다.

[Fig. 6]

Impedance control block diagram

3.3 상태 추정기

시스템을 모델링 할 때 실제 시스템과 똑같이 모델링하는 것은 쉽지 않고, 노이즈 때문에 상태를 정확하게 측정하는 것은 불가능하며, 상태의 초깃값 역시 알기 어렵다. 그래서 실제 시스템의 상태를 측정한 값과 랜딩 플랫폼의 모델을 통해 얻은 상태를 섞어서 실제 플랫폼의 상태를 추정할 수 있다.

먼저 상태 공간 방정식을 동역학 방정식으로부터 유도해야 한다. 동역학 방정식을 선형화를 통해서 상태 공간 방정식을 유도할 수도 있지만, 높은 차원의 동역학 방정식은 복잡하고, 많은 연산이 요구되기 때문에 선형 시 불변인 2차 시스템으로 근사하였다.

[Fig. 7]에 스프링과 댐퍼는 임피던스 제어기가 포함된 것을 도식화한 것이며, 랜딩플랫폼은 앞뒤 좌우 대칭이기 때문에 θ 에 대한 모델도 위와 동일하다. 각 변수 및 파라미터는 다음과 같다.

[Fig. 7]

Landing platform approximated to 2nd order system

JR : 관성 모멘트
rR : 무게중심으로부터의 거리
ktR : 병진운동 스프링 상수
dtR : 병진운동 댐핑 상수
krR : 회전운동 스프링 상수
drR : 회전운동 댐핑 상수

2차 시스템을 바탕으로 상태 공간 방정식을 유도하면 다음과 같다.

x˙=Ax+Bu,y=Cx(22) 
x=yL,p y˙L,p yR,p y˙R,p ϕ ϕ˙T(23) 
u=fL,yfR,yT(24) 
A=010000-2ktm-2dtm000000010000-2ktm-2dtm000000010000-krJ-drJ(25) 
B=01000-rJ00010rJT(26) 
C=0 0 0 0 1 0(27) 
kr=rkt(28) 
dr=rdt(29) 

실제 랜딩플랫폼에서 측정된 출력값(y), 상태 추정기로부터 나온 추정된 출력을 y^ 이라고 할 때 상태 추정기의 방정식은 아래와 같다.

x^˙=Ax^+Bu+Ly-y^(30) 
y^=Cx^(31) 

위 방정식에 대한 블록 다이어그램은 아래 [Fig. 8]과 같다.

[Fig. 8]

State estimator block diagram

e:=x-x^라고 하고, 양변을 미분하여 정리하면 아래와 같다.

e˙=A-LCe(32) 
LR6 : 상태 추정기 게인

L을 조정하여 A-LC 의 고유값을 조정할 수 있다. L 을 높일수록 고유값은 커지면서 더욱 e 를 더욱 빠르게 0으로 수렴하게 된다. 그러나 동시에 노이즈에 대해서 민감하게 반응하게 된다는 단점이 있다.


4. 실 험

4.1 실험 환경

4.1.1 선박 운동 환경

파도의 크기와 선박의 크기에 따라 선박의 동특성이 달라지기 때문에, 파도의 크기와 선박의 크기를 한국항공우주연구원이 사용했던 선박의 크기를 참고하였고, 세계기상기구(WMO)에서 파도의 크기를 정의한 Sea state (SS)에 의해 나타나는 선박의 동특성을 기준으로 하였다. 실험에 사용된 SS 코드는 3, 4, 5이고, 파고의 범주 중 가장 높은 값으로만 파도가 나타난다는 가정을 하였다[Table 3].

WMO sea state code

그리고 선박의 동특성을 확인하기 위해서 노르웨이의 Ship Design and Operation Lab (NTNU in Ålesund) 연구실에서 제공하는 시뮬레이션으로 확인된 선박의 회전 운동 주파수 응답을 샘플링 하여 선박의 운동을 시간 영역에서 나타내어 움직임을 나타내었다[18]. [Table 4]는 시뮬레이션에 입력된 선박의 파라미터 이며, 선박의 무게중심은 중간에 있다고 가정하였다.

The ship specification

파도가 선박의 정면으로 올 때를 180°로 하여, 파도의 입사각은 α는 [Fig. 9]와 같은 기준으로 하였다.

[Fig. 9]

Wave incidence angle

4.1.2 접촉 모델

랜딩플랫폼에 대한 실험은 MATLAB/Simulink를 통해서 시뮬레이션을 실시했다. 엔드이팩터가 지면에 접촉할 때 발생하는 힘에 대한 모델은 Simulink/Simscape 의 Spatial Contact Force Block을 사용하였다. 법선력(fn)과 마찰력(ff)은 [Fig. 10]과 같이 Base와 Follower가 접촉할 때 생기는 평면을 기준으로 법선과 접선 방향으로 힘이 발생한다. 법선력은 스프링과 댐퍼로, 마찰력은 정지 및 운동 마찰 계수로서 정의된다. 모델 파라미터는 [Table 5]와 같다.

[Fig. 10]

Contact model

Contact model parameter

4.1.3 랜딩플랫폼 하드웨어 및 파라미터

Simscape를 활용한 시뮬레이션 랜딩플랫폼은 앞뒤, 좌우가 대칭이므로 2D로 실험을 진행하였다. 시뮬레이션에서 엔드이팩터에 힘이 측정되는 순간부터 지면의 접촉으로 인식되고 균형제어가 시작된다[Fig. 11]. 랜딩플랫폼의 레그제어에 있는 PID 제어 계수와 모터컨트롤러의 PD 제어기의 계수는 실험을 통해 얻었다. 시뮬레이션 모델 및 프로토타입 랜딩플랫폼에 사용된 PID 계수는 [Table 6]과 같다.

[Fig. 11]

Simscape landing platform simulation example

PID parameter

레그의 길이와 드론이 포함된 각 파츠의 무게는 실제 랜딩플랫폼과 유사하도록 파라미터를 일치시켰다. 그리고 무게중심은 각 파츠의 중심에 있다고 가정하였다. 제어주기는 프로토타입의 제어주기인 100 Hz로 일치시켰다.

프로토타입 랜딩플랫폼의 모든 조인트에 사용된 모터는 Dsservo사의 디지털 서보모터(RDS5160)를 사용했으며, 7.4 V를 전원 전압으로 사용했다. MCU는 ST사의 STM32F407VET6를 사용하여 레그를 제어하였다. IMU 센서는 E2BOX사의 EBIMU-9DOFV5를 사용하였다. 엔드이팩터에서 발생 되는 힘을 측정하기 위해서 Singletact 사의 CS15-45N 힘센서를 사용하였다. 각 센서와 모터의 위치는 [Fig. 1]에 나타내었다. 그리고 랜딩플랫폼과 쿼드콥터의 주요 스팩과 성능은 [Table 7]과 같다.

Landing platform & quadcopter specification

4.2 임피던스 제어 실험

임피던스 제어기의 성능은 3.2절에서 말한 것과 같이 임피던스의 각 파라미터는 ζ, wn 에 의해 응답기 결정된다. 임피던스 제어기는 충격을 완화하기 위해 적용된 것이므로 충격을 가장 잘 흡수하는 계수를 찾는 것이 목적이다. ζ 특성을 고려했을 때 ζ 가 클수록 %OS 및 정착시간이 줄어들 것을 예상할 수 있다. [Fig. 12]에서는 기체의 전체 무게 4.5 kgf, wn = 1 일 때를 기준으로, 고도 0.5 m 지점에서 수평면 착륙함으로써, 각 ζ에 대한 시간 응답을 나타 낸다.

[Fig. 12]

Drop test for each damping ratio

위 그래프에서 나타났듯이, ζ가 커질수록 진동이 줄어드는 것을 볼 수가 있다. ζ 가 1일 때 가장 좋은 성능을 보였기 때문에 d, kζ 가 1 일 때(Critical damped)를 기준으로 결정되었다(k = 5.5, d= 11).

선박의 흔들림에 따라 들어 올릴 레그를 다른 레그로 전환할 때, 한쪽 레그는 급정지, 그리고 다른 레그를 들어 올리는 속도를 급격히 가속함에 따라 내부적인 진동이 발생했다. [Fig. 13]은 시뮬레이션 선박을 크기 15°, 각속도 1.5 rad/s 로 sin 파형으로 흔들 때를 나타낸다.

[Fig. 13]

Impedance on/off comparison in simulation

선박의 회전각의 크기는 그래프의 가독성을 위해 실제 기울기의 1/4 scale로 나타냈다. 임피던스 제어기를 껐을 때는 자세의 피크(Peak) 마다 진동이 발생하는 것을 확인할 수 있다. 하지만 임피던스 제어기를 켰을 때는 착륙 충격 순간 자세 변화량이 39.7%가 줄어들고, 동시에 자세 오차의 피크에서 진동이 발생하는 현상이 줄어들었다.

[Fig. 14]는 시뮬레이션과 같이 프로토타입 랜딩플랫폼에 크기 10°, 각속도 2.11 rad/s 으로 테스트베드 위에서 실험했을 때를 나타낸다. 임피던스 제어기의 ON/OFF의 피크 오차가 각각 5.59°, 5.72° 가 발생하였고, 임피던스 제어기가 ON일 때, 진동이 완화되어 좀 더 안정적인 자세를 보여줬다. FRFL 는 같은 열에 있는 레그 위치의 합을 나타낸다.

[Fig. 14]

Impedance on/off comparison for prototype

4.3 추정기 실험

추정기는 노이즈에 대해 강인함을 확인하기 위해서 시뮬레이션의 센서에 실제 센서와 유사한 분산을 갖는 노이즈를 주어서 성능을 확인하였다. 힘센서 및 IMU센서의 분산은 각각 0.0658, 0.0281로 나타났다.

추정기의 게인 L에 따른 e가 0으로 수렴하는 시간 응답을 확인하기 위해, 플랜트(Plant)의 상태변수 x=yL,py˙L,pyR,py˙R,p ϕ ϕ˙Tu = [fL,y FR,y]T 에서 초기 상태를 x0 = [0 0 0 0 10° 1°]T , u0= [0 2]T 라고 했을 때 실험 결과는 [Fig. 15]와 같이 나타났다.

[Fig. 15]

Error tracking for each gain

그래프에서 나타난 바와 같이, 게인 L이 클수록 빠르게 실제 플랜트의 ϕact에 추종하지만, 노이즈에 민감하게 반응하는 것을 확인할 수 있었다. 노이즈에 대해 강인한 추정기를 얻는 것이 목적이기에 실험 중 가장 안정적이었던 L 이 1일 때를 기준으로 시뮬레이션의 랜딩플랫폼에 적용하였다.

SS5 상태에서의 선박의 롤에 대한 움직임을 시뮬레이션에 나타내고, 랜딩플랫폼의 센서에 노이즈를 첨가했다. 이에 따른 상태 추정기의 유무에 대한 랜딩플랫폼의 자세는 [Fig. 16]과 같이 나타났다.

[Fig. 16]

Estimator on/off comparison in simulation

추정기를 껐을 때는 노이즈를 띄고 있는 자세값 때문에 균형제어 역시 큰 영향을 받아 진동하였고, 추정기를 켰을 때 노이즈에 의한 랜딩플랫폼의 롤에 대해 흔들림이 크게 줄었다.

4.4 착륙 실험

시뮬레이션을 통해 랜딩플랫폼을 0.5 m 에서 출렁이는 테스트베드 위에 착륙하여 랜딩플랫폼의 시간응답을 비교해 보았다. 랜딩플랫폼의 롤에 대한 시간응답은 [Fig. 17]과 같이 나타났다.

[Fig. 17]

Landing and swaying test for each SS code in simulation

파도 크기에 비해 배의 크기가 크기 때문에 흔들리는 주파수 대역이 낮게 나타났다. SS가 높을수록 오차가 크게 나타났고, 노이즈에 대한 영향을 줄이기 위해 낮게 설정했던 추정기의 Gain에 의해 실제 랜딩플랫폼의 롤(ϕBody)에 대한 오차는 추정기와 노이즈가 없는 상태일 때 보다 크게 나타났다.

프로토타입 랜딩플랫폼 실험은 실제 테스트베드의 성능의 한계 때문에 실제 선박의 동특성을 동일하게 묘사하기에는 한계가 있었기에, 동특성에서 가장 큰 스팩트럼을 기준으로 선박의 흔들림과 유사하도록 파형을 생성하여 실험을 진행하였다.

롤, 피치 두 개의 축으로 선박의 운동을 생성하였고, 0.5 m에서 착륙실험을 했을 때의 결과는 [Fig. 18]과 같이 나타났으며, 자세 오차는 모두 1° 이내로 나타났다. 시뮬레이션과 실제 실험 결과에서 알 수 있듯이 선박이 흔들리는 주기가 느리기 때문에 흔들림의 크기에 상관없이 큰 오차가 발생하지 않았다.

[Fig. 18]

Landing and swaying test for each SS code for prototype


5. 결 론

본 논문에서는 흔들리는 선박 위에 착륙하기 위한 쿼드쿼드콥터 랜딩플랫폼을 제안하였다. 4족 랜딩플랫폼에서, PID 제어를 활용한 레그제어를 통해서 균형제어를 하였다. 그리고, 임피던스 제어를 통해 내/외부에 의한 충격과 진동을 완화하는 것을 실험을 통해 확인하였다. 임피던스 제어는 2차 시스템에서 필요한 ζwn을 결정하여 댐핑과 스프링 상수를 유도해 낼 수 있었다. 또한, 센서에서 나타나는 노이즈에 강하게 설계하기 위해 랜딩플랫폼의 상태를 피드백 받는 추정기를 설계하였다. 하지만 센서의 노이즈레벨과 민감도가 높아 추정기 설계에 어려움이 있었다. 마지막으로, 파도에 의해 선박이 흔들릴 때 착륙을 하는 상황을 시뮬레이션 및 실제 실험을 통해 랜딩플랫폼의 성능을 확인하였다. 본 랜딩플랫폼은 이착륙 시 충격과 지속적인 흔들림에 따른 충격과 진동에 대해 안정적이게 설계를 하였다. 하지만, 큰 파도는 강한 바람이 동반하기 때문에, 비행 및 이착륙 시 바람에 의한 외란 역시 반드시 고려되어야 할 문제이다. 향후 본 연구는 정박한 선박 외에도 이동 중인 선박 및 이동 중인 차량에 이착륙을 돕는 랜딩플랫폼으로 연구를 진행할 예정이다.

Acknowledgments

This work was supported by a 2-Year Research Grant of Pusan National University; This work was supported by BK21FOUR, Creative Human Resource Education and Research Programs for ICT Convergence in the 4th industrial Revolution

References

  • J. E. Kim and J. W. Lee, “Drone Technology and Market Trend Report,” Commercializations Promotion Agency for R&D Outcomes, Seoul, Korea, vol. 67, August, 2019, [Online], https://www.compa.re.kr, .
  • Y. M. Kim and W. B. Baek, “Gyro Effect Control of the Quadrotor UAV using Feedback Linearization,” The Journal of Korea Robotics Society, vol. 15, no. 3, pp. 248-255, Sept., 2020. [https://doi.org/10.7746/jkros.2020.15.3.248]
  • H. Shakhatreh, A. H. Sawalmeh, A. A.-Fuqaha, Z. Dou, E. Almaita, I. Khalil, N. S. Othman, A. Khreishah, and M. Guizani, “Unmanned aerial vehicles (UAVs): A survey on civil applications and key research challenges,” IEEE Access, vol. 7, pp. 48572-48634, 2019. [https://doi.org/10.1109/ACCESS.2019.2909530]
  • M. D. Simoni, E. Kutanoglub, and C. G.Claudela, “Optimization and analysis of a robot-assisted last mile delivery system,” Transportation Research Part E: Logistics and Transportation Review, vol. 142, pp. 102049, 2020. [https://doi.org/10.1016/j.tre.2020.102049]
  • G. Yashin, A. Egorov, Z. Darush, N. Zherdev, and D. Tsetserukou, “LocoGear: Locomotion Analysis of Robotic Landing Gear for Multicopters,” IEEE Journal on Miniaturization for Air and Space Systems, vol. 1, no, 2, pp. 138-147, 2020. [https://doi.org/10.1109/JMASS.2020.3015525]
  • M. Ikura, L. Miyashita, and M. Ishikawa, “Real-time Landing Gear Control System Based on Adaptive 3D Sensing for Safe Landing of UAV,” 2020 IEEE/SICE International Symposium on System Integration (SII), pp. 759-764, Honolulu, HI, USA, 2020. [https://doi.org/10.1109/SII46433.2020.9026177]
  • S. Baker, D. Soccol, A. Postula, and M. V. Srinivasan, “Passive landing gear using coupled mechanical design,” Australasian Conference on Robotics and Automation, pp. 1-8, 2013, [Online], https://www.semanticscholar.org/paper/Passive-landing-gear-using-coupled-mechanical-Baker-Soccol/1e5595683ae0f186529717cdff7ee3e13b7fcc8c, .
  • T. Yang,Q. Ren, F. Zhang, B. Xie, H. Ren, J. Li, and Y. Zhang, “Hybrid camera array-based uav auto-landing on moving ugv in gps-denied environment,” Remote Sensing, vol. 10, no. 11, pp. 1829, 2018. [https://doi.org/10.3390/rs10111829]
  • Y. Kwon, D. Cheon, S. Hwang, J. Choi, H. Kang, and J. Lee, “System for Leveling Landing Surface in Response to Changes in Quadcopter Posture,” The Journal of Korea Robotics Society, vol. 16, no. 2, pp. 155-163, Jun., 2021. [https://doi.org/10.7746/jkros.2021.16.2.155]
  • S. Jung, J. Koo, K. Jung, H. Kim, and H. Myung, “Vision-based Autonomous Landing System of an Unmanned Aerial Vehicle on a Moving Vehicle,” The Journal of Korea Robotics Society, vol. 11, no. 4, pp. 262-269, Dec., 2016. [https://doi.org/10.7746/jkros.2016.11.4.262]
  • S. Lee, J. Kawk, and B. Chu, “Study of a Leveling Mobile Platform for Take-off and Landing of Unmanned Aerial Vehicles,” Journal of the Korean Society of Manufacturing Process Engineers, vol. 19, no. 4, pp. 85-92, 2020. [https://doi.org/10.14775/ksmpe.2020.19.04.085]
  • D.-H. Cheon, J.-W, Lee, S.-H. Woo, J.-W. Choi, H.-S. Kang, and J.-M. Lee, “Research on Adaptive Landing System on the Rough Terrain for Quad-copter,” Journal of The Institute of Control, Robotics and Systems, vol. 27, no. 3, pp. 247-254, 2021. [https://doi.org/10.5302/J.ICROS.2021.20.0195]
  • C. S. Yoo, A. Jo, B. J. Park, and Y. S. Kang, “Trade-Off Study of Shipboard Landing of Vertical Take-off and Landing Aircraft,” Aerospace Engineering and Technology, vol. 12, no. 1, pp. 10-21, 2013, [Online], https://www.koreascience.or.kr/article/JAKO201368440974175.view?orgId=anpor&hide=breadcrumb,journalinfo, .
  • C.-S. Yoo, A. Cho, B.-J. Park, and Y.-S. Kang, “Sea Wave Modeling Analysis and Simulation for Shipboard Landing of Tilt Rotor Unmanned Aerial Vehicle,” Journal of the Korean Society for Aeronautical & Space Sciences, vol. 42, no. 9 , pp.731-738, 2014. [https://doi.org/10.5139/JKSAS.2014.42.9.731]
  • S. L. Andrade and H. M. Gaspar, Ship Motion Application, [Online], http://www.shiplab.hials.org/app/shipmotion, Accessed: October 29, 2021
  • S. Lee, J. Kawk, and B. Chu, “Study of a Leveling Mobile Platform for Take-off and Landing of Unmanned Aerial Vehicles,” Journal of the Korean Society of Manufacturing Process Engineers, vol. 19, no. 4, pp. 85-92, April, 2020. [https://doi.org/10.14775/ksmpe.2020.19.04.085]
  • R. Z. Stanisic and A. V. Fernández, “Adjusting the parameters of the mechanical impedance for velocity, impact and force control,” Robotica, vol. 30, no. 4, pp. 583-597, 2012. [https://doi.org/10.1017/S0263574711000725]
  • J. J. Jensen, A. E. Mansour, and A. S. Olsena, “Estimation of ship motions using closed-form expressions,” Ocean Engineering, vol. 31, no. 1, pp. 61-85, 2004. [https://doi.org/10.1016/S0029-8018(03)00108-2]
황 성 현

2017 경남과학기술대학교 메카트로닉스공학과(학사)

2020~현재 부산대학교 전기전자공학과(석사과정)

관심분야: 선형시스템, 로봇공학, 마이크로프로세서 제어

이 승 현

2020 동아대학교 전자공학과(학사)

2020~현재 부산대학교 전기전자공학과(석사과정)

관심분야: 자동 로봇 제어, 강화 학습, 시스템 설계

진 성 호

2020 경남과학기술대학교 메카트로닉스공학과(학사)

2020~현재 부산대학교 전기전자공학과(석사과정)

관심분야: 매니퓰레이터 제어, 영상 인식

이 인 호

2009 한국과학기술원 기계공학과 학사

2011 한국과학기술원 기계공학과 석사

2016 한국과학기술원 기계공학과 박사

2020~현재 부산대학교 전자공학과 조교수

관심분야: Robotics, 기계 시스템 자동화, 휴머노이드

[Fig. 1]

[Fig. 1]
Quadcopter landing platform & 2-link leg detail

[Fig. 2]

[Fig. 2]
The testbed for a quadcopter landing platform

[Fig. 3]

[Fig. 3]
Floating based robot coordinate

[Fig. 4]

[Fig. 4]
Control block diagram

[Fig. 5]

[Fig. 5]
Landing platform balancing principle

[Fig. 6]

[Fig. 6]
Impedance control block diagram

[Fig. 7]

[Fig. 7]
Landing platform approximated to 2nd order system

[Fig. 8]

[Fig. 8]
State estimator block diagram

[Fig. 9]

[Fig. 9]
Wave incidence angle

[Fig. 10]

[Fig. 10]
Contact model

[Fig. 11]

[Fig. 11]
Simscape landing platform simulation example

[Fig. 12]

[Fig. 12]
Drop test for each damping ratio

[Fig. 13]

[Fig. 13]
Impedance on/off comparison in simulation

[Fig. 14]

[Fig. 14]
Impedance on/off comparison for prototype

[Fig. 15]

[Fig. 15]
Error tracking for each gain

[Fig. 16]

[Fig. 16]
Estimator on/off comparison in simulation

[Fig. 17]

[Fig. 17]
Landing and swaying test for each SS code in simulation

[Fig. 18]

[Fig. 18]
Landing and swaying test for each SS code for prototype

[Table 1]

Operations with regard to ϕ,y~ϕ

When,ϕ>ϕref,y~ϕ>0Case1
yRF,p=yRF,p--dϕ,yRB,p=yRB,p--dϕ
When,ϕ>ϕref,y~ϕ0Case2
yLF,p=yLF,p-+dϕ,yLB,p=yLB,p-+dϕ
When,ϕ<ϕref,y~ϕ0Case3
yLF,p=yLF,p-+dϕ,yLB,p=yLB,p-+dϕ
When,ϕ<ϕref,y~ϕ<0Case4
yRF,p=yRF,p--dϕ,yRB,p=yRB,p--dϕ

[Table 2]

Operations with regard to θ,y~θ

When,θ>θref,y~θ>0Case1
yLB,p=yLB,p--dθ,yRB,p=yRB,p--dθ
When,θ>θref,y~θ0Case2
yLF,p=yLF,p-+dθ,yRF,p=yRF,p-+dθ
When,θ<θref,y~θ0Case3
yLB,p=yLB,p--dθ,yRB,p=yRB,p--dθ
When,θ<θref,y~θ<0Case4
yLF,p=yLF,p-+dθ,yRF,p=yRF,p-+dθ

[Table 3]

WMO sea state code

SS code Wave height Characteristics
3 0.5 to 1.25 m Slight
4 1.25 to 2.5 m Moderate
5 2.5 to 4 m Rough

[Table 4]

The ship specification

Length 135 m
Waterline Breadth 19.6 m
Blcok Coefficient 0.53
Speed 0 kts
Wave Incidence Angle (α) 150°

[Table 5]

Contact model parameter

Stiffness 106 N/m
Damping 103 N/ (m/s)
Transition Region Width 10-4 m
Coefficient of Static Friction 0.5
Coefficient of Dynamic Friction 0.3
Critical Velocity 10-3 m/s

[Table 6]

PID parameter

Simulation
Joint Motor
KP 1.1
KD 0.05
Simulation
Trajectory
Controller
KP 0.002
KI 0.001
KD 0.001
Prototype
Trajectory
Controller
KP 0.7
KI 0.05
KD 0.05

[Table 7]

Landing platform & quadcopter specification

Quadcopter Weight 2.5 kgf
Landing Gear Weight 2 kgf
Maximum Takeoff Weight of Quadcopter 5.6 kgf·cm
Maximum Joint Torque 65 kgf
Upper/Lower Leg Length 0.13 m
Upper/Lower Leg Weight 0.25 kgf
Maximum Measurable Contact Force 45 N
Body Width (Twice r) 0.25 m
Inertia (Roll Axis) 0.1375 kg·m2