KR102156655B1 - Control framework based on dynamic simulation for robot - Google Patents
Control framework based on dynamic simulation for robot Download PDFInfo
- Publication number
- KR102156655B1 KR102156655B1 KR1020200016429A KR20200016429A KR102156655B1 KR 102156655 B1 KR102156655 B1 KR 102156655B1 KR 1020200016429 A KR1020200016429 A KR 1020200016429A KR 20200016429 A KR20200016429 A KR 20200016429A KR 102156655 B1 KR102156655 B1 KR 102156655B1
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- virtual
- virtual robot
- real
- joint
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B17/00—Systems involving the use of models or simulators of said systems
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/106—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
- G05B19/4069—Simulating machining process on screen
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39286—Forward inverse, dynamics model, relaxation neural network model firm
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Manipulator (AREA)
Abstract
Description
본 발명은 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크에 관한 것이며, 보다 상세하게는 기구학적 특이점에서 로봇이 안정적으로 동작시킬 수 있는 프레임 워크에 관한 것이다.The present invention relates to a dynamic simulation-based control framework for a robot, and more particularly, to a framework capable of stably operating a robot in a kinematic singularity.
최근 다양한 분야에 적용되는 로봇이 활발하게 개발되고 있으며, 목적에 따라 다양한 형태의 로봇이 개발되고 있다. 이러한 로봇은 다수의 축과 관절을 포함하여 구성되며, 설계가 완료되는 경우 기구학적인 특성이 결정된다. 이러한 로봇은 기구학적으로 도달할 수 없는 자세 또는 동작, 즉 물리적으로 이루어낼 수 없는 특이점들이 존재하게 된다. 특히 산업용 작업에 널리 활용되는 6 축 로봇의 경우 일반적인 3차원 공간의 작업에 대해 여유 자유도를 가지지 못하기 때문에 기구학적 특이점을 통과할 수 없다. 한편, 실제 로봇의 제어를 위한 시뮬레이터에서는 가상 로봇이 특이점에 해당하는 경우가 발생하게 되며, 특이점에서 입력을 발생시키는 경우 발산하게 되어 제어적으로 불안정한 결과를 초래한다.Recently, robots applied to various fields have been actively developed, and various types of robots are being developed according to the purpose. Such a robot is composed of a number of axes and joints, and when the design is completed, the kinematic characteristics are determined. Such a robot has a posture or motion that cannot be kinematically reached, that is, there are singularities that cannot be achieved physically. In particular, in the case of a 6-axis robot that is widely used in industrial work, it cannot pass through the kinematic singularity because it does not have an extra degree of freedom for work in a general 3D space. On the other hand, in a simulator for controlling a real robot, a case where a virtual robot corresponds to a singular point occurs, and when an input is generated at the singular point, it is emitted, resulting in a controllically unstable result.
이와 같은 종래의 로봇 제어와 관련하여 대한민국 공개특허 제 20050022757 호가 개시되어 있다. 그러나 이러한 종래 기술은 전술한 특이점에서의 불안정성을 여전히 내포하고 있는 문제점이 있었다.In connection with such a conventional robot control, Korean Patent Application Publication No. 20050022757 is disclosed. However, such a conventional technique has a problem that still contains instability in the above-described singularity.
본 발명은 종래의 로봇 제어시 특이점에서 제어적 불안정성을 해소하여 안정적으로 운용할 수 있는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크를 제공하는 것에 그 목적이 있다.An object of the present invention is to provide a dynamic simulation-based control framework for a robot capable of stably operating by solving control instability at a singular point during conventional robot control.
상기 과제의 해결 수단으로서, 실제 로봇의 기구적 특성을 근거로 설계되는 가상 로봇의 움직임을 계산하는 동역학 시뮬레이션 모듈, 가상 로봇에 가상의 외력을 발생시켜 가상 로봇의 움직임을 발생시킬 수 있도록 구성되는 임피던스 제어 모듈, 가상의 힘을 근거로 시뮬레이션된 가상 로봇의 움직임을 실제 로봇이 모사할 수 있도록 실제 로봇의 구동부를 제어하는 로봇 관절 제어 모듈 및 가상 로봇의 현재 상태와 가상 로봇의 기구학적 특이점의 인접도에 따라 가상 로봇의 관절 마찰력을 조절하는 특이점과의 인접도 판단 모듈을 포함하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크가 제공될 수 있다.As a means of solving the above problems, a dynamics simulation module that calculates the motion of a virtual robot designed based on the mechanical characteristics of the real robot, and an impedance configured to generate the motion of the virtual robot by generating a virtual external force in the virtual robot. Control module, robot joint control module that controls the driving part of the real robot so that the motion of the simulated virtual robot based on the virtual force can be simulated, and the proximity of the current state of the virtual robot and the kinematic singularity of the virtual robot Accordingly, a control framework based on dynamics simulation for a robot including a module for determining the proximity of a singular point for adjusting the joint friction force of the virtual robot may be provided.
한편, 인접도 판단 모듈은 가상 로봇의 기구학적 특이점과 가상 로봇의 현재 상태의 인접도가 높아짐에 따라 가상 로봇의 관절 마찰력을 증가시키도록 구성될 수 있다.Meanwhile, the proximity determination module may be configured to increase the joint friction force of the virtual robot as the kinematic singularity of the virtual robot and the proximity of the current state of the virtual robot increase.
한편, 임피던스 제어 모듈은 가상의 스프링과 가상의 댐퍼를 생성하여 외력을 발생시키도록 구성될 수 있다. Meanwhile, the impedance control module may be configured to generate an external force by generating a virtual spring and a virtual damper.
또한, 임피던스 제어 모듈은 사용자로부터 입력받은 목표 궤적에 따라 가상 로봇의 엔드 이펙터(End effector)가 움직일 수 있도록 가상의 스프링 및 가상의 댐퍼 각각의 일측은 가상 로봇의 엔드 이펙터에 연결하며, 타측은 목표 궤적에 연결할 수 있다.In addition, the impedance control module connects one side of each of the virtual spring and the virtual damper to the end effector of the virtual robot so that the end effector of the virtual robot can move according to the target trajectory received from the user, and the other side is the target. Can be connected to the trajectory.
한편, 가상 로봇은 특이점에서 임피던스 제어 모듈에 의해 작용하는 외력으로 움직이도록 구성될 수 있다. Meanwhile, the virtual robot may be configured to move with an external force acting by the impedance control module at the singular point.
그리고, 구동부는 실제 로봇의 관절에 구비된 모터를 포함할 수 있다.In addition, the driving unit may include a motor provided in a joint of an actual robot.
한편, 가상 로봇 및 실제 로봇은 6축 구동이 가능하도록 구성될 수 있다. Meanwhile, the virtual robot and the real robot may be configured to be capable of 6-axis driving.
한편, 실제 로봇은 일측이 외부에 마운트되며, 타측에 엔드 이펙터(end effector)가 구비될 수 있다.Meanwhile, in an actual robot, one side is mounted externally, and an end effector may be provided on the other side.
본 발명에 따른 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크는 가상 로봇에서 특이점 근처에서도 안정성을 잃지 않고 사용자가 의도한 방향으로 작동이 가능하므로 안정성을 향상시킬 수 있는 효과가 있다.The control framework based on dynamics simulation for a robot according to the present invention has an effect of improving stability since the virtual robot can operate in a direction intended by the user without losing stability even near a singular point.
도 1은 본 발명에 따른 일 실시예인 제어 프레임 워크의 블록도이다.
도 2는 실제 로봇과 가상 로봇의 개념을 나타낸 개념도이다.
도 3은 가상 로봇과 특이점의 개념을 도시한 도면이다.1 is a block diagram of a control framework according to an embodiment of the present invention.
2 is a conceptual diagram showing the concept of a real robot and a virtual robot.
3 is a diagram showing the concept of a virtual robot and a singular point.
이하, 본 발명의 실시 예에 따른 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크-에 대하여, 첨부된 도면을 참조하여 상세히 설명한다. 그리고 이하의 실시예의 설명에서 각각의 구성요소의 명칭은 당업계에서 다른 명칭으로 호칭될 수 있다. 그러나 이들의 기능적 유사성 및 동일성이 있다면 변형된 실시예를 채용하더라도 균등한 구성으로 볼 수 있다. 또한 각각의 구성요소에 부가된 부호는 설명의 편의를 위하여 기재된다. 그러나 이들 부호가 기재된 도면상의 도시 내용이 각각의 구성요소를 도면내의 범위로 한정하지 않는다. 마찬가지로 도면상의 구성을 일부 변형한 실시예가 채용되더라도 기능적 유사성 및 동일성이 있다면 균등한 구성으로 볼 수 있다. 또한 당해 기술 분야의 일반적인 기술자 수준에 비추어 보아, 당연히 포함되어야 할 구성요소로 인정되는 경우, 이에 대하여는 설명을 생략한다.Hereinafter, a control framework based on dynamics simulation for a robot according to an embodiment of the present invention will be described in detail with reference to the accompanying drawings. In addition, in the description of the following embodiments, the names of each component may be referred to as different names in the art. However, if they have functional similarities and identity, even if a modified embodiment is employed, it can be viewed as an even configuration. In addition, symbols added to each component are described for convenience of description. However, the content illustrated on the drawings in which these symbols are indicated does not limit each component to the range within the drawings. Likewise, even if an embodiment in which some of the configurations in the drawings are modified is employed, if there is functional similarity and identity, it can be viewed as an equivalent configuration. In addition, in view of the level of a general technician in the relevant technical field, if it is recognized as a component that should be included, a description thereof will be omitted.
도 1은 본 발명에 따른 일 실시예인 제어 프레임 워크의 블록도이다.1 is a block diagram of a control framework according to an embodiment of the present invention.
도시된 바와 같이 본 발명에 따른 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크는 동역학 시뮬레이션 모듈(10), 임피던스 제어 모듈(20), 로봇 관절 제어 모듈(40) 및 인접도 판단 모듈을 포함하여 구성될 수 있다.As shown, the dynamics simulation-based control framework for a robot according to the present invention may include a
동역학 시뮬레이션 모듈(10)은 실제 로봇(200)의 기구적 특성을 근거로 가상 로봇(100)의 움직임을 계산하도록 구성된다. 동역학 시뮬레이션 모듈(10)에서 생성된 가상 로봇(100)은 실제 로봇(200)과 동일하게 복수의 링크(140)와 관절(130)을 포함하여 구성될 수 있다. 가상 로봇(100)은 능동적인 구동부를 제외하고 외력에 의해 수동적으로 동작하는 모델로 생성된다. 구체적으로 외부와의 마찰, 중력과 같은 방해요소를 생략하고 사용자의 입력에 의한 외력에 의해 작동하도록 구성된다. 따라서 가상 로봇(100)은 자체적으로 발생하는 힘과 움직임이 없어 한정된 크기의 외력에 대하여 항상 안정적인 움직임이 이루어진다. The
동역학 시뮬레이션 모듈(10)에서 생성된 가상 로봇(100)은 각 관절(130)을 연결하는 링크(140)가 강성재질로 설정되어 변형이 일어나지 않는 모델로 생성된다. 이때 외력에 의하여 발생하는 로봇의 움직임은 다음의 식으로 표현될 수 있다.The
(수식 1) (Equation 1)
여기서 는 로봇의 관절(130) 속도와 로봇 말단의 도구의 이동 속도 사이를 매핑하는 자코비안 (Jacobian) 행렬이며, 는 로봇 말단 도구에 작용하는 외력이다. 은 가상 로봇(100)이 과도하게 움직이는 것을 방지하기 위한 로봇의 관절(130)에서 발생하는 마찰을 모사하는 관절(130) 토크이다. 와 는 각각 로봇의 관절(130) 각도 및 속도 벡터이다. ,는 가상 로봇(100)의 관절(130) 각도 및 속도에 따른 관성 (inertia), 전향력 (Coriolis) 행렬이다. 자코비안, 관성, 전향력 행렬은 로봇의 구조에 따라 결정되며, 일반적으로 로봇 제조사의 라이브러리 함수를 통해 계산될 수 있다. 가상 로봇 관절의 현재 상태가 , 이고, 가 외부로부터 가상 로봇(100)에 가해졌을 때 그 결과로 발생하는 가상 로봇(100)의 관절(130) 가속도 및 그 이후의 가상 로봇(100)의 관절(130) 상태 (, ) 가 다음의 식과 같이 결정될 수 있다.here Is a Jacobian matrix mapping between the speed of the robot's
(수식 2) (Equation 2)
결국 동역학 시뮬레이션 모듈(10)에서는 임의의 외력 가 가상 로봇(100)에 가해질 때 매 순간의 움직임을 예측할 수 있게 된다.After all, in the
임피던스 제어 모듈(20)은 사용자의 입력에 의한 가상의 외력을 가상 로봇(100)에 적용시킬 수 있도록 구성된다. 임피던스 제어 모듈(20)은 가상 스프링(110)과 가상 댐퍼(120)를 생성하도록 구성된다. 가상 스프링(110) 및 가상 댐퍼(120)가 발생시키는 힘은 시뮬레이션 상의 가상 로봇(100)에 작용하여 로봇의 움직임을 발생시킨다. 가상 스프링(110)은 고유의 탄성으로 로봇에 힘을 작용하게 되며, 가상 댐퍼(120)는 로봇이 지나치게 과도한 속도를 내는 것을 방지하는 기능을 한다.The
임피던스 제어 모듈(20)에서 발생시키는 가상의 외력은 가상 로봇(100)을 사용자가 입력한 목표 궤적에 가까워지도록 유도하는 방향으로 작용한다. 구체적으로 가상 스프링(110)의 일측은 로봇의 말단인 엔드 이펙터(150)(end effector)에 연결되며, 타측은 목표 궤적(1000)에 연결되도록 구성된다. 따라서 가상 스프링(110)이 엔드 이펙터(150)에 작용하는 힘의 방향은 목표 궤적(1000)을 향하는 방향이 된다. 다시말해 엔드 이펙터(150)를 목표 궤적(1000) 방향으로 잡아당기는 힘이 발생한다. 가상 댐퍼(120)는 가상 스프링(110)과 마찬가지로 일측이 가상 로봇(100)의 엔드 이펙터(150)와 연결되고 타측이 목표 궤적(1000)에 연결되도록 구성된다. The virtual external force generated by the
가상 스프링(110)은 다음의 식과 같이 출력되며, 힘의 크기가 제한되는 특수한 형태의 스프링으로 설정된다.The
(수식 3) (Equation 3)
여기서, 는 가상 로봇(100) 말단 부 위치와 사용자에 의해 주어진 목표 궤적(1000) 사이의 위치 오차이다. 는 사용자에 의해서 정해지는 스프링 상수, 는 댐퍼 상수, 는 가상 스프링(110)의 임계 출력이다. here, Is a position error between the position of the end of the
일반적으로 값이 높을수록 가상 로봇(100)의 목표 궤적(1000)에 대한 추종 적확도는 높아지나, 시뮬레이션 상에서 지나치게 높은 스프링 상수로 설정하면 스프링에 의해 과도하게 큰 외력이 발생하여 가상의 로봇이 발산하게 된다. 따라서 스프링 상수가 과도하게 설정되어 발산되는 경우를 방지할 수 있도록 수치 해석적으로 무조건 안정성(unconditionally stable)을 가진 암시적 방법 (implicit method)을 사용하여 가상 로봇(100)에 가해지는 외력을 아래와 같이 계산할 수 있다.Generally The higher the value, the higher the accuracy of tracking the target trajectory 1000 of the
(수식 4)(Equation 4)
*여기서 는 가상 로봇(100) 말단 부인 엔드 이펙터 위치이다. 이 때 는 현재 알 수 없는 동역학 시뮬레이션의 결과 값이다. 따라서 전술한 수식 2와 수식 4를 이용하여 아래와 같이 를 계산한다. *here Is the position of the distal female end effector of the
(수식 5)(Equation 5)
전술한 암시적 방법을 사용하여 외력을 계산하는 임피던스 제어 모듈(20)은 스프링 상수 를 매우 높게 설정할 수 있으며, 이를 통해 동역학 시뮬레이션 상의 가상 로봇(100)은 기구학적 특이점이 아닌 구간에서 높은 정확도로 목표 궤적(1000)을 추종할 수 있다. The
한편 기구학적 특이점(singularity)이란 어느 하나의 좌표가 아닌 기구학적으로 도달할 수 없는 '상태'를 뜻한다. 이러한 특이점에서는 가상 로봇(100)을 발산 또는 작동중단시키지 않도록 임피던스 제어 모듈(20)에 의한 외력 이외에는 추가적인 동력을 발생시키지 않는다. 또한, 임피던스 제어 모듈(20)의 가상 스프링(110) 또한 수식 3에서와 같이 출력 힘의 크기가 제한되어 있기 때문에 가상 로봇(100)은 목표 궤적(1000)에서 벗어나기는 하지만 안정적인 움직임을 보이게 된다. On the other hand, kinematic singularity means a'state' that cannot be reached kinematically rather than a single coordinate. In this singularity, additional power is not generated other than an external force by the
로봇 관절 제어 모듈(40)은 실제 로봇(200)의 관절(130)을 제어할 수 있도록 구성된다. 로봇 관절 제어 모듈(40)은 임피던스 제어 모듈(20) 및 동역학 시뮬레이션 모듈(10)에 의해 외력이 발생할 때 예측되는 가상 로봇(100)의 움직임을 모사하여 실제 로봇(200)의 구동부를 제어할 수 있다. 로봇 관절 제어 모듈(40)은 제어 step 별로 가상 로봇(100)과 실제 로봇(200) 관절(130) 각도의 오차에 기반하여 이를 최소화 하는 방향으로 구동부를 제어하는 입력을 발생시킨다. 한편, 도시되지는 않았으나, 로봇의 구동부는 관절(130)에 구비되며, 일 예로 로터리 액추에이터, 모터와 같은 회전 구동요소로 구성될 수 있다. 실제 로봇(200) 관절(130)이 모터로 구성된 경우 로봇 관절 제어 모듈(40)은 모터 입력 토크 를 계산한다. The robot
이때 모터 입력 토크인 는 일반적으로 널리 사용되는 PID 제어로서 다음의 식으로 계산될 수 있다.At this time, the motor input torque Is generally widely used PID control and can be calculated by the following equation.
(수식 6) (Equation 6)
또한 는 더욱 정확한 동작을 위하여 가상 로봇(100)의 관성, 전향력 행렬에 의한 효과를 감안한 optimal PID 제어기로서 다음의 식을 이용하여 계산될 수 있다.Also For a more accurate operation, consider the effect of the inertia of the
(수식 7)(Equation 7)
여기서 수식 6 및 수식 7에 나타난 은 실제 로봇(200)의 관절(130) 위치와 속도를 의미하다. 또한 은 실제 로봇(200)과 동역학 시뮬레이션 상 가상 로봇(100)의 관절(130) 각도 차이를 의미한다. ,,,,는 각각 사용자가 위치 정확도를 위해 조절해주어야 하는 제어기 파라미터이다.Where shown in Equation 6 and Equation 7 Means the position and speed of the joint 130 of the
인접도 판단 모듈은 동역학 시뮬레이션 모듈(10)에서 가상 로봇(100)이 작동할 때 매 순간 기구학적 특이점에 얼마나 접근하였는지를 계산하도록 구성된다. 인접도 판단 모듈은 가상 로봇(100)이 기구학적 특이점에 인접한 경우 가상 모델의 관절(130) 마찰력을 조절하여 안정성을 높일 수 있도록 구성된다. 구체적으로 가상 로봇(100)이 기구학적 특이점에 인접하는 경우 관절(130) 마찰력을 증가시키는 방향으로 파라미터가 조절될 수 있다. The proximity determination module is configured to calculate how close the kinematic singular point is approached every moment when the
인접도 판단 모듈에서 인접도의 판단은 를 계산하여 유추할 수 있다. 기구학적 특이점에서는 로봇이 특정 방향으로 더 이상 진행하지 못하는 현상이 발생하기 때문에 값이 0이 되므로, 의 절대값의 크기를 통해 로봇의 현재 상태가 기구학적 특이점과 얼마나 인접해 있는지 알 수 있다. In the proximity determination module, the determination of the proximity is Can be inferred by calculating In the kinematic singularity, there is a phenomenon in which the robot can no longer proceed in a specific direction. Since the value is 0, It is possible to know how close the current state of the robot is to the kinematic singularity through the magnitude of the absolute value of.
많은 물리적 현상의 시뮬레이션에서 마찰의 모델은 물체의 움직임을 방해하는 효과를 표현하기 때문에, 다음과 같이 그 힘의 크기가 속도에 비례하는 댐퍼 형태로 표현된다. In simulations of many physical phenomena, the friction model expresses the effect of hindering the movement of an object, so the magnitude of the force is expressed in the form of a damper in proportion to the velocity as follows.
{bold{tau}}_{friction}=-{bold{B}}`{dot{bold{q}} (수식 8){bold{tau}}_{friction}=-{bold{B}}`{dot{bold{q}} (Equation 8)
나아가, 본 발명에서는 기구학적 특이점 근처에서 가상 로봇(100)의 움직임의 안정성을 높이기 위해 다음과 같이 값의 절대값이 0에 가까워졌을 때 댐핑 상수가 증가하도록 하였다. Furthermore, in the present invention, in order to increase the stability of the movement of the
(수식 9) (Equation 9)
여기서 와 는 각각 댐핑 상수를 결정하기 위한 파라미터이며, 소정범위 내에서 적절한 값으로 결정될 수 있다.here Wow Each is a parameter for determining the damping constant, and may be determined as an appropriate value within a predetermined range.
전술한 바와 같이 본 발명에 따라 사용자가 목표 궤적(1000)을 입력하는 경우 가상 로봇(100)이 목표 궤적(1000)을 추종할 수 있도록 가상의 외력이 작용하여 로봇을 작동시키게 된다. 이때 가상 로봇(100)이 기구학적 특이점에 인접함에 따라 가상 로봇(100)의 관절(130) 마찰력을 증가시켜 안정성을 향상시키고 지속적으로 목표 궤적(1000)을 추종할 수 있도록 제어된다. 따라서 특이점에서 발생하는 발산 또는 불안정한 동작을 방지할 수 있는 효과가 있다.As described above, when the user inputs the target trajectory 1000 according to the present invention, a virtual external force acts so that the
이하에서는 도 2 및 도 3을 참조하여 본 발명에 따라 시뮬레이션 되는 가상 로봇(100)과 실제 로봇(200)에 대하여 설명하도록 한다.Hereinafter, a
도 2(a)는 실제 로봇(200)과 가상 로봇(100)의 개념을 나타낸 개념도이다. 도시된 바와 같이 가상 로봇(100)은 복수개의 6축 좌표를 따라 순차적으로 이동할 수 있도록 외력이 작용하며, 가상 로봇의 자세에 따라 실제 로봇이 거동하도록 구성된다. 다만, 설명의 편의를 위해 가상 로봇의 엔드 이펙터에는 가상 스프링과 가상 댐퍼가 나타나 있으나 시각화된 모델에서는 표시되지 않을 수 있다. 또한, 도 3에는 설명의 편의를 위하여 3D 모델링으로 시각화 영상(300)으로 표시된 가상 로봇이 도시되어 있으나, 가상 로봇은 별도의 3D 모델링으로 시각화하지 않고 수학식으로만 구동될 수 있다. 2(a) is a conceptual diagram showing the concept of the
한편 도 2(b)와 같이 가상 로봇(100)의 시뮬레이션에 의해 실제 로봇이 가상 로봇의 자세를 추종할 수 있도록 제어된다. 다만, 본 발명은 도시된 실제 로봇의 구성에 한정하지 않고 다양하게 구성의 로봇에 적용될 수 있다.Meanwhile, as shown in FIG. 2(b), the actual robot is controlled to follow the posture of the virtual robot by simulation of the
도 3은 가상 로봇과 특이점의 개념을 도시한 도면이다. 3 is a diagram showing the concept of a virtual robot and a singular point.
도 3(a)에는 자세를 유지한 상태에서 실제 로봇(200)이 이동할 때 기구적으로 도달할 수 없는 특이점에 해당하는 예가 도시되어 있다. 실제 로봇(200)은 도시된 자세에서 기구적인 한계로 엔드 이펙터(150)가 화살표 방향으로 이동하지 못하는 특이점에 해당한다. 가상 로봇(100)은 동역학 시뮬레이터 모듈(10) 상에서 엔드 이펙터(150)가 특이점에 가까워질수록 관절의 마찰력이 증가하여 특이점에 도달하지 않게 된다.3(a) shows an example corresponding to a singular point that cannot be mechanically reached when the
도 3(b)에는 위치를 유지한 상태에서 실제 로봇(200)의 엔드 이펙터가 특정 각도를 이룰 수 없는 특이점에 해당하는 예가 도시되어 있다. 실제 로봇(200)은 기구적인 한계로 엔드 이펙터의 각도가 화살표 방향으로 조절되지 못한다. 전술한 바와 같이 이러한 특이점에 인접하는 경우 가상 로봇의 관절 마찰력이 증가되어 동작이 정지시키고, 실제 로봇은 가상 로봇의 자세를 추종할 수 있다.3(b) shows an example corresponding to a singular point in which the end effector of the
전술한 바와 같이 가상 로봇(100)이 특이점에 인접할수록 가상 로봇의 관절에 작용하는 마찰력이 증가되므로 가상 로봇(100)은 특이점에 도달하지 않고 안정적으로 정지하게 된다. 또한 이에 따라 실제 로봇(200)은 가상 로봇을 추종한 자세를 유지하게 된다. 즉 가상 로봇이 특이점에 해당하여 전체 시스템의 작동이 중단되지 않고 가상 로봇의 자세 및 위치만이 정지될 수 있다. 이후 사용자가 목표 궤적을 재입력하는 경우 가상 로봇은 자연스럽게 다음 궤적을 향하여 움직이게 된다.As described above, as the
본 발명에 따른 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크는 가상 로봇에서 특이점 근처에서도 안정성을 잃지 않고 사용자가 의도한 방향으로 작동이 가능하므로 안정성을 향상시킬 수 있는 효과가 있다.The control framework based on dynamics simulation for a robot according to the present invention has an effect of improving stability since the virtual robot can operate in a direction intended by the user without losing stability even near a singular point.
10: 동역학 시뮬레이션 모듈
20: 임피던스 제어 모듈
30: 로봇 관절 제어 모듈
40: 인접도 판단 모듈
100: 가상 로봇
110: 가상 스프링
120: 가상 댐퍼
130: 관절
140: 링크
150: 엔드 이펙터
200: 실제 로봇
1000: 목표 궤적10: dynamics simulation module
20: impedance control module
30: robot joint control module
40: proximity determination module
100: virtual robot
110: virtual spring
120: virtual damper
130: joint
140: link
150: end effector
200: real robot
1000: target trajectory
Claims (8)
상기 가상 로봇에 가상의 외력을 발생시켜 상기 가상 로봇의 움직임을 발생시킬 수 있도록 구성되는 임피던스 제어 모듈;
상기 가상의 힘을 근거로 시뮬레이션된 가상 로봇의 움직임을 상기 실제 로봇이 모사할 수 있도록 상기 실제 로봇의 구동부를 제어하는 로봇 관절 제어 모듈; 및
상기 가상 로봇의 현재 상태와 상기 가상 로봇의 기구학적 특이점의 인접도에 따라 상기 가상 로봇의 관절 마찰력을 조절하는 특이점과의 인접도 판단 모듈을 포함하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.A dynamics simulation module that calculates a motion of a virtual robot designed based on mechanical characteristics of an actual robot;
An impedance control module configured to generate a virtual external force to the virtual robot to generate a movement of the virtual robot;
A robot joint control module for controlling a driving unit of the real robot so that the real robot can simulate the motion of the virtual robot simulated based on the virtual force; And
A control framework based on dynamics simulation for a robot, comprising a module for determining proximity to a singular point for adjusting joint frictional force of the virtual robot according to the current state of the virtual robot and the proximity of the kinematic singular point of the virtual robot.
상기 인접도 판단 모듈은 상기 가상 로봇의 기구학적 특이점과 상기 가상 로봇의 현재 상태의 인접도가 높아짐에 따라 상기 가상 로봇의 관절 마찰력을 증가시키는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 1,
The proximity determination module increases the joint frictional force of the virtual robot as the kinematic singularity of the virtual robot and the proximity of the current state of the virtual robot increase, the control framework based on dynamics simulation for a robot.
상기 임피던스 제어 모듈은 가상의 스프링과 가상의 댐퍼를 생성하여 상기 외력을 발생시키는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 2,
The impedance control module generates a virtual spring and a virtual damper to generate the external force, a dynamic simulation-based control framework for a robot, characterized in that.
상기 임피던스 제어 모듈은,
사용자로부터 입력받은 목표 궤적에 따라 상기 가상 로봇의 엔드 이펙터(End effector)가 움직일 수 있도록 상기 가상의 스프링 및 상기 가상의 댐퍼 각각의 일측은 상기 가상 로봇의 엔드 이펙터에 연결하며, 타측은 상기 목표 궤적에 연결하는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 3,
The impedance control module,
One side of each of the virtual spring and the virtual damper is connected to the end effector of the virtual robot so that the end effector of the virtual robot can move according to the target trajectory input from the user, and the other side is the target trajectory. Dynamic simulation-based control framework for a robot, characterized in that connected to.
상기 가상 로봇은 상기 특이점에서 상기 임피던스 제어 모듈에 의해 작용하는 외력으로 움직이는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 4,
The virtual robot is a dynamic simulation-based control framework for a robot, characterized in that the movement by an external force acting by the impedance control module at the singular point.
상기 구동부는 상기 실제 로봇의 관절에 구비된 모터를 포함하는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 2,
The driving unit is a dynamic simulation-based control framework for a robot, characterized in that it includes a motor provided in the joint of the real robot.
상기 가상 로봇 및 상기 실제 로봇은 6축 구동이 가능하도록 구성된 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.The method of claim 1,
The virtual robot and the real robot are dynamic simulation-based control framework for a robot, characterized in that configured to enable 6-axis driving.
상기 실제 로봇은 일측이 외부에 마운트되며, 타측에 엔드 이펙터(end effector)가 구비되는 것을 특징으로 하는 로봇을 위한 동역학 시뮬레이션 기반 제어 프레임 워크.
The method of claim 7,
One side of the real robot is mounted externally, and an end effector is provided on the other side of the real robot.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200016429A KR102156655B1 (en) | 2020-02-11 | 2020-02-11 | Control framework based on dynamic simulation for robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200016429A KR102156655B1 (en) | 2020-02-11 | 2020-02-11 | Control framework based on dynamic simulation for robot |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190137569A Division KR102079122B1 (en) | 2019-10-31 | 2019-10-31 | Control framework based on dynamic simulation for robot |
Publications (1)
Publication Number | Publication Date |
---|---|
KR102156655B1 true KR102156655B1 (en) | 2020-09-16 |
Family
ID=72669714
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020200016429A KR102156655B1 (en) | 2020-02-11 | 2020-02-11 | Control framework based on dynamic simulation for robot |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102156655B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220092448A (en) * | 2020-12-24 | 2022-07-01 | 부산대학교 산학협력단 | System and Method for Controlling Force based Impedance for the Dismantling of Reactor Vessel Internal |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20050022757A (en) | 2003-08-27 | 2005-03-08 | 대한민국(창원대학교) | High Speed Autoloading System including a 6-DOF Articulated Robot with Flexible Weaving Motion and Joint Motion in the Vicinity of Singularities for Automation of Machine Tools |
JP5129415B2 (en) * | 2011-03-17 | 2013-01-30 | パナソニック株式会社 | ROBOT, ROBOT CONTROL DEVICE, CONTROL METHOD, AND CONTROL PROGRAM |
KR20160118559A (en) * | 2015-04-02 | 2016-10-12 | 동영오에이퍼니처 (주) | Robot control system, method and computer readable medium |
-
2020
- 2020-02-11 KR KR1020200016429A patent/KR102156655B1/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20050022757A (en) | 2003-08-27 | 2005-03-08 | 대한민국(창원대학교) | High Speed Autoloading System including a 6-DOF Articulated Robot with Flexible Weaving Motion and Joint Motion in the Vicinity of Singularities for Automation of Machine Tools |
JP5129415B2 (en) * | 2011-03-17 | 2013-01-30 | パナソニック株式会社 | ROBOT, ROBOT CONTROL DEVICE, CONTROL METHOD, AND CONTROL PROGRAM |
KR20160118559A (en) * | 2015-04-02 | 2016-10-12 | 동영오에이퍼니처 (주) | Robot control system, method and computer readable medium |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220092448A (en) * | 2020-12-24 | 2022-07-01 | 부산대학교 산학협력단 | System and Method for Controlling Force based Impedance for the Dismantling of Reactor Vessel Internal |
KR102642410B1 (en) | 2020-12-24 | 2024-03-04 | 부산대학교 산학협력단 | System and Method for Controlling Force based Impedance for the Dismantling of Reactor Vessel Internal |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11305431B2 (en) | System and method for instructing a robot | |
US20200282558A1 (en) | System and method for controlling a robot with torque-controllable actuators | |
JP7199178B2 (en) | ROBOT CONTROL DEVICE, ROBOT DEVICE, ROBOT CONTROL PARAMETER ADJUSTMENT METHOD, AND PROGRAM | |
KR102003445B1 (en) | Apparatus and method for performing open loop control and closed loop control of a robot manipulator | |
US9050724B2 (en) | Control method of robot apparatus and robot apparatus | |
US11975451B2 (en) | Simulation-in-the-loop tuning of robot parameters for system modeling and control | |
Cheah et al. | Task-space sensory feedback control of robot manipulators | |
Senoo et al. | Impedance control design based on plastic deformation for a robotic arm | |
Koehler et al. | Stiffness control of deformable robots using finite element modeling | |
JP2023523656A (en) | Apparatus and method for planning contact interaction trajectories | |
KR102156655B1 (en) | Control framework based on dynamic simulation for robot | |
Oliva et al. | A general visual-impedance framework for effectively combining vision and force sensing in feature space | |
Žlajpah et al. | Unified virtual guides framework for path tracking tasks | |
KR102079122B1 (en) | Control framework based on dynamic simulation for robot | |
Zhu et al. | Vision-admittance-based adaptive RBFNN control with a SMC robust compensator for collaborative parallel robots | |
Ansarieshlaghi et al. | Hybrid Force/Position Control of a Very Flexible Parallel Robot Manipulator in Contact with an Environment. | |
Cheung et al. | Cooperative control of a multi-arm system using semi-autonomous telemanipulation and adaptive impedance | |
Vezvari et al. | Perfect torque compensation of planar 5R parallel robot in point-to-point motions, optimal control approach | |
Pomares et al. | Direct visual servoing framework based on optimal control for redundant joint structures | |
Kaigom et al. | Developing virtual testbeds for intelligent robot manipulators-an erobotics approach | |
Akhtaruzzaman et al. | Modeling and control of a multi degree of freedom flexible joint manipulator | |
Zarei-nia | Haptic-enabled teleoperation of hydraulic manipulators: theory and application | |
Udai et al. | Simulation of force control algorithms for serial robots | |
Fratu et al. | Robots collision avoidance using learning through imitation | |
US20240116178A1 (en) | Predictive control method for torque-rate control and vibration suppression |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |