Korean Institute of Information Technology
[ Article ]
The Journal of Korean Institute of Information Technology - Vol. 22, No. 2, pp.83-92
ISSN: 1598-8619 (Print) 2093-7571 (Online)
Print publication date 28 Feb 2024
Received 15 Jan 2024 Revised 15 Feb 2024 Accepted 18 Feb 2024
DOI: https://doi.org/10.14801/jkiit.2024.22.2.83

ROS 기반 UWB 통신 기술을 이용한 협동로봇 안전관리 시스템

최낙원* ; 손지훈** ; 김영빈* ; 박범용***
*국립금오공과대학교 IT융복합공학과 석사과정(공동1저자)
**국립금오공과대학교 반도체시스템전공 학사과정(공동1저자)
*국립금오공과대학교 IT융복합공학과 석사과정
***국립금오공과대학교 IT융복합공학과 부교수(교신저자)
Collaborative Robot Safety Management System using ROS-based UWB Communication
Nak-Won Choi* ; Ji-Hun Son** ; Yeon-Bin Kim* ; Bum-Yong Park***

Correspondence to: Bum-Yong Park Dept. of IT Convergence Engineering, Kumoh National Institute of Technology, 61, Daehak-ro, Gumi-si, Gyeonngsangbuk-do, 39177 Korea Tel.: +82-54-7438, Email: bumyong.park@kumoh.ac.kr

초록

본 논문은 로봇 운영체제(ROS, Robot Operating System) 기반 초광대역(UWB, Ultra-Wideband) 통신을 이용한 협동 로봇 안전관리 시스템을 제안하였다. 협동 로봇은 사람과 함께 작업하는 로봇으로, 작업자의 안전 확보가 매우 중요하다. 제안하는 시스템은 UWB 통신을 활용하여 작업자의 위치를 추정한다. 추정된 위치 정보를 기반으로 작업자와 로봇의 거리에 따라 로봇의 속도를 제어하여 작업자의 안전을 확보한다. 제안하는 시스템의 성능을 평가하기 위해 시뮬레이션과 실험을 수행하였다. 실험 결과, 작업자가 로봇의 작업 영역으로 진입하는 경우 로봇의 속도는 10배 감속하여 작업자의 안전을 효과적으로 보호할 수 있음을 확인하였다. 이를 통해 제안된 ROS 기반의 UWB 통신 기술은 안전하고 효율적으로 산업환경에서 로봇 작업을 지원하는 데 기여할 것으로 기대된다.

Abstract

This paper proposes a safety management system for collaborative robots using Ultra-Wideband communication based on Robot Operating System. Collaborative robots are robots that work together with humans, and it is very important to ensure the safety of workers. The proposed system utilizes UWB communication to estimate the location of the worker. Based on the estimated location information, it controls the speed of the robot according to the distance between the worker and the robot to ensure the safety of the worker. Simulations and experiments were conducted to evaluate the performance of the proposed system. The experimental results show that when the operator enters the working area of the robot, the speed of the robot can be reduced by 10 times, effectively ensuring the safety of the operator. This suggests that the ROS-based UWB communication technology presented here is expected to contribute to supporting robot operations in industrial environments, ensuring both safety and efficiency.

Keywords:

ROS, collaborative robot, safety control, indoor positioning, UWB, ultra-wide band, industrial robot

Ⅰ. 서 론

현대 제조 환경에서 제조 패러다임은 대규모 집적생산에서 빠르고 유연한 제조 방식으로의 전환을 요구하고 있다. 이에 따라 사람과 로봇의 협력과 융합이 강조되며, 특히 협동 로봇이 이에 주목받고 있다[1]. 협동 로봇은 산업환경에서 높은 효율성과 유연성을 제공하며, 사용자 친화적인 장점이 있다. 하지만 협동 로봇의 특성상 작업자와 로봇의 작업 공간 공유로 인해 작업자의 안전 보장은 여전히 해결해야 할 중요한 과제이다[2].

산업용 로봇의 안전 국제 표준인 ISO 10218-1:2011에서는 안전 보장 메커니즘을 4가지 유형으로 분류하고 있다: 안전 정격 감시 정지, 핸드 가이딩, 속도 및 이격거리 감시, 일률 및 힘 제한[3]. 협동 로봇은 이 4가지 유형 중 하나 이상이 가능한 산업용 로봇이다. 하지만 다양한 유형의 로봇 또는 사람과 함께 작업하는 경우, 작업자의 이동이 잠재적인 위험으로 작용할 수 있어 협동 로봇이 충족하는 안전 규정으로는 충분치 않다. 기존의 안전 시스템은 산업 공정을 처리하는데 제한된 속도와 부하용량을 가지도록 한다. 이러한 기능의 제한은 특정 작업 공간 설계에서 효율성 및 성능 저하를 초래한다. 이를 해결하고자 실내 측위 기술을 도입하여 장치의 추적을 통해 작업자의 안전성을 증대시킨다.

실내 측위 기술은 실내 환경에서 물체나 이동체의 위치를 정확하게 추정하는 기술을 의미한다. 현재 무선통신을 이용한 실내 측위 기술에는 Bluetooth, Wi-Fi를 사용하여 RSSI(Received signal Strength Indication)에 따른 거리 측정 방식을 이용한다[4][5][6]. 이러한 방식은 장애물이나 반사되는 물체들이 있을 때 전파 간섭이 발생하여 정확도가 매우 떨어진다는 문제가 존재한다. 이를 위한 대안으로 UWB 통신 기술이 주목받고 있다[7]-[9]. UWB 통신은 500MHz 이상의 넓은 대역폭과 간섭이 적은 특성이 있고 두 지점 간에 전파 이동시간을 이용하여 거리를 측정하기 때문에 물체의 정밀한 위치 추정이 가능하다[10]. 또한 장애물에 대한 높은 투과율을 제공하여 다수의 로봇과 장애물이 존재하는 산업현장에서 적용할 수 있다. 최근, UWB 통신 기반의 실시간 위치 추정을 활용한 다양한 시스템 제안되었다. 참고문헌 [11][12]는 UWB 통신을 기반으로 하는 무인 운송 차량의 충돌 회피를 위한 안전 시스템을 제시하였다. [13][14]는 산업환경에서 UWB 통신 기반의 협동 로봇과 사람 간의 충돌 회피를 위한 시스템을 제안하였다. [11]의 경우 무인 운송 차량 간의 충돌 회피나 경로 최적화를 이루었다. [13]의 경우 UWB 통신을 듀얼 채널로 구성하여 위치 추정에, 안정성과 신뢰성을 높였다. 이처럼 다수의 모바일 로봇을 사용하는 산업현장과 로봇과 사람이 같이 작업하는 환경에서 UWB 통신을 활용한 다양한 연구가 진행되었다. 이들은 UWB를 통한 위치 추정 시스템이 산업현장에서 높은 정확성을 가지고 안전관리에 효과적이란 것을 입증하고 있다.

이전 연구에서 UWB 통신 기술을 활용한 협동 로봇 안전관리 시스템을 설계하고 구현하였다[15]. 하지만 실제 산업용 로봇에는 적용하지 못한 한계점이 존재한다.

본 논문에서는 ROS 플랫폼을 도입하여 이전 연구에서 수행한 실험 환경을 실제 협동 로봇을 사용하여 실제 산업 환경과 유사한 조건으로 확장하고자 한다. ROS는 로봇 및 자동화 시스템의 효율적인 관리와 제어를 가능하게 하며, 다양한 로봇 하드웨어와의 통신을 지원한다[16].

UWB 통신을 활용한 실내 측위 기술과 ROS의 결합은 로봇과 작업자 간의 효율적인 상호작용을 가능하게 하며, 시스템의 확장성과 안전성, 유연성이 향상되어, 현대 제조 공정의 요구 사항에 따라 공정변화에 유연하게 대처할 수 있을 것이라 기대된다. 이를 시뮬레이션과 실험을 통해 제안된 시스템의 유용성을 확인하였다.

본 논문의 구성은 다음과 같다. 2장에서는 제안하는 시스템의 구성과 개발환경, ROS, UR(Universal Robots) 로봇, 실내 위치 추정에 관해 기술한다. 3장에서 앞서 기술한 내용을 바탕으로 실내 위치 추정 실험 및 Gazebo를 통한 시뮬레이션을 구현하였고, 실제 로봇제어에 대한 실험을 확인하고, 마지막으로 4장에서는 본 논문의 결론을 서술한다.


Ⅱ. 제안하는 시스템

2.1 시스템 구성도

본 논문에서 제안하는 시스템은 그림 1과 같이 구성되어있다. 산업현장에서 고정된 위치에서 UWB 통신과 호스트 PC와 통신하는 장치를 “앵커(anchor)”라 정의한다. 또한, 움직이는 작업자가 휴대하는 장치를 “태그(tag)”라고 정의하며, 앵커와 UWB 통신을 수행한다. 앵커는 태그와 UWB 통신을 통해 거리를 측정하고 거리정보를 토픽[17]으로 발행한다. 호스트 PC에서는 앵커로부터 거리정보를 토픽으로 구독하여 태그의 좌표를 추정한다. UR_Control 노드는 태그의 위치와 로봇의 상태를 종합적으로 고려하여 로봇을 정지시키거나 변경된 속도로 로봇을 움직이며, Gripper_Control 노드를 통해 그리퍼의 개폐 동작을 수행한다.

Fig. 1.

System configuration diagram

제안하는 시스템 환경 구성은 그림 2와 같이 앵커 3개, 태그 1개, 협동로봇 그리고 호스트 PC로 이루어져 있다. 좌표계의 단위는 1m이며 앵커, 협동 로봇, 호스트 PC는 같은 네트워크에 연결되어있다.

Fig. 2.

System development enviroment diagram

2.2 개발환경

제안하는 시스템에서 사용하는 협동로봇은 Universal Robots의 UR3로 6 자유도를 가진 협동 로봇이다. 이 로봇에 Robotiq 사의 2F-140 그리퍼를 장착하여 작업을 수행한다.

앵커는 UWB 통신과 ROS 토픽 통신하기 위해 SBC(Single Board Computer)로 Raspberry Pi 3B를 사용하였다. UWB 모듈은 Decawave 사의 DWM1000이 탑재된 Markerfabs사의 ESP32 UWB 보드를 사용한다.

SBC와 호스트 PC의 운영체제(Operating system)는 Ubuntu 20.04 LTS(Long Term Support)이며, ROS 버전은 Noetic을 사용하였다. 시뮬레이션 환경으로는 Gazebo를 사용한다.

System development environment

2.3 ROS 기반의 안전관리 시스템

ROS는 로봇 시스템의 제어, 로봇 간의 데이터 통신, 가시화, 하드웨어 연결 등의 기능별 모듈화를 가능하게 하는 미들웨어로, 많은 로봇 연구자가 사용하는 로봇 운영체제다[16]. ROS는 이기종 하드웨어 간의 데이터 통신을 통해 로봇 개발을 용이하게 한다.

ROS는 목적에 따라 세분된 최소 단위 실행 프로그램인 노드 형태로 개발된다. 노드는 또 다른 노드와 메시지를 통해 데이터를 주고받으며 하나의 커다란 프로그램을 이룬다.

그림 3은 제안하는 전체 시스템의 노드 구성과 토픽을 나타낸 것이다. 동그라미는 노드를, 화살표는 토픽 메시지 이동을 의미한다. xy_publisher 노드에서 수집한 앵커와 태그 사이의 거리를 통해 작업자의 태그 좌표를 추정하고 발행한다. velocity_update 노드에서는 해당 좌표를 수신하여 UR3 로봇과의 거리를 계산하고 거리가 1.5m 미만인 경우 낮은 로봇의 속도 파라미터값을 UR_Control 노드로 발행한다. 발행한 속도 파라미터는 동적으로 변경되기 때문에 태그를 장착한 작업자와 UR3 로봇과 가까워지면 로봇은 속도를 늦춘다. 한편, UR_Control 노드에서는 로봇의 Pick-and-Place 작업을 실행하며 Gripper_Control 노드로 그리퍼의 동작을 나타내는 문자열을 토픽으로 발행한다. Gripper_Control 노드에서 cmodel_rtu_driver 노드로 그리퍼 활성화 및 리셋, 핑거 제어 등의 명령어를 토픽으로 발행하여 최종적인 그리퍼의 동작을 실행한다.

Fig. 3.

Proposed system's overall node configure

2.4 실시간 실내 위치 추정

실시간 실내 위치 추정 시스템은 xy_publisher 노드로 구현된다. 실내 위치 추정은 그림 2와 같이 위치가 알려진 3개의 앵커와 작업자가 휴대하는 태그로 구성된다. 각각의 앵커는 실시간으로 작업자와의 거리를 측정하고, 앵커와의 거리정보를 기반으로 작업자의 위치를 추정한다.

본 논문에는 UWB 통신의 도착 시간차(Time Difference of Arrival, TDoA)를 활용한 실내 위치 추정을 수행한다[8]. UWB 기반 위치 추정은 넓은 대역폭과 낮은 간섭, 높은 시간 분해능 등의 장점이 있다[9]. 작업자의 실내 위치 추정을 위해 작업자(태그)와 앵커의 ToF(Time of Flight)를 측정하여 물리적 거리를 계산한다. 이때 ToF 측정은 SDS-TWR(Symmetric Double-side Two-Way Ranging) 알고리즘을 사용한다[18].

측정된 거리정보를 통해 2D 환경에서의 태그 좌표를 삼각 측량 기법을 사용하여 추정한다. 위치 추정에는 LLSE(Linearized Least Square Estimation) 알고리즘을 사용한다. 이 방법에서는 관측된 데이터 간의 제곱 불일치를 최소화하여 추정한다[19].

2차원 좌표추정을 위해서는 최소 3개 이상의 앵커 좌표를 알아야 한다. 태그 좌표(x,y)와 임의의 i번 앵커의 좌표(xi,yi)의 두 지점의 거리 관계를 식 (1)과 같이 나타낼 수 있고, 정리하면 식 (2)와 같이 만들 수 있다.

x-xi2+y-yi2=di2 i=1,2,3(1) 
x2+xi2-2xix+y2+yi2-2yiy=di2(2) 

임의의 기준 n번 앵커를 고려하면 식 (2)식 (3)으로 나타낼 수 있다. 식 (2)(3)을 빼서 제곱 항을 소거하여 식 (4)와 같은 선형 방정식으로 나타낼 수 있다.

x2+xn2-2xnx+y2+yn2-2yny=dn2(3) 
di2-dn2+xn2+yn2-xi2-yi2=2xn-xix+2yn-yiy(4) 
b=Ap(5) 

식 (5)식 (4)를 행렬방정식으로 나타낸 것이다. 추정하고자 하는 태그의 좌표 p는 식 (9)의 행렬 연산을 통해 좌표를 계산하고 태그의 좌표 정보를 발행한다.

b=d12-dn2+xn2-x12+yn2-y12d22-dn2+xn2-x22+yn2-y22dn-12-dn2+xn2-xn-12+yn2-yn-12(6) 
A=2x1-xny1-ynx2-xny2-ynxn-1-xnyn-1-yn(7) 
p=xy(8) 
p=ATA-1ATb(9) 

2.5 UR 로봇

본 논문에서 UR3 로봇은 2F-140 그리퍼와 결합하여 Pick-and-Place 작업을 수행한다. UR3 로봇은 그림 4과 같이 총 6개의 관절 Base, Shoulder, Elbow, Wrist 1, Wrist 2, Wrist 3으로 구성되어있다. 관절 작동 범위는 Wrist 3의 경우 무한한 회전이 가능하며, 나머지 관절은 ±360° 회전이 가능하다. 이는 로봇이 다양한 방향에서 물체를 집거나 이동시킬 수 있도록 한다. 또한, 관절 속도의 경우 모든 Wrist 관절은 360 deg/s 그 외 기타 관절은 180 deg/s이다.

Fig. 4.

Joint configuration of UR3

그리퍼는 2개의 Fingertip 사이의 폭이 140mm이며, 다양한 형태와 크기의 물체를 안정적으로 집을 수 있다. UR3 로봇은 Universal_Robots_ROS_Driver 패키지[20]를 통해 호스트 PC와 연결되며, 해당 패키지는 UR3 로봇과 ROS 간 안정적이고 지속 가능한 인터페이스를 제공한다. 로봇의 동작은 그림 3의 move_group 노드와 ur_hardware_interface 노드의 액션 통신을 통해 로봇이 관절 궤적을 따라 이동한다. 또한 UR3 로봇과 마찬가지로 ROS 환경에서 그리퍼를 제어할 수 있는 Robotiq 패키지[21]를 통해 그리퍼를 연결하여 제어 명령을 내리고 이를 통해 pick-and-place 작업을 수행한다.


Ⅲ. 실험 및 시뮬레이션 구현

3.1 실시간 실내 위치 추정 실험

제안한 시스템에 대한 실내 측위에 대한 실험을 환경의 영향을 통제한 상태에서 진행하였다. 실험 구성은 3m × 3m 영역에 세 앵커를 임의로 배치하고, 태그가 부착된 모바일 로봇을 통해 일정한 속도(0.1m/s)로 영역을 이동하며 시스템의 위치 추정과 실제 로봇의 경로를 비교하였다. 실험 결과는 다음과 같다.

그림 5는 모바일 로봇의 예상 위치와 실제 이동 경로를 시각적으로 보여준다. 파란색 점선은 실제 로봇의 이동 경로이고, 빨간색 실선은 예상되는 태그 위치이다. 실험 결과에 대한 실시간 위치 추정 오류는 그림 6과 같다.

Fig. 5.

Trajectories of true position and UWB position estimation

Fig. 6.

Localization errors

표 1은 위치 추정에 대한 평균 오차 및 최대 오차를 나타내었다. 위치 추정에 대해 최대 40cm 정도의 오차를 보인다. 프로세서의 한계로 인하여 태그와 앵커가 근접한 상황에서는 거리 측정이 부정확한 특성을 보이기 때문에 태그가 앵커와 가까워짐에 따라 오차가 커지는 것을 확인할 수 있다. 또한 이러한 오차를 줄이기 위한 연구를 다른 연구에서 활발하게 진행이며[9][19][22], 본 논문에서 구성한 실험에서는 LLSE와 같은 간단한 알고리즘을 사용한 조건에서도 높은 위치 정확도를 제공한다는 것을 확인하였다.

Performance of the localization error

3.2 Gazebo를 통한 시뮬레이션

Gazebo는 오픈소스 기반의 시뮬레이터로 로봇이 접할 수 있는 동적 환경을 재현할 수 있다[23]. Gazebo에서의 시뮬레이션은 그림 7과 같이 5.2m × 6m 크기의 3D 맵에서 진행한다. UR3 로봇 모델의 좌표는 Base 관절 좌표계의 원점으로 정의하고, 맵의 정중앙을 원점으로 (-1.5,1.5,0.8)에 위치한다. 작업자는 빨간 실선을 따라 태그를 휴대하며 UR3 로봇 모델로 접근한다.

Fig. 7.

Simulation environment configuration

Gazebo에서 수신한 태그 좌표를 통해 그림 8(a)와 같은 작업자 모형을 생성하며, UR3 로봇의 좌표와의 거리는 1.5m를 기준으로 전체 로봇 관절의 최대 속도 스케일링 값에 대한 파라미터를 통해 UR3 로봇의 속도를 조절한다.

Fig. 8.

Workspace of UR3 robot (a) Worker model (b) Obstacle placement in Gazebo

로봇의 모션플래닝은 MoveIt을 이용하여 UR3 로봇의 관절과 그리퍼에 대한 궤적을 생성하고, ROS 액션 통신을 통해 로봇을 제어한다. MoveIt은 로봇 매니퓰레이터를 위한 종합 라이브러리로, 역기구학 해석을 통한 모션플래닝 기능을 제공한다[24]. 그림 8(b)는 작업자 모형이 UR3 로봇과의 거리가 1.5m 이하일 때의 시뮬레이션 결과이다. 로봇이 작업자 모형을 부딪치지 않고 천천히 동작하는 것을 확인할 수 있다. 그림 9는 모션플래닝을 위한 장애물 설정을 Rviz를 통해 시각화한 그림이다[25]. UR3 로봇의 모션플래닝은 주위 사물, 움직이는 작업자의 위치를 고려하여 실행해야 한다. 이를 위해 작업 공간에서 고정된 환경과 작업자의 충돌 범위에 대한 모형을 추가하여 로봇이 안전한 경로로 움직일 수 있도록 한다. 시뮬레이션에서는 고정된 환경인 UR3 로봇의 지지대와 물품 받침대 그리고 작업자에 대한 충돌 모형을 생성하여 UR3 로봇과 주변 사물과의 충돌을 방지한다.

Fig. 9.

Obstacles in the workspace of the UR3 robot

3.3 실제 로봇제어 실험 및 결과

Gazebo 시뮬레이션을 통해 구현한 시스템을 실제 환경과 로봇을 사용한 실험을 진행하였다. 호스트 PC와 UR3 로봇은 URCap 프로그램을 통해 연결한다. 로봇은 ur_hardware_interface 노드와 move_group 노드 사이 FollowJointTrajectoryGoal 메시지를 통해 해당 궤적에 따라 움직인다. 그리퍼의 경우 USB 포트를 통해 호스트 PC와 연결하고 USB/RS-485 컨버터를 사용하여 Modbus RTU 명령어를 통해 제어한다. 실험 환경 구성은 그림 2와 같다. 앵커 1의 위치를 (0,0,1.2) 앵커 2는 (1.6,0,1.2) 앵커 3은 (-1.1,2.8,1.2)에 위치 시키고 UR3는 (-1.5,1.5,0.8)에 위치 시킨다. 작업자가 태그를 가지고 그림 7과 같이 이동하며, 그림 10과 같이 로봇의 작업 공간을 포함한 거리인 1.5m 이내에 위치했을 때 작업 속도가 제어되는지 실험을 통해 확인하였다.

Fig. 10.

Experiment on speed control of UR3

그림 11은 로봇의 pick-and-place 동작에 사용되는 관절 중 Base, Elbow, Wrist 2 관절의 속도를 joint_states 토픽을 통해 나타낸 그래프이며, 그림 12는 태그의 위치 추정을 통한 로봇과의 거리를 나타낸 그래프이다. UR3 로봇의 각 관절의 속도는 최대 속도 스케일링 값이 1인 경우 0.6rad/s, 0.01인 경우 0.06rad/s의 값을 가진다. 그림 11그림 12을 통해 UR3 로봇과의 거리가 1.5m 미만으로 변경되는 지점(36s)에서 속도 스케일링 값이 1에서 0.01로 변하여 로봇의 속도가 줄어든 것을 확인할 수 있다. 스케일링 값은 100배 정도 차이가 나지만 로봇의 하드웨어 제약 사항이나 짧은 거리에 대한 가감속 이동을 고려하여 10배 정도의 차이가 나는 결과를 얻었다.

Fig. 11.

Experiment on joint velocity control of UR3

Fig. 12.

Measuring the distance to the UR3 through position estimation

이를 통해 실내 위치 추정을 기반으로 로봇의 관절 속도가 감소하여 충돌에 대한 피해를 예방하는 효과를 나타낸다.


Ⅳ. 결 론

본 논문에서 ROS기반 UWB 통신 기술을 이용한 협동 로봇 안전관리 시스템을 제안하였다. 실험 결과 UWB 통신 기술을 활용한 실내 위치 추정 기술은 준수한 성능을 보이며, ROS를 통해 효과적으로 작업자의 실시간 위치를 로봇에게 전달하여 로봇의 속도를 제어하였다.

제안한 시스템은 협동 로봇, 대형 창고 및 공장과 같은 사람과 로봇이 같이 일하는 작업 환경에서 안전하고 효율적으로 로봇 작업을 수행할 수 있을 것이다. 또한, 실제 협동로봇과 ROS 플랫폼을 사용함으로써 실제 현장에서 적용 가능성을 보여주었다. 하지만 UWB 모듈을 소지한 한정된 작업자에 적용되므로 향후 UWB 측위 기술의 안정성과 정확성을 높이는 연구와 비전 센서를 이용하여 범용적인 안전 시스템에 관한 연구를 진행할 것이다.

Acknowledgments

이 연구는 금오공과대학교 대학 연구과제비로 지원되었음(과제지원년도, 2021년)

References

  • J.-N. Cheong, "Understanding collaborative robots and human-robot collaboration", The Journal of Institute of Control, Robotics and Systems, Vol. 27, No. 3, pp. 23-28, Sep. 2021.
  • M. Guertler, L. Tomidei, and N. Sick, "When is a robot a cobot? moving beyond manufacturing and ARM-Based cobot manipulators", Proceedings of the Design Society, Vol. 3, pp. 3889-3898, Jul. 2023. [https://doi.org/10.1017/pds.2023.390]
  • Z. M. Bi, C. Luo, Z. Miao, B. Zhang, W. J. Zhang, and L. Wang, "Safety assurance mechanisms of collaborative robotic systems in manufacturing", Robotics and Computer-Integrated Manufacturing, Vol. 67, pp. 102022, Feb. 2021. [https://doi.org/10.1016/j.rcim.2020.102022]
  • C. Zhou, J. Yuan, H. Liu, and J. Qiu, "Bluetooth indoor positioning based on RSSI and Kalman filter", Wireless Personal Communications , Vol. 96, pp. 4115-4130, Jul. 2017. [https://doi.org/10.1007/s11277-017-4371-4]
  • K.-J. Pi, H. Min, and K. Han "An Accuracy Assessment Scheme through Entropy Analysis in BLE-based Indoor Positioning Systems", The Journal of the Institute of Internet, Broadcasting and Communication, Vol. 22, No. 3 pp. 117-123, Jun. 2022. [https://doi.org/10.7236/JIIBC.2022.22.3.117]
  • M.-G. Kim and J.-W. Kim, "Implementation of indoor location-aware system based on probability distribution of rssi", The Journal of the Institute of Internet, Broadcasting and Communication, Vol. 8, No. 4 pp. 9-14, Aug. 2008.
  • J. Qu, "A review of UWB indoor positioning", Journal of Physics: Conference Series, Vol. 2669, pp. 1203, Dec. 2023. [https://doi.org/10.1088/1742-6596/2669/1/012003]
  • A. Alarifi, et al., "Ultra wideband indoor positioning technologies: Analysis and recent advances", Sensors, Vol. 16, No. 5, pp. 707, May 2016. [https://doi.org/10.3390/s16050707]
  • F. Che, Q. Z. Ahmed, P. I. Lazaridis, P. Sureephong, and T. Alade, "Indoor Positioning System (IPS) Using Ultra-Wide Bandwidth (UWB)—For Industrial Internet of Things (IIoT)", Sensors Vol. 23, No. 12, pp. 5710, Jun. 2023. [https://doi.org/10.3390/s23125710]
  • B.-J. Jang, "Principles and Trends of UWB Positioning Technology", The Journal of Korean Institute of Electromagnetic Engineering and Science,  Vol. 33, No. 1, pp. 1-11, Jan. 2022. [https://doi.org/10.5515/KJKIEES.2022.33.1.1]
  • L. Zamora-Cadenas, I. Velez, and J. Enrique Sierra-Garcia, "UWB-based safety system for autonomous guided vehicles without hardware on the infrastructure", IEEE Access, Vol. 9, pp. 96430-96443, Jul. 2021. [https://doi.org/10.1109/ACCESS.2021.3094279]
  • S. Monica and G. Ferrari, "Low-complexity UWB-based collision avoidance system for automated guided vehicles", ICT Express, Vol.  2, No. 2, pp. 53-56, Jun. 2016. [https://doi.org/10.1016/j.icte.2016.05.004]
  • M. S. M. A. Khesbak, "Enabling Collision Avoidance in Human-Robot Collaborative Industrial Environment: Prototype of Safe UWB-based Hybrid Positioning System", Diss. City University, Apr. 2020.
  • W. Wang, Z. Zeng, and W. Ding, "Concept and validation of a large-scale human-machine safety system based on real-time UWB indoor localization", Macau, China, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 201-207, Nov. 2019. [https://doi.org/10.1109/IROS40897.2019.8968572]
  • J.-H. Son, T.-H. Kim and Y.-J. Bae, "Collaborative Robot Safety Management System Using UWB communication Technology", in Proceedings of KIIT Conference, Jeju, Korea, pp. 581-586. Jun. 2023.
  • https://wiki.ros.org/ROS/Introduction, [accessed: Jan. 31, 2024]
  • M. Quigley, et al., "ROS: an open-source Robot Operating System", ICRA workshop on open source software, Vol. 3. No. 3.2, pp. 5, 2009.
  • M. Kwak and J. Chong, "A new double two-way ranging algorithm for ranging system", 2010 2nd IEEE InternationalConference on Network Infrastructure and Digital Content. IEEE, Beijing, China, pp. 470-473, Dec. 2010. [https://doi.org/10.1109/ICNIDC.2010.5657814]
  • A. Poulose, O. S. Eyobu, M. Kim, and D. S. Han, "Localization Error Analysis of Indoor Positioning System Based on UWB Measurements", 2019 Eleventh International Conference on Ubiquitous and Future Networks (ICUFN), Zagreb, Croatia, pp. 84-88, Jul. 2019. [https://doi.org/10.1109/ICUFN.2019.8806041]
  • https://github.com/UniversalRobots/Universal_Robots_ROS_Driver, [accessed: Jan. 31, 2024]
  • https://github.com/cambel/robotiq, [accessed: Jan. 31, 2024]
  • G. Schroeer, "A Real-Time UWB Multi-Channel Indoor Positioning System for Industrial Scenarios", 2018 International Conference on Indoor Positioning and Indoor Navigation (IPIN), Nantes, France, pp. 1-5, Sep. 2018. [https://doi.org/10.1109/IPIN.2018.8533792]
  • N. Koenig and A. Howard, "Design and use paradigms for Gazebo, an open-source multi-robot simulator", 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Sendai, Japan, Vol. 3, pp. 2149-2154, Sep. 2004. [https://doi.org/10.1109/IROS.2004.1389727]
  • S. Chitta, I. Sucan, and S. Cousins, "Moveit![ros topics]", IEEE Robotics & Automation Magazine(2012), Vol. 19, No. 1, pp. 18-19, 2012.
  • C. Li, L. Hao, H. Cheng, and X. Nie, "Research on Motion Planning System of Service Robot Based on ROS", 2017 IEEE 7th Annual International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER), Honolulu, HI, USA, pp. 205-209, Aug. 2017. [https://doi.org/10.1109/CYBER.2017.8446559]
저자소개
최 낙 원 (Nak-Won Choi)

2023년 2월 : 금오공과대학교 전자공학부 정보전자전공(공학사)

2023년 3월 ~ 현재 : 금오공과대학교 IT융복합공학과 석사과정

관심분야 : 지능형로봇 및 제어, ROS, 인간-로봇 상호작용(HRI) 기술

손 지 훈 (Ji-Hun Son)

2018년 3월 ~ 현재 : 국립금오공과대학교 전자공학부 학사과정

관심분야 : 지능형로봇 및 제어, 임베디드 시스템, 인간-로봇 상호작용(HRI) 기술

김 영 빈 (Yeong-Bin Kim)

2023년 2월 : 금오공과대학교 전자공학부 정보전자전공(공학사)

2023년 3월 ~ 현재 : 금오공과대학교 IT융복합공학과 석사과정

관심분야 : 지능형로봇 및 제어, ROS, 인간-로봇 상호작용(HRI) 기술

박 범 용 (Bum-Yong Park)

2009년 2월 : 경북대학교 전자전기컴퓨터공학부(공학사)

2011년 2월 : 포항공과대학교 전자전기공학과(공학석사)

2015년 8월 : 포항공과대학교 전자전기공학과(공학박사)

2017년 8월 : 삼성전자 생산기술연구소 책임연구원

2017년 9월 ~ 현재 : 금오공과대학교 전자공학부, IT융복합공학과 부교수

관심분야 : Robust control, robot manipulator system, 신호 처리, 임베디드 제어 시스템

Fig. 1.

Fig. 1.
System configuration diagram

Fig. 2.

Fig. 2.
System development enviroment diagram

Fig. 3.

Fig. 3.
Proposed system's overall node configure

Fig. 4.

Fig. 4.
Joint configuration of UR3

Fig. 5.

Fig. 5.
Trajectories of true position and UWB position estimation

Fig. 6.

Fig. 6.
Localization errors

Fig. 7.

Fig. 7.
Simulation environment configuration

Fig. 8.

Fig. 8.
Workspace of UR3 robot (a) Worker model (b) Obstacle placement in Gazebo

Fig. 9.

Fig. 9.
Obstacles in the workspace of the UR3 robot

Fig. 10.

Fig. 10.
Experiment on speed control of UR3

Fig. 11.

Fig. 11.
Experiment on joint velocity control of UR3

Fig. 12.

Fig. 12.
Measuring the distance to the UR3 through position estimation

Table 1.

System development environment

Development tools
Collaborative robot Universal Robots UR3
Robotiq 2F-140
UWB module Makerfabs ESP32 UWB
SBC Raspberrt Pi 3B
Host PC Ubuntu 20.04 ROS Noetic

Table 2.

Performance of the localization error

X Y
Mean error (m) -0.066984 -0.159255
Max error (m) -0.277209 -0.408585