KR100877983B1 - Objcctive compoliancy apparatus and method of robot - Google Patents

Objcctive compoliancy apparatus and method of robot Download PDF

Info

Publication number
KR100877983B1
KR100877983B1 KR1020020013007A KR20020013007A KR100877983B1 KR 100877983 B1 KR100877983 B1 KR 100877983B1 KR 1020020013007 A KR1020020013007 A KR 1020020013007A KR 20020013007 A KR20020013007 A KR 20020013007A KR 100877983 B1 KR100877983 B1 KR 100877983B1
Authority
KR
South Korea
Prior art keywords
signal
target
command
motor
acceleration
Prior art date
Application number
KR1020020013007A
Other languages
Korean (ko)
Other versions
KR20030073447A (en
Inventor
황준섭
Original Assignee
주식회사 엘지이아이
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 주식회사 엘지이아이 filed Critical 주식회사 엘지이아이
Priority to KR1020020013007A priority Critical patent/KR100877983B1/en
Publication of KR20030073447A publication Critical patent/KR20030073447A/en
Application granted granted Critical
Publication of KR100877983B1 publication Critical patent/KR100877983B1/en

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls

Abstract

본 발명은 로봇의 목표물 추종장치 및 방법에 관한 것으로, 가속도 센서 및 이전 명령의 가중치 적용 기법을 이용하여 부드럽게 목표물을 추종할 수 있도록 한 것이다. 이를 위하여 본 발명은 씨씨디 카메라를 통해 입력되는 영상정보를 소정 신호처리하고, 상기 신호처리된 영상정보에서 목표물을 추출하는 영상신호처리기와; 상기 영상신호처리기에서 출력되는 영상신호로 목표물까지의 거리 및 이동경로를 산출하여 그에 따른 위치 이동명령을 내리는 동작처리기와; 현재 모터의 가속도를 검출하는 가속도 센서와; 상기 가속도 센서의 가속도 신호와 상기 동작처리기의 위치 이동명령을 이용하여, 현재 위치 명령의 예측치 및 이후의 위치 명령의 예측치를 산출하여 모터를 구동하기 위한 PWM 신호를 출력하는 모터 제어부를 포함하여 구성한다.The present invention relates to a target tracking device and a method of a robot, and to follow the target smoothly using an acceleration sensor and a weighting technique of a previous command. To this end, the present invention comprises a video signal processor for pre-processing the image information input through the CD camera, and extracts a target from the signal processed image information; An operation processor configured to calculate a distance to a target and a movement path using the image signal output from the image signal processor and issue a position movement command accordingly; An acceleration sensor for detecting an acceleration of the current motor; And a motor controller for outputting a PWM signal for driving the motor by calculating an estimated value of a current position command and a predicted value of a later position command by using an acceleration signal of the acceleration sensor and a position movement command of the motion processor. .

Description

로봇의 목표물 추종장치 및 방법{OBJCCTIVE COMPOLIANCY APPARATUS AND METHOD OF ROBOT}OBJCCTIVE COMPOLIANCY APPARATUS AND METHOD OF ROBOT}

도1은 일반적인 로봇의 제어장치에 대한 구성을 보인 블록도.1 is a block diagram showing a configuration for a control device of a general robot.

도2는 도1에 있어서, 로봇의 목표물 추종장치에 대한 구성을 보인 블록도.Figure 2 is a block diagram showing the configuration for the target tracking device of the robot in Figure 1;

도3은 본 발명 로봇의 목표물 추종장치에 대한 구성을 보인 블록도.Figure 3 is a block diagram showing the configuration for the target tracking device of the present invention robot.

도4는 본 발명 로봇의 목표물 추종방법에 대한 동작 흐름도. Figure 4 is an operation flowchart for a target tracking method of the robot of the present invention.

*** 도면의 주요부분에 대한 부호의 설명 ****** Explanation of symbols for main parts of drawing ***

1:영상신호처리기 2:동작처리기1: Image signal processor 2: Motion processor

100:모터제어부 101:시간차이검출부100: motor control unit 101: time difference detection unit

102:비례적분제어기 200:가속도센서102: proportional integral controller 200: acceleration sensor

본 발명은 보행 로봇의 목표물 추종장치 및 방법에 관한 것으로, 특히 부드러운 동작으로 목표물 추종이 가능하도록 한 보행 로봇의 목표물 추종장치 및 방법에 관한 것이다.The present invention relates to a target tracking device and a method of a walking robot, and more particularly, to a target tracking device and a method of a walking robot to enable a target tracking with a smooth motion.

최근, 소니(SONY)에 의해 발표된 AIBO는 산업로봇을 중심으로 하여 주도되던 기존의 로봇 업계에 애완 로봇 혹은 엔터테인먼트 로봇이라는 새로운 분야에 대한 가능성을 제시하였다.Recently, AIBO announced by Sony has opened up the possibility of a new field of pet robots or entertainment robots to the existing robot industry that was led by industrial robots.

이러한 엔터테인먼트 로봇은 기능성이라는 측면은 배제하고, 단지 즐거움만을 사용자에게 제공한다는 측면에서 기존의 틀을 깬 것이다.These entertainment robots break the existing framework in that they provide only enjoyment to users, excluding functionality.

이러한 종류의 제품은 일반적으로 사용자의 목적에 의해서만 작업을 진행하는 산업용 로봇과는 달리 인공지능을 가지고 있어, 로봇 스스로, 즉 자율적으로 자신의 행동을 결정하고 행동할 수 있다. Unlike industrial robots, which typically work only for the purpose of the user, this type of product has artificial intelligence that allows the robot to determine and act on its own, autonomously.

일반적으로 이러한 자율적인 행동 및 로봇 내부의 감정 상태를 표현하기 위하여 로봇은 사물을 관측할 수 있는 카메라, 물체와의 거리 및 충돌방지를 위한 IR혹은 초음파 센서 등을 구비하고 있으며, 음성 인식 등을 위한 스피커와 행동을 제어하기 위한 각종 센서를 구비하고 있다.Generally, in order to express such autonomous behavior and emotional state inside the robot, the robot is equipped with a camera for observing an object, an IR or ultrasonic sensor for preventing a collision with the object, and an ultrasonic sensor. It is equipped with various sensors for controlling the speaker and behavior.

특정 목표의 추적을 위해서는 일반적으로 카메라의 영상신호를 처리하는 화상신호(Vision processing)처리 장치가 부착되어 있어야 하며, 이러한 화상처리의 결과를 이용하여 애완용 로봇의 머리부분이나 전체 몸 동작을 제어하는 동작제어 처리기에 특정 위치로의 명령을 전달하여, 몸 전체의 움직임을 제어하여야 한다.In order to track a specific target, an image processing (Vision processing) processing device for processing a video signal of a camera should generally be attached. An operation of controlling the head or the whole body motion of a pet robot using the result of the image processing Commands to the control processor to the specific position to control the movement of the entire body.

도1은 일반적인 보행 로봇의 제어장치에 대한 구성을 보인 블록도로서, 이에 도시된 바와같이 CCD 혹은 CMOS 카메라에서 들어오는 영상정보를 처리하는 영상신호처리기(1)와, 상기 영상신호처리기(1)에서 처리된 신호를 이용하여 목표물까지의 거리 및 이동경로 등을 계산하는 동작처리기(2)와, 상기 동작처리기(2)에 로봇의 각종 정보를 제공하는 센서(3), 상기 동작처리기(2)로부터 들어오는 동작명령을 이용하여 직접적으로 로봇의 각 관절의 위치를 명령위치로 제어하는 모터제어용 신호처리기(4)와, 상기 모터제어용 신호처리기(4)의 신호를 적절한 레벨의 전압 및 전류로 변환하여 모터(6)에 인가하는 모터 구동부(5)와, 모터(6)의 위치를 감지하여 적절한 전압신호로 변환하는 위치감지센서(7)로 구성된다.FIG. 1 is a block diagram showing a configuration of a control apparatus of a general walking robot. As shown in FIG. 1, an image signal processor 1 for processing image information from a CCD or CMOS camera, and the image signal processor 1 in FIG. The motion processor 2 calculates the distance to the target and the movement path using the processed signal, and the sensor 3 which provides various kinds of information of the robot to the motion processor 2, and the motion processor 2 from the motion processor 2. The motor control signal processor 4 which directly controls the position of each joint of the robot to the command position by using an incoming operation command, and converts the signal of the motor control signal processor 4 into a voltage and current of an appropriate level And a position detecting sensor 7 for detecting the position of the motor 6 and converting it into an appropriate voltage signal.

그 밖에도 애완용 로봇에는 음성신호를 처리하기 위한 부분 및 감정상태를 외부로 표현하기 위한 LCD 혹은 LED등의 각종 디스플레이장치 및 사용자 입력처리기, 다른 로봇 및 개인용 컴퓨터와의 통신을 위한 통신 모듈을 구비하고 있다.In addition, the pet robot is equipped with various display devices such as LCDs or LEDs for expressing parts of voice signals and emotions to the outside, user input processors, and communication modules for communication with other robots and personal computers. .

도2는 종래 보행 로봇의 목표물 추종을 위한 개략도로서, 카메라의 영상 신호를 영상신호처리기(1)에서 처리하여 추적하고자 하는 목표물이 있는 경우에는, 동작처리기(2)에 영상신호를 전달하여 목표물의 위치를 알린다.2 is a schematic diagram for tracking a target of a conventional walking robot. When there is a target to be processed by tracking the video signal of the camera in the image signal processor 1, the image signal is transferred to the motion processor 2 to transfer the target signal. Announce the location.

상기 동작처리기(2)는 목표물의 현재위치와 움직이는 방향을 계산하여,모터 제어부 (10)에 위치 이동명령을 내린다.The operation processor 2 calculates the current position and the moving direction of the target, and gives a position movement command to the motor controller 10.

상기 모터제어부(10)는 각 모터(6)의 현재 위치와 위치 명령의 차이를 비례 적분하여 그에 따른 펄스폭 변조(PWM) 출력을 계산한후, 그 펄스폭변조신호(PWM)를 각 부의 모터(6)에 인가한다.The motor control unit 10 proportionally integrates the difference between the current position of each motor 6 and the position command, calculates the pulse width modulation (PWM) output accordingly, and then outputs the pulse width modulation signal (PWM) of each motor. It applies to (6).

상술한 종래 로봇의 목표물 추종방법은, 애완용 로봇의 머리가 목표물을 당연히 추적하지만, 그 움직이는 모양이 카메라의 영상신호를 처리하는 영신신호처리기의 목표물의 위치를 알려주는 명령의 시간 간격에 따라, 외부에서 바라보는 머리의 움직임이 매우 부자연스러워지는데, 즉 로봇의 위치 명령의 시간간격이 영상신호처리기의 느림으로 인하여 느리게 전송되는 경우에는 외부에서 보이는 움직임이 끊어져 보이는 문제점이 있다.In the above-described conventional method for tracking a target, the head of the pet robot naturally tracks the target, but the moving shape of the target robot indicates the position of the target of the Youngshin signal processor that processes the video signal of the camera. The movement of the head looking at becomes very unnatural, that is, when the time interval of the position command of the robot is transmitted slowly due to the slowness of the image signal processor, there is a problem that the externally visible movement is broken.

또한, 비례 적분 제어시, 목표물에 추종하는 시간과 오버슈트를 최소로 하는 경향이 있기 때문에 목표위치로 최단 시간동안 이동하려고 하지만, 연속된 신호인 것처럼 보여야 할 이동경로가 자연스러운 로봇의 동작과는 다소 멀어지는 현상이 발생하는 문제점이 있다.In addition, in proportional integration control, the time to follow the target and the overshoot tend to be minimized. However, the movement path to be seen as a continuous signal is somewhat different from that of the natural robot. There is a problem that far away phenomenon occurs.

본 발명은 상기와 같은 문제점을 해결하기 위하여 안출된 것으로, 가속도 센서 및 이전 명령의 가중치 적용 기법을 이용하여 부드럽게 목표물을 추종할 수 있도록 한 로봇의 목표물 추종 장치 및 방법을 제공함에 그 목적이 있다.The present invention has been made to solve the above problems, and an object of the present invention is to provide an apparatus and method for tracking a target of a robot that can smoothly follow a target using a weighting technique of an acceleration sensor and a previous command.

상기와 같은 목적을 달성하기 위한 본 발명은, 씨씨디 카메라를 통해 입력되는 영상정보를 소정 신호처리하고, 상기 신호처리된 영상정보에서 목표물을 추출하는 영상신호처리기와; 상기 영상신호처리기에서 출력되는 영상신호로 목표물까지의 거리 및 이동경로를 산출하여 그에 따른 위치 이동명령을 내리는 동작처리기와; 현재 모터의 가속도를 검출하는 가속도 센서와; 상기 가속도 센서의 가속도 신호와 상기 동작처리기의 위치 이동명령을 이용하여, 현재 위치 명령의 예측치 및 이후의 위치 명령의 예측치를 산출하여 모터를 구동하기 위한 PWM 신호를 출력하는 모터 제어부를 포함하는 것을 특징으로 한다.According to an aspect of the present invention, there is provided an image signal processor configured to perform predetermined signal processing on image information input through a CD camera and extract a target object from the signal processed image information; An operation processor configured to calculate a distance to a target and a movement path using the image signal output from the image signal processor and issue a position movement command accordingly; An acceleration sensor for detecting an acceleration of the current motor; And a motor controller configured to output a PWM signal for driving the motor by calculating an estimated value of a current position command and an estimated value of a later position command by using an acceleration signal of the acceleration sensor and a position movement command of the motion processor. It is done.

상기와 같은 목적을 달성하기 위한 본 발명은, 목표물을 추출하여, 상기 목표물의 변위를 산출하는 제1 과정과; 현재 모터의 가속도를 검출하여, 상기 검출된 가속도에 따라 비례적분 제어기의 이득을 변경하는 제2 과정과; 이전 위치 이동명령에 일정한 가중치를 이용하여 현재 목표물의 위치를 예측하는 제3 과정과; 상기 목표물의 위치 예측에 따른 위치 이동 명령신호를, 상기 이득에 따라 비례 적분하는 제4 과정과; 상기 위치 이동 명령신호에 따른 PWM 신호를 산출하고, 상기 산출된 PWM 신호를 모터의 위치신호로 인가하는 제5 과정으로 수행함을 특징으로 한다.The present invention for achieving the above object, the first process for extracting the target, calculating the displacement of the target; Detecting a current acceleration of the motor and changing a gain of the proportional integral controller according to the detected acceleration; A third process of predicting the position of the current target by using a predetermined weight in the previous position movement command; A fourth process of proportionally integrating a position movement command signal according to the position prediction of the target according to the gain; And a fifth process of calculating a PWM signal according to the position movement command signal and applying the calculated PWM signal as a position signal of a motor.

이하, 본 발명에 의한 로봇의 목표물 추종장치 및 방법에 대한 실시예의 작용 및 효과를 첨부한 도면을 참조하여 상세히 설명한다.Hereinafter, with reference to the accompanying drawings the operation and effects of the embodiment of the target tracking device and method of the robot according to the present invention will be described in detail.

도3은 본 발명 로봇의 목표물 추종장치에 대한 실시예의 구성을 보인 블록도로서, 이에 도시한 바와같이 씨씨디 카메라를 통해 입력되는 목표물에 대한 영상정보를 소정 신호처리하는 영상신호처리기(1)와; 상기 영상신호처리기(1)에서 출력되는 영상신호로 목표물까지의 거리 및 이동경로를 산출하여 그에 따른 위치 이동명령을 내리는 동작처리기(2)와; 현재 모터의 가속도를 검출하는 가속도 센서(200)와; 상기 가속도 센서(200)의 가속도신호와 상기 동작처리기(2)의 위치이동명령을 이용하여, 현재 위치 명령의 예측치 및 이후의 위치 명령의 예측치를 산출하여 모터를 구동하기 위한 PWM신호를 출력하는 모터 제어부(100)로 구성한다.Figure 3 is a block diagram showing an embodiment of a target tracking device of the robot of the present invention, as shown in the image signal processor 1 for predetermined signal processing of the image information about the target input through the CD camera and ; An operation processor (2) for calculating a distance to a target and a movement path with an image signal output from the image signal processor (1) and giving a position movement command accordingly; An acceleration sensor 200 for detecting an acceleration of the current motor; A motor for outputting a PWM signal for driving the motor by calculating the predicted value of the current position command and the predicted value of the subsequent position command by using the acceleration signal of the acceleration sensor 200 and the position shift command of the motion processor 2. It consists of the control part 100.

상기 모터제어부(100)는 상기 동작처리기(2)에서 현재 입력되는 위치 이동명령신호를 이전 이동명령신호와 비교하여 시간차이를 검출하는 시간차이검출부(101)와; 상기 동작처리기(2)의 위치이동명령신호를 입력받아 이를 가속도 신호 및 시간차이에 의해 이득을 변경하는 비례 적분 제어기(102)를 구비한다.The motor controller 100 includes: a time difference detector 101 for detecting a time difference by comparing a position movement command signal currently input by the operation processor 2 with a previous movement command signal; And a proportional integral controller 102 which receives the position shift command signal of the operation processor 2 and changes the gain by the acceleration signal and the time difference.

도4는 본 발명 로봇의 목표물 추종방법에 대한 동작흐름도로서, 이에 도시한 바와같이 목표물을 추출하여, 그 목표물의 변위를 산출하는 제1 과정과; 현재 모터의 가속도를 검출하여, 그 가속도에 따라 비례적분 제어기(102)의 이득을 변경하는 제2 과정과; 이전 위치 이동명령에 일정한 가중치를 이용하여 현재 목표물의 위치를 예측하는 제3 과정과; 상기 목표물의 위치 예측에 따른 위치 이동 명령신호를, 상기 이득에 따라 비례 적분하는 제4 과정과; 상기 위치 이동 명령신호에 따른 PWM신호를 산출한 후, 그 PWM신호를 모터의 위치신호로 인가하는 제5 과정으로 이루어지며, 이와같은 본 발명의 동작을 설명한다.4 is a flowchart illustrating a target tracking method of the robot according to an embodiment of the present invention, and the first step of extracting a target and calculating a displacement of the target as shown in the drawing; Detecting a current acceleration of the motor and changing a gain of the proportional integral controller 102 according to the acceleration; A third process of predicting the position of the current target by using a predetermined weight in the previous position movement command; A fourth process of proportionally integrating a position movement command signal according to the position prediction of the target according to the gain; After calculating the PWM signal according to the position movement command signal, a fifth process of applying the PWM signal as the position signal of the motor is described. The operation of the present invention will be described.

먼저, 영상신호처리기(1)는, 씨씨디 카메라를 통해 입력되는 목표물에 대한 영상정보를 소정 신호처리하여 이를 동작처리기(2)에 인가하고, 이에 의해 상기 동작처리기(2)는 상기 영상신호처리기(1)에서 출력되는 영상신호로 목표물까지의 거리 및 이동경로를 산출하여 그에 따른 위치 이동명령을 모터제어부(100)에 내린다.First, the image signal processor 1 performs a predetermined signal processing on the image information about the target input through the CD camera and applies it to the operation processor 2, whereby the operation processor 2 causes the image signal processor to The distance to the target and the movement path are calculated by the video signal output from (1), and the position movement command is issued to the motor controller 100 accordingly.

한편, 가속도센서(200)는 현재 모터의 가속도를 검출하여 이를 모터제어부 (100)에 인가한다. Meanwhile, the acceleration sensor 200 detects the acceleration of the current motor and applies it to the motor controller 100.                     

이에 따라, 상기 모터 제어부(100)는 상기 가속도 센서(200)의 가속도신호와 상기 동작처리기(2)의 위치이동명령을 이용하여, 현재 위치 명령의 예측치 및 이후의 위치 명령의 예측치를 산출하여 모터를 구동하기 위한 PWM신호를 출력한다.Accordingly, the motor controller 100 calculates the predicted value of the current position command and the predicted value of the subsequent position command by using the acceleration signal of the acceleration sensor 200 and the position shift command of the motion processor 2. Outputs a PWM signal to drive.

즉, 상기 모터제어부(100)의 시간차이검출부(101)는 상기 동작처리기(2)에서 현재 입력되는 위치 이동명령신호를 이전 이동명령신호와 비교하여 시간차이를 검출하고, 모터제어부(100)의 비례적분제어기(102)는 상기 동작처리기(2)의 위치이동명령신호를 입력받아 이를 가속도 신호 및 시간차이에 의해 이득을 변경하는데, 각 모터의 현재 위치와 위치명령의 차이 및 로봇 전체의 현재 상태를 알 수 있는 가속도 센서의 신호 및 이전 위치 명령의 가중치를 이용한 현재위치 명령의 예측치 및 이후 명령의 예측치를 이용하여 비례적분 제어기를 통한 펄스폭 변조(PWM)출력을 계산하고 각 부의 모터에 펄스폭 변조신호를 인가한다.That is, the time difference detection unit 101 of the motor controller 100 detects the time difference by comparing the position movement command signal currently input from the operation processor 2 with the previous movement command signal, and detects the time difference of the motor controller 100. The proportional integral controller 102 receives the position shift command signal of the operation processor 2 and changes the gain by the acceleration signal and the time difference, and the difference between the current position and position command of each motor and the current state of the entire robot. Calculate the pulse width modulation (PWM) output through the proportional integral controller using the current position command's prediction using the acceleration sensor's signal and the weight of the previous position command and the prediction value of the next command. Apply the modulated signal.

종래와 달리, 상기 가속도 센서(200)의 신호를 이용하는 것은 로봇의 현재 자세에 따라 로봇의 머리가 움직이는데 필요한 최소 동력이 달라지기 때문인데, 예를 들면 로봇이 4족을 이용하여 정상태로 정지하였을 경우에는 머리를 들어올리는데 필요한 힘이 머리를 내리는데 필요한 에너지보다 당연히 더 필요하게 된다.Unlike the related art, the signal of the acceleration sensor 200 is used because the minimum power required to move the head of the robot varies according to the current posture of the robot, for example, when the robot is stopped in a steady state using four groups. Of course, the power needed to lift the head is naturally more than the energy needed to lower the head.

따라서, 상기 가속도센서(200)에서 들어오는 신호는 자세에 따라 비례적분제어기 (102)의 이득을 변경시키는데 사용된다.Therefore, the signal coming from the acceleration sensor 200 is used to change the gain of the proportional integral controller 102 according to the attitude.

또한, 목표물의 움직임은 시간에 따라 그 속도가 가변이지만, 영상처리기(1)의 신호처리는 거의 일정하게 영상처리를 하므로, 그 영상처리기(2)가 줄 수 있는 명령으로 표현할 수 있는 최대 주파수는 영상 처리기의 주파수를 2f라고 한다면, f 라는 것으로 표현할 수 있다.In addition, although the speed of the target's movement varies with time, the signal processing of the image processor 1 performs the image processing almost constant, so the maximum frequency that can be expressed by the command that the image processor 2 can give is If the frequency of the image processor is 2f, it can be expressed as f.

만약 목표물이 f이상의 속도로 가변 되어진다면, 로봇의 움직임은 당연히 그 움직임을 추적하지 못할 것이다. If the target is variable at speeds above f, the robot's movement will not be able to track it.

따라서, 상기 모터 제어부(100)는 제어 명령의 이전 데이터들을 이용하여 목표물의 움직임을 가상적으로 파악하는 기법을 구사하여야 하는데, 이를 도4를 참조하여 설명한다.Therefore, the motor controller 100 should use a technique for virtually detecting the movement of the target by using previous data of the control command, which will be described with reference to FIG. 4.

우선, 목표물을 추출하여, 그 목표물의 변위를 산출하고, 현재 모터의 가속도를 검출하여, 그 가속도에 따라 비례적분 제어기의 이득을 변경한다.First, the target is extracted, the displacement of the target is calculated, the acceleration of the current motor is detected, and the gain of the proportional integral controller is changed in accordance with the acceleration.

그 다음, 이전 위치 이동명령에 일정한 가중치를 이용하여 현재 목표물의 위치를 예측하는데, 이때 이전 위치변화 명령신호가 오래된 명령일수록 가중치의 값을 작게 설정한다. Next, the position of the current target is predicted by using a constant weight in the previous position movement command. In this case, the older the position change command signal is, the smaller the value of the weight is set.

예를 들면, 현재의 명령이 n이면 이전 명령은 n-1, n-2등이 될 것이며 오래된 명령일수록 가중치의 값이 적어져 현재 명령에 미치는 영향이 적다.For example, if the current command is n, the previous command will be n-1, n-2, etc. The older the command, the smaller the value of the weight and less influence on the current command.

그 다음, 상기 목표물의 위치 예측에 따른 위치 이동 명령신호를, 상기 이득에 따라 비례 적분한 다음, 상기 위치 이동 명령신호에 따른 PWM신호를 산출한 후,그 PWM신호를 모터의 위치신호로 인가한다.Next, the position shift command signal according to the position prediction of the target is proportionally integrated according to the gain, and after calculating the PWM signal according to the position shift command signal, the PWM signal is applied as the position signal of the motor. .

다시 말해서, 본 발명은, 가속도 센서에서 나오는 신호를 이용하여 비례적분 제어기의 이득이 가변적으로 조정되며, 목표물의 부드러운 추종을 위하여, 가중치와 이전명령들의 곱으로 현재 명령을 갱신하여 목표물의 궤적을 어느정도 예측할 수 있게 된다.In other words, in the present invention, the gain of the proportional integral controller is variably adjusted by using the signal from the acceleration sensor, and for smooth tracking of the target, the current instruction is updated by the product of the weight and the previous instructions to some extent to adjust the trajectory of the target. Predictable.

상기 본 발명의 상세한 설명에서 행해진 구체적인 실시 양태 또는 실시예는 어디까지나 본 발명의 기술 내용을 명확하게 하기 위한 것으로 이러한 구체적 실시예에 한정해서 협의로 해석해서는 안되며, 본 발명의 정신과 다음에 기재된 특허 청구의 범위내에서 여러가지 변경 실시가 가능한 것이다.Specific embodiments or examples made in the detailed description of the present invention are intended to clarify the technical contents of the present invention to the extent that they should not be construed as limited to these specific embodiments and should not be construed in consultation. Various changes can be made within the scope of.

이상에서 상세히 설명한 바와같이 본 발명은, 로봇의 목표물 추적에 있어서 기존의 비례 적분제어기에서 처리하여 생길 수 있는 동작의 부자연스러움을 가속도 센서 및 이전 명령의 가중치 적용 기법을 이용하여 부드럽게 할 수 있으며, 목표물의 빠른 변화에도 대응할 수 있는 효과가 있다.As described in detail above, the present invention can smooth the unnaturalness of the motion that can be generated by the existing proportional integral controller in the target tracking of the robot by using the acceleration sensor and the weighting technique of the previous command. It is effective to cope with the rapid change of.

Claims (7)

씨씨디 카메라를 통해 입력되는 영상정보를 소정 신호처리하고, 상기 신호처리된 영상정보에서 목표물을 추출하는 영상신호처리기와;An image signal processor configured to perform predetermined signal processing on image information input through the CD camera and extract a target object from the signal processed image information; 상기 영상신호처리기에서 출력되는 영상신호로 목표물까지의 거리 및 이동경로를 산출하여 그에 따른 위치 이동명령을 내리는 동작처리기와;An operation processor configured to calculate a distance to a target and a movement path using the image signal output from the image signal processor and issue a position movement command accordingly; 현재 모터의 가속도를 검출하는 가속도 센서와;An acceleration sensor for detecting an acceleration of the current motor; 상기 가속도 센서의 가속도 신호와 상기 동작처리기의 위치 이동명령을 이용하여, 현재 위치 명령의 예측치 및 이후의 위치 명령의 예측치를 산출하여 모터를 구동하기 위한 PWM 신호를 출력하는 모터 제어부를 포함하여 구성된 것을 특징으로 하는 로봇의 목표물 추종장치.And a motor controller configured to output a PWM signal for driving the motor by calculating an estimate of the current position command and an estimate of a later position command by using the acceleration signal of the acceleration sensor and the position movement command of the motion processor. The target tracking device of the robot. 제1 항에 있어서, 상기 모터 제어부는,The method of claim 1, wherein the motor control unit, 각 모터의 현재위치와 위치명령의 차이 및 가속도 신호와 이전 위치명령의 가중치를 이용하여 현재 위치 명령의 예측치 및 이후 위치 명령의 예측치를 산출하게 구성된 것을 특징으로 하는 로봇의 목표물 추종장치.The target tracking device of the robot, characterized in that it is configured to calculate the predicted value of the current position command and the predicted value of the next position command by using the difference between the current position and position command of each motor and the weight of the acceleration signal and the previous position command. 제1 항에 있어서, 상기 모터 제어부는,The method of claim 1, wherein the motor control unit, 상기 동작처리기에서 현재 입력되는 위치 이동명령신호를 이전 이동명령신호와 비교하여 시간차이를 검출하는 시간차이검출부와;A time difference detection unit for detecting a time difference by comparing a position movement command signal currently input by the operation processor with a previous movement command signal; 상기 동작처리기의 위치 이동명령신호를 입력받고, 상기 입력된 위치 이동명령신호를 가속도 신호 및 시간차이에 의해 이득을 변경하는 비례 적분 제어기를 포함하여 구성된 것을 특징으로 하는 로봇의 목표물 추종장치.And a proportional integral controller configured to receive a position movement command signal of the motion processor and change the gain by an acceleration signal and a time difference. 제 3항에 있어서, 상기 비례적분제어기는,The method of claim 3, wherein the proportional integral controller, 목표물의 위치변화와 시간과의 차이를 이용하여 로봇 머리의 변위를 제어하게 구성된 것을 특징으로 하는 로봇의 목표물 추종장치.The target tracking device of the robot, characterized in that configured to control the displacement of the robot head using the difference between the position change and the time of the target. 삭제delete 목표물을 추출하여, 상기 목표물의 변위를 산출하는 제1 과정과;Extracting a target to calculate a displacement of the target; 현재 모터의 가속도를 검출하여, 상기 검출된 가속도에 따라 비례적분 제어기의 이득을 변경하는 제2 과정과;Detecting a current acceleration of the motor and changing a gain of the proportional integral controller according to the detected acceleration; 이전 위치 이동명령에 일정한 가중치를 이용하여 현재 목표물의 위치를 예측하는 제3 과정과;A third process of predicting the position of the current target by using a predetermined weight in the previous position movement command; 상기 목표물의 위치 예측에 따른 위치 이동 명령신호를, 상기 이득에 따라 비례 적분하는 제4 과정과;A fourth process of proportionally integrating a position movement command signal according to the position prediction of the target according to the gain; 상기 위치 이동 명령신호에 따른 PWM 신호를 산출하고, 상기 산출된 PWM 신호를 모터의 위치신호로 인가하는 제5 과정을 포함하여 이루어진 것을 특징으로 하는 로봇의 목표물 추종방법.And a fifth process of calculating a PWM signal according to the position movement command signal and applying the calculated PWM signal as a position signal of a motor. 제6 항에 있어서, 상기 제3 과정은,The method of claim 6, wherein the third process, 이전 위치변화 명령신호가 오래된 명령일 수록 가중치의 값을 작게 설정하는 단계를 포함하는 것을 특징으로 하는 로봇의 목표물 추종방법.And setting the value of the weight smaller as the previous position change command signal is older.
KR1020020013007A 2002-03-11 2002-03-11 Objcctive compoliancy apparatus and method of robot KR100877983B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020020013007A KR100877983B1 (en) 2002-03-11 2002-03-11 Objcctive compoliancy apparatus and method of robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020020013007A KR100877983B1 (en) 2002-03-11 2002-03-11 Objcctive compoliancy apparatus and method of robot

Publications (2)

Publication Number Publication Date
KR20030073447A KR20030073447A (en) 2003-09-19
KR100877983B1 true KR100877983B1 (en) 2009-01-12

Family

ID=32224277

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020020013007A KR100877983B1 (en) 2002-03-11 2002-03-11 Objcctive compoliancy apparatus and method of robot

Country Status (1)

Country Link
KR (1) KR100877983B1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102063891B1 (en) 2019-06-04 2020-01-08 영남대학교 산학협력단 Following robot control method and system and computing device for executing the system
KR20220120918A (en) 2021-02-24 2022-08-31 주식회사 하다(HADA Co.,Ltd) Human worker-following transfer rovot

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101019336B1 (en) * 2007-10-29 2011-03-07 재단법인서울대학교산학협력재단 System and method for stabilization contol using an inertial sensor
KR101038367B1 (en) * 2007-10-29 2011-06-01 재단법인서울대학교산학협력재단 System and method for vision contol using video information
US9183639B2 (en) 2013-09-26 2015-11-10 Intel Corporation Image frame processing including usage of acceleration data in assisting object location
KR101762236B1 (en) 2015-02-24 2017-07-27 한화지상방산 주식회사 Driving device and driving control system
CN108664032A (en) * 2018-06-08 2018-10-16 东北大学秦皇岛分校 A kind of automatic control system and method for following carrier based on machine vision
JP7309371B2 (en) * 2019-01-25 2023-07-18 株式会社ソニー・インタラクティブエンタテインメント robot control system
US11702087B2 (en) * 2019-09-17 2023-07-18 Baidu Usa Llc Autonomous driving monitoring system

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6063620A (en) * 1983-09-16 1985-04-12 Komatsu Ltd Servocontrol method
JPH0350602A (en) * 1989-07-18 1991-03-05 Kobe Steel Ltd Gain setting device for robot
JPH03276310A (en) * 1990-03-27 1991-12-06 Mazda Motor Corp Driving controller for mobile vehicle
KR19990059974A (en) * 1997-12-31 1999-07-26 윤종용 Path planning device and path planning method for robot control

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6063620A (en) * 1983-09-16 1985-04-12 Komatsu Ltd Servocontrol method
JPH0350602A (en) * 1989-07-18 1991-03-05 Kobe Steel Ltd Gain setting device for robot
JPH03276310A (en) * 1990-03-27 1991-12-06 Mazda Motor Corp Driving controller for mobile vehicle
KR19990059974A (en) * 1997-12-31 1999-07-26 윤종용 Path planning device and path planning method for robot control

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102063891B1 (en) 2019-06-04 2020-01-08 영남대학교 산학협력단 Following robot control method and system and computing device for executing the system
KR20220120918A (en) 2021-02-24 2022-08-31 주식회사 하다(HADA Co.,Ltd) Human worker-following transfer rovot

Also Published As

Publication number Publication date
KR20030073447A (en) 2003-09-19

Similar Documents

Publication Publication Date Title
US10717191B2 (en) Apparatus and methods for haptic training of robots
Vanacker et al. Context-based filtering for assisted brain-actuated wheelchair driving
US9491359B2 (en) Automatic-tracking camera apparatus
KR100877983B1 (en) Objcctive compoliancy apparatus and method of robot
JP4490997B2 (en) Mobile robot
US20170203437A1 (en) Apparatus and methods for operating robotic devices using selective state space training
US9792546B2 (en) Hierarchical robotic controller apparatus and methods
US20100198443A1 (en) Path planning device, path planning method, and moving body
Boquete et al. Neural control of the movements of a wheelchair
Behnke et al. Predicting away robot control latency
Leconte et al. Design and integration of a spatio-temporal memory with emotional influences to categorize and recall the experiences of an autonomous mobile robot
KR102300574B1 (en) Method of moving in power assist mode reflecting physical characteristic of user and cart-robot of implementing thereof
Namiki et al. Robotic catching using a direct mapping from visual information to motor command
US20190217467A1 (en) Apparatus and methods for operating robotic devices using selective state space training
EP1484716A1 (en) An architecture for self-developing devices
Guler et al. An adaptive admittance controller for collaborative drilling with a robot based on subtask classification via deep learning
US20230321831A1 (en) Systems and Methods for Model-free Safety Control in Robotics Platforms
Santos-Victor et al. Embedded visual behaviors for navigation
Wang et al. Autonomous robot navigation using fuzzy logic controller
KR102376615B1 (en) Method for controlling mobile robot and apparatus thereof
Piaggio et al. An optical-flow person following behaviour
WO2019145907A1 (en) Method aimed at patients with motor disabilities for selecting a command by means of a graphic interface, and corresponding system and computer program product
US20220203524A1 (en) Apparatus and methods for operating robotic devices using selective state space training
DE3885437D1 (en) Finely controlled follow-up robot.
CN104950683A (en) Self-adaptive gap inverse model generating device for visual servo manipulator system

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
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 20121227

Year of fee payment: 5

FPAY Annual fee payment

Payment date: 20131224

Year of fee payment: 6

LAPS Lapse due to unpaid annual fee