Abstract
In this paper, a method of shape prediction of an endoscope handling robot that can imitate a surgeon's behavior using a sensor network is suggested. Unit sensors, which are composed of a 3-axis magnetometer and 3-axis accelerometer pair comprise the network through CAN bus communication. Each unit of the sensor is used to detect the angle of the points in the longitudinal direction of the robot, which is made from a flexible tube. The signals received from the sensor network were filtered using a low pass Butterworth filter. Here, a Butterworth filter was designed for noise removal. Finally, the Euler angles were extracted from the signals, in which the noise was filtered by the low path Butterworth filter. Using this Euler angle, the position of each sensor on the sensor network is estimated. The robot body was assumed to consist of links and joints. The position of each sensor can be assumed to be attached to the center of each link. The position of each link was determined using the Euler angle and kinematics equation. The interpolation was carried out between the positions of the sensors to be able to connect each point smoothly and obtain the final posture of the endoscope in operation. The experimental results showed that the shape of the colonoscope can be visualized using the Euler angles evaluated from the sensor network suggested and the shape of serial link estimated from the kinematics chain model.
본 논문에서는 센서 네트워크를 이용하여 의사의 동작을 흉내 낼 수 있는 내시경 취급로봇의 형상 예측방법이 제안된다. 3축 지자기계와 3축 가속도 계로 이루어진 단위센서가 CAN버스 통신을 통하여 네트워크를 구성한다. 각각의 센서 유니트는 연성 튜브로 만들어진 로봇의 길이방향 위에 있는 점들의 각들을 검출하는 데 사용된다. 센서 네트워크로부터 수신된 신호들은 Butterworth lowpass filter를 이용하여 필터링 된다. 여기서 우리는 노이즈 제거를 위하여 버터워쓰 필터를 설계하였다. 최종적으로 로패스 필터에 의하여 노이즈가 걸러진 신호들을 처리하여 Euler 각이 추출된다. 이 Euler 각을 이용하여 sensor network 상에 있는 각 센서의 위치가 추정된다. 우리는 로봇 바디가 링크와 관절들로 구성되어 있다고 가정한다. 그러면 각 센서의 위치는 각 링크의 중심에 부착되어 있는 것으로 가정할 수 있다. Euler 각과 kinematics chain model로부터 링크의 위치를 결정할 수 있다. 각 링크를 매끈하게 연결할 수 있도록 하기 위해 각 센서의 위치사이에 보간이 수행되어 최종적으로 작동 중에 있는 내시경의 최종형상이 얻어진다. 실험 결과는 제시된 센서 네트워크에서 추정된 Euler angle과 kinematic chain model을 이용하여 추정된 serial link의 형상으로부터 내시경형상을 가시화 할 수 있음을 보여준다.