KR102429255B1 - Module type robot arm for maintenance or diagnosis of surface of structure - Google Patents

Module type robot arm for maintenance or diagnosis of surface of structure Download PDF

Info

Publication number
KR102429255B1
KR102429255B1 KR1020210191672A KR20210191672A KR102429255B1 KR 102429255 B1 KR102429255 B1 KR 102429255B1 KR 1020210191672 A KR1020210191672 A KR 1020210191672A KR 20210191672 A KR20210191672 A KR 20210191672A KR 102429255 B1 KR102429255 B1 KR 102429255B1
Authority
KR
South Korea
Prior art keywords
link
motor
robot arm
coupling part
wall
Prior art date
Application number
KR1020210191672A
Other languages
Korean (ko)
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 국민대학교산학협력단
Application granted granted Critical
Publication of KR102429255B1 publication Critical patent/KR102429255B1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0052Gripping heads and other end effectors multiple gripper units or multiple end effectors
    • B25J15/0061Gripping heads and other end effectors multiple gripper units or multiple end effectors mounted on a modular gripping structure
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/08Programme-controlled manipulators characterised by modular constructions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/106Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D55/00Endless track vehicles
    • B62D55/08Endless track units; Parts thereof
    • B62D55/18Tracks
    • B62D55/26Ground engaging parts or elements
    • B62D55/265Ground engaging parts or elements having magnetic or pneumatic adhesion

Abstract

The present invention relates to a modular robot arm that can stably repair or diagnose the wall of a structure without interfering with the operation of a climbing device by being mounted in a module type on the climbing device that can move along the wall of the structure. The present invention comprises: a module base with a first motor and a second motor; a plurality of first and third links connected to the central axis of rotation of the first and second motors, respectively; a second link and a fourth link having one ends connected to the first link and the third link and the other ends connected to each other; and an end effector mounted on a connection portion between the third link and the fourth link. According to the rotation of the first motor and the second motor, the first to fourth links move in the same plane direction.

Description

구조물 벽면 보수 또는 진단용 모듈형 로봇팔{MODULE TYPE ROBOT ARM FOR MAINTENANCE OR DIAGNOSIS OF SURFACE OF STRUCTURE}A modular robot arm for repair or diagnosis on the wall of a structure

본 발명은 구조물 벽면 보수 또는 진단용 모듈형 로봇팔에 관한 것으로서, 더욱 상세하게는 구조물의 벽면을 따라 이동할 수 있는 등벽장치에 모듈 타입으로 장착되어 등벽장치의 구동과 간섭없이 구조물 벽면을 안정적으로 보수하거나 진단 할 수 있는 모듈형 로봇팔에 관한 것이다.The present invention relates to a modular robot arm for repairing or diagnosing a structure wall, and more particularly, it is mounted in a module type on a back wall device that can move along the wall surface of a structure to stably repair or It is about a modular robotic arm that can diagnose.

최근, 빌딩이나 교량 등의 구조물들이 대형화 및 고도화되고 있다. 기존에는 대형 구조물 벽면의 외벽이나 내벽에 도장, 청소, 검사 또는 진단, 보수 등의 작업을 할 때 사람이 직접 작업용 승강기와 같은 탑승수단을 이용하여 매달린 상태에서 승강하며 관련 작업을 하였다.In recent years, structures such as buildings and bridges have been enlarged and upgraded. In the past, when painting, cleaning, inspection, diagnosis, repair, etc. were performed on the outer or inner wall of a large structure wall, a person directly used a boarding means such as an elevator for work to ascend and descend in a suspended state.

그러나, 벽면 보수의 수요는 증가하고 있으나, 현장 작업에 있어서는 간소화나 자동화의 수단이 없어 수요를 충족시키지 못하고 있고, 또한, 발판이나 곤돌라 등의 기자재 비용, 인건비 등 경제적인 부담이 큰 점도 문제가 되고 있다.However, the demand for wall repair is increasing, but there is no means of simplification or automation in the field work, so the demand cannot be met. Also, the cost of equipment such as scaffolding and gondolas, and the economic burden such as labor costs are also a problem. have.

이러한 종래 벽면 작업의 문제점을 해결하기 위해 벽면에 부착된 상태에서 벽면을 주행할 수 있는 벽면주행로봇이나 벽면주행로봇에 장착되어 작업을 수행할 수 있는 기술들이 개발되고 있다.In order to solve the problem of the conventional wall work, technologies are being developed that can be mounted on a wall traveling robot or a wall traveling robot that can run on a wall while being attached to the wall to perform the work.

이와 관련하여, 종래 기술인 한국등록특허 제10-1243599호(벽면 부착식 작업로봇)은, 스위치 자기장치를 이용하여 벽면 부착수단과 벽면 주행수단을 일체화시켜 벽면을 따라 주행하며 보수 등의 작업을 수행하는 기술을 개시하고 있다.In this regard, the prior art Korean Patent No. 10-1243599 (wall-mounted work robot) uses a magnetic field value of a switch to integrate the wall mounting means and the wall running means to run along the wall and perform repairs, etc. technology is disclosed.

그러나, 상술한 종래 기술에 따르면 벽면의 보수 등의 작업은 작업 모듈에서 수행하는데 작업 모듈에 대한 구체적 내용은 개시하고 있지 않다. 따라서, 등벽 장치에 장착되어 안정적으로 벽면 보수 또는 진단을 수행할 수 있는 로봇에 대한 기술이 필요하다.However, according to the prior art described above, the work such as repair of the wall is performed in the work module, but the specific content of the work module is not disclosed. Therefore, there is a need for a technology for a robot that is mounted on a back wall device and can stably perform wall repair or diagnosis.

한국등록특허 제10-1243599호(벽면 부착식 작업로봇)Korean Patent No. 10-1243599 (Wall-Attached Work Robot)

본 발명의 과제는 상술한 종래 기술이 가진 문제를 해결하기 위해 고안된 것으로, 등벽장치에 장착되어, 링크 운동을 통해 안정적으로 구조물 벽면의 보수 또는 진단을 수행할 수 있고, 등벽장치와 간섭없이 작업을 수행할 수 있는 새로운 형태의 발명을 제공함에 있다.The object of the present invention is devised to solve the problems of the prior art, and it is mounted on the back wall device, can stably repair or diagnose the structure wall through the link movement, and can work without interference with the back wall device. It is to provide a new type of invention that can be carried out.

상기의 과제를 달성하기 위한 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔은, 제1 모터와 제2 모터가 장착된 모듈 베이스; 상기 제1 모터 및 제2 모터 각각의 회전 중심축과 연결된 복수의 제1 링크 및 제3 링크; 일단이 상기 제1 링크 및 제3 링크와 연결되고, 타단이 서로 연결된 제2 링크 및 제4 링크; 및 상기 제3 링크와 제4 링크 간 연결 부위에 장착된 엔드 이펙터;를 포함하고, 상기 제1 모터 및 제2 모터의 회전에 따라 상기 제1 내지 제4 링크가 동일한 평면 방향에서 링크 운동하는 것을 특징으로 한다.A modular robot arm for repairing or diagnosing a structure wall according to the present invention for achieving the above object includes: a module base on which a first motor and a second motor are mounted; a plurality of first and third links connected to the respective rotational axes of the first and second motors; a second link and a fourth link having one end connected to the first link and the third link and the other end connected to each other; and an end effector mounted on a connection portion between the third link and the fourth link, wherein the first to fourth links link movement in the same plane direction according to the rotation of the first motor and the second motor. characterized.

본 발명의 일 실시예에서, 상기 모듈 베이스에는, 상기 로봇팔의 전원을 공급하는 구동부 또는 움직임을 제어하는 제어부가 결합되는 것을 특징으로 한다.In one embodiment of the present invention, the module base is characterized in that the driving unit for supplying power to the robot arm or a control unit for controlling the movement is coupled.

또한, 본 발명의 일 실시예에서, 상기 모듈 베이스에는 내부 공간을 갖는 케이스가 결합되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, the module base is characterized in that the case having an internal space is coupled.

또한, 본 발명의 일 실시예에서, 상기 제1 모터 또는 제2 모터에는 회전각을 측정하기 위한 엔코더가 장착되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, the first motor or the second motor is characterized in that the encoder for measuring the rotation angle is mounted.

또한, 본 발명의 일 실시예에서, 상기 제1 링크와 제3 링크 또는 제2 링크와 제4 링크는 링크 연결축에 의해 서로 회전 가능하게 연결되는 것을 특징으로 한다.Further, in an embodiment of the present invention, the first link and the third link or the second link and the fourth link are rotatably connected to each other by a link connecting shaft.

또한, 본 발명의 일 실시예에서, 상기 제3 링크 및 제4 링크는 'L'자 형태로 형성되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, the third link and the fourth link is characterized in that formed in an 'L' shape.

또한, 본 발명의 일 실시예에서, 상기 제3 링크 및 제4 링크간 연결 부위에는 상기 엔드이펙터를 회전시킬 수 있는 제3 모터가 장착되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, a third motor capable of rotating the end effector is mounted on the connection portion between the third link and the fourth link.

또한, 본 발명의 일 실시예에서, 상기 제3 모터의 하부에는 상기 평면(P1)과 수직 방향으로 형성되어 승하강하는 액츄에이터가 연결되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, the lower portion of the third motor is formed in the direction perpendicular to the plane (P1), characterized in that the actuator is connected to the ascending and descending.

또한, 본 발명의 일 실시예에서, 상기 제3 모터의 하부에는 상기 제3 모터의 상기 액츄에이터의 일단이 연결되는 연결부가 장착되는 것을 특징으로 한다.In addition, in an embodiment of the present invention, a connection part to which one end of the actuator of the third motor is connected is mounted on a lower portion of the third motor.

또한, 본 발명의 일 실시예에서, 상기 연결부에는 상기 액츄에이터의 일단이 삽입되도록 삽입홈이 형성되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, the connection portion is characterized in that the insertion groove is formed so that one end of the actuator is inserted.

또한, 본 발명의 일 실시예에서, 상기 엔드 이펙터는 상기 액츄에이터 끝단에 탈착 가능하게 연결된 것을 특징으로 한다.In addition, in an embodiment of the present invention, the end effector is characterized in that it is detachably connected to the end of the actuator.

또한, 본 발명의 일 실시예에서, 보수 위치를 판별하도록 영상 수단이 더 포함되는 것을 특징으로 한다.In addition, in one embodiment of the present invention, it is characterized in that the imaging means is further included to determine the repair position.

본 발명에 따르면, 로봇팔의 링크 구조로 동일 평면 방향으로 링크 운동함으로써 등벽장치에 장착된 상태에서 구조물 벽면의 보수 또는 진단을 안정적으로 수행할 수 있는 효과가 있다.According to the present invention, there is an effect that can stably perform repair or diagnosis of the wall of the structure in the state mounted on the back wall device by the link movement in the same plane direction with the link structure of the robot arm.

또한, 본 발명에 따르면, 모듈형 로봇팔은 별도의 전원을 사용함으로써 등벽장치와 독립적인 구성이 가능하다.In addition, according to the present invention, the modular robot arm can be configured independently of the back wall device by using a separate power source.

또한, 본 발명에 따르면, 등벽장치의 구동에 간섭되지 않고 안정적으로 로봇팔이 구동될 수 있다.In addition, according to the present invention, the robot arm can be stably driven without interfering with the driving of the back wall device.

도 1은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 전체적인 모습을 나타낸 사시도이다.
도 2는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 본체부와 링크부를 분리하여 나타낸 분해 사시도이다.
도 3은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 본체부의 구조를 나타낸 분해 사시도이다.
도 4는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제1 패시브 조인트부의 구조를 나타내 분해 사시도이다.
도 5는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제2 엑티브 조인트부의 구조를 위에서 아래 방향으로 경사지게 바라본 분해 사시도이다.
도 6은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제2 엑티브 조인트부의 구조를 아래서 위 방향으로 경사지게 바라본 분해 사시도이다.
도 7은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔이 접힌 상태를 나타낸 도면이다.
도 8은 본 발명의 일 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 움직임을 해석하기 위한 기구학적 모델을 나타낸 도면이다.
도 9는 본 발명의 다른 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 움직임을 해석하기 위한 기구학적 모델을 나타낸 도면이다.
도 10a는 본 발명의 일 실시예에 따른 모듈형 로봇팔의 링크 동작에 따른 엔드 이펙터의 이동 상태를 나타낸 도면이고, 도 10b는 도 10a에 도시된 각 엔드 이펙트의 x 및 y 방향 위치 변화를 나타낸 그래프이다.
도 11a는 본 발명의 일 실시예에 따른 모듈형 로보팔의 액츄에이터 동작에 따른 엔드 이펙터의 이동 상태를 나타낸 도면이고, 도 11b는 도 11a에 도시된 각 엔드 이펙터의 z 방향 위치 변화를 나타낸 그래프이다.
1 is a perspective view showing the overall appearance of a modular robot arm for repair or diagnosis of a wall structure according to the present invention.
2 is an exploded perspective view showing the body part and the link part of the modular robot arm for repair or diagnosis of the structure wall according to the present invention.
Figure 3 is an exploded perspective view showing the structure of the main body of the modular robot arm for repair or diagnosis of the wall structure according to the present invention.
Figure 4 is an exploded perspective view showing the structure of the first passive joint part of the modular robot arm for repair or diagnosis of the wall structure according to the present invention.
5 is an exploded perspective view of the structure of the second active joint part of the modular robot arm for repair or diagnosis of the wall of the structure in accordance with the present invention as viewed obliquely from the top down.
6 is an exploded perspective view of the structure of the second active joint part of the modular robot arm for repair or diagnosis of the wall of the structure according to the present invention, as viewed obliquely from the bottom to the top.
7 is a view showing a folded state of the modular robot arm for repair or diagnosis of the wall of the structure according to the present invention.
8 is a view showing a kinematic model for analyzing the movement of a modular robot arm for repair or diagnosis of a structure wall according to an embodiment of the present invention.
9 is a view showing a kinematic model for analyzing the movement of a modular robot arm for repair or diagnosis of a structure wall according to another embodiment of the present invention.
Figure 10a is a view showing the movement state of the end effector according to the link operation of the modular robot arm according to an embodiment of the present invention, Figure 10b is a view showing the x and y direction position change of each end effect shown in Figure 10a It is a graph.
11A is a diagram illustrating a movement state of an end effector according to an actuator operation of a modular robopal according to an embodiment of the present invention, and FIG. 11B is a graph showing a change in the z-direction position of each end effector shown in FIG. 11A .

이하 첨부된 도면을 참조하여, 바람직한 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔에 대해 상세히 설명하면 다음과 같다. 여기서, 동일한 구성에 대해서는 동일부호를 사용하며, 반복되는 설명, 발명의 요지를 불필요하게 흐릴 수 있는 공지 기능 및 구성에 대한 상세한 설명은 생략한다. 발명의 실시형태는 당업계에서 평균적인 지식을 가진 자에게 본 발명을 보다 완전하게 설명하기 위해서 제공되는 것이다. 따라서, 도면에서의 요소들의 형상 및 크기 등은 보다 명확한 설명을 위해 과장될 수 있다.Hereinafter, with reference to the accompanying drawings, a detailed description of the modular robot arm for repairing or diagnosing the wall of a structure according to a preferred embodiment is as follows. Here, the same reference numerals are used for the same components, and repeated descriptions and detailed descriptions of well-known functions and configurations that may unnecessarily obscure the gist of the invention will be omitted. The embodiments of the present invention are provided in order to more completely explain the present invention to those of ordinary skill in the art. Accordingly, the shapes and sizes of elements in the drawings may be exaggerated for clearer description.

본 발명의 일 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔은 구조물 벽면을 따라 이동할 수 있는 등벽장치에 장착된다. 등벽장치의 예시로는, 구조물 벽면을 따라 비행할 수 있는 드론 형태의 장치, 구조물 벽면에 부착되어 이동할 수 있는 로봇 형태의 장치 등이 있다.The modular robot arm for repairing or diagnosing the wall of a structure according to an embodiment of the present invention is mounted on a back wall device that can move along the wall of the structure. Examples of the back wall device include a drone-type device that can fly along the wall of a structure, a robot-type device that can be attached to the wall of a structure and can move.

또한, 본 발명의 일 실시예에 따른 모듈형 로봇팔은 등벽장치에 탈부착 가능하게 장착될 수 있다. 따라서, 모듈형 로봇팔의 보수 또는 유지에 유리하며, 등벽장치를 달리하여 장착될 수도 있다.In addition, the modular robot arm according to an embodiment of the present invention may be detachably mounted on the back wall device. Therefore, it is advantageous for repair or maintenance of the modular robot arm, and may be mounted with a different back wall device.

< 모듈형 로봇팔의 구성 >< Composition of modular robot arm >

도 1은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 전체적인 모습을 나타낸 사시도이고, 도 2는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 본체부와 링크부를 분리하여 나타낸 분해 사시도이며, 도 3은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 본체부의 구조를 나타낸 분해 사시도이다.1 is a perspective view showing an overall appearance of a modular robot arm for repair or diagnosis of a structure wall according to the present invention, and FIG. 2 is an exploded view showing the main body and a link portion of the modular robot arm for repair or diagnosis of a structure wall according to the present invention 3 is an exploded perspective view showing the structure of the main body of the modular robot arm for repair or diagnosis of the wall structure according to the present invention.

도 1 내지 도 3을 참조하면, 본 발명의 일 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔은 본체부(100)와 링크부(200)를 포함한다.1 to 3 , the modular robot arm for repairing or diagnosing a structure wall according to an embodiment of the present invention includes a body part 100 and a link part 200 .

본체부(100)는 등벽장치에 장착되어 링크부(200)의 구동 및 제어를 수행하는 것으로, 본체부(100)는 모듈 베이스(110), 제1 모터(142) 및 제2 모터(144)를 포함한다.The body part 100 is mounted on the back wall device to drive and control the link part 200 , and the body part 100 includes a module base 110 , a first motor 142 and a second motor 144 . includes

모듈 베이스(110)에는 링크부(200)를 구동시키기 위한 전원인 구동부(132)가 장착된다. 따라서, 본 발명의 일 실시예에 따른 모듈형 로봇팔은 등벽장치와 별도의 전원으로 구동될 수 있다. 다만, 변형된 실시예에서는 등벽장치와 모듈형 로봇팔이 통합된 전원에 의해 구동될 수도 있다.A driving unit 132 that is a power source for driving the link unit 200 is mounted on the module base 110 . Therefore, the modular robot arm according to an embodiment of the present invention can be driven by a separate power supply from the back wall device. However, in a modified embodiment, the back wall device and the modular robot arm may be driven by an integrated power source.

모듈 베이스(110)에는 링크부(200)를 제어하기 위한 제어부(134)가 장착된다. 제어부(134)는 제1 모터(142) 및 제2 모터(144)의 구동을 제어하거나, 링크부(200)에 장착된 각종 구동 장치(후술할 제3 모터 및 액츄에이터 등)를 제어한다. 제어부(134)는 소형 pc(mini-personal computer)일 수 있다.A control unit 134 for controlling the link unit 200 is mounted on the module base 110 . The control unit 134 controls driving of the first motor 142 and the second motor 144 , or controls various driving devices (such as a third motor and an actuator to be described later) mounted on the link unit 200 . The controller 134 may be a mini-personal computer (PC).

제어부(134)로는 사용자의 입력 데이터(예를 들어, 모터의 회전각 데이터)를 입력받아 제1 모터 내지 제3 모터(142, 144, 257)를 구동시킬 수 있다.The controller 134 may receive user input data (eg, rotation angle data of a motor) to drive the first to third motors 142 , 144 , and 257 .

제어부(134)는 본체부(100) 및 링크부(200)와 유선 또는 무선 통신 방식으로 연결되어 있다. 본 발명의 일 실시예에서는 CAN(Controller Area Network) 통신이 사용되나, 통신 방식에는 제한이 없다. 따라서, 제어부(134)는 예를 들어, 구동부(132), 제1 모터(142), 제2 모터(144) 및 링크부(200)의 각종 구동장치의 현재 상태를 알 수 있다.The control unit 134 is connected to the main body 100 and the link unit 200 in a wired or wireless communication method. In an embodiment of the present invention, controller area network (CAN) communication is used, but there is no limitation on the communication method. Accordingly, the control unit 134 may know, for example, the current state of various driving devices of the driving unit 132 , the first motor 142 , the second motor 144 , and the link unit 200 .

한편, 제1 모터(142) 및 제2 모터(144)에는 엔코더(encoder)가 내장된다. 엔코더는 제1 모터(142) 및 제2 모터(144)의 회전각을 측정하여 제어부(134)로 전송한다. 후술할 제3 모터(257)에도 엔코더가 장착될 수 있다.On the other hand, the encoder (encoder) is built in the first motor 142 and the second motor 144. The encoder measures the rotation angles of the first motor 142 and the second motor 144 and transmits them to the controller 134 . An encoder may also be mounted on a third motor 257 to be described later.

모듈 베이스(110)의 일측에는 제1 모터(142) 및 제2 모터(144)가 각각 장착될 수 있는 제1-1홀(112) 및 제1-2홀(114)이 형성된다. 다만, 모듈 베이스(110) 상에서 제1 모터(142) 및 제2 모터(144)가 장착되는 부위는 다양한 형상을 가질 수 있다.A 1-1 hole 112 and a 1-2 hole 114 in which the first motor 142 and the second motor 144 can be respectively mounted are formed on one side of the module base 110 . However, a portion on the module base 110 to which the first motor 142 and the second motor 144 are mounted may have various shapes.

모듈 베이스(110)에는 내부공간을 갖는 케이스(120)가 결합된다. 케이스(120)의 내부공간에는 구동부(132) 및 제어부(134)가 수용된다.A case 120 having an inner space is coupled to the module base 110 . The driving unit 132 and the control unit 134 are accommodated in the inner space of the case 120 .

제1 모터(142) 및 제2 모터(144)는 각각 제1-1홀(112) 및 제1-2홀(114)에 장착된다. 제1 모터(142) 및 제2 모터(144) 각각에는 모터(142, 144)가 회전할 수 있는 회전부(143, 145)가 형성되어 있다.The first motor 142 and the second motor 144 are mounted in the 1-1 hole 112 and the 1-2 hole 114, respectively. Rotating parts 143 and 145 capable of rotating the motors 142 and 144 are formed in each of the first motor 142 and the second motor 144 .

한편, 제1 모터(142) 및 제2 모터(144)에는 구동 토크를 증가시키기 위해 감속기가 더 장착될 수 있다.Meanwhile, the first motor 142 and the second motor 144 may be further equipped with a reduction gear to increase the driving torque.

도 4는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제1 패시브 조인트부의 구조를 나타내 분해 사시도이고, 도 5는 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제2 엑티브 조인트부의 구조를 위에서 아래 방향으로 경사지게 바라본 분해 사시도이며, 도 6은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 제2 엑티브 조인트부의 구조를 아래서 위 방향으로 경사지게 바라본 분해 사시도이다.4 is an exploded perspective view showing the structure of the first passive joint part of the modular robot arm for repair or diagnosis of a structure wall according to the present invention, and FIG. 5 is a second active joint of the modular robot arm for repair or diagnosis of the structure wall according to the present invention. 6 is an exploded perspective view of the structure of the part viewed obliquely from the top down, and FIG. 6 is an exploded perspective view of the structure of the second active joint part of the modular robot arm for repair or diagnosis of the structure wall according to the present invention.

링크부(200)는 본체부(100)와 연결되어 링크운동을 수행하는 것으로, 제1 링크(210), 제2 링크(220), 제3 링크(230) 및 제4 링크(240)를 포함한다.The link unit 200 is connected to the body unit 100 to perform a link movement, and includes a first link 210 , a second link 220 , a third link 230 , and a fourth link 240 . do.

본 발명의 일 실시예에서 제1 링크(210)와 제2 링크(220)는 그 형상이 같고, 제3 링크(230)와 제4 링크(240)는 그 형상이 같다. 따라서, 제1 링크(210)와 제3 링크(230)의 형상을 중심으로 설명하며, 제2 링크(220) 및 제4 링크(240)의 자세한 설명은 생략한다.In an embodiment of the present invention, the first link 210 and the second link 220 have the same shape, and the third link 230 and the fourth link 240 have the same shape. Accordingly, the shapes of the first link 210 and the third link 230 will be mainly described, and detailed descriptions of the second link 220 and the fourth link 240 will be omitted.

한편, 제1 내지 제4 링크(210, 220, 230, 240)가 연결된 부위는 패시브 조인트부(P1, P2)와 엑티브 조인트부(A1, A2)로 구분될 수 있다. 패시브 조인트부(P1, P2)는 모터 등 구동 장치 없이 링크가 연결된 부분이고, 엑티브 조인트부(A1, A2)는 링크 연결된 부분에 모터 등 구동 장치를 포함한다.Meanwhile, portions to which the first to fourth links 210 , 220 , 230 , and 240 are connected may be divided into passive joint portions P1 and P2 and active joint portions A1 and A2 . The passive joint parts P1 and P2 are parts to which a link is connected without a driving device such as a motor, and the active joint parts A1 and A2 include a driving device, such as a motor, to the link connected part.

도 4를 참조하면, 제1 링크(210)의 일단에는 제1 모터(142)의 회전부(143)에 동일 중심축(회전축)을 갖고 장착되는 제1 모터 연결부(212)가 형성되고, 타단에는 제3 링크(230)와 연결되는 제1 링크 연결부(214)가 형성된다.Referring to FIG. 4 , at one end of the first link 210 , a first motor connection unit 212 mounted with the same central axis (rotation axis) to the rotating unit 143 of the first motor 142 is formed, and at the other end of the first link 210 . A first link connecting portion 214 connected to the third link 230 is formed.

여기서, 제1 링크(210) 및 제2 링크(220)가 제1 모터(142) 및 제2 모터(144)와 연결되는 부위는 제1 엑티브 조인트부(A1)이다. 제1 엑티부 조인트부(A1)에서 제1 링크(210) 및 제2 링크(220)는 제1 모터(142) 및 제2 모터(144)의 구동에 의해 움직인다.Here, a portion where the first link 210 and the second link 220 are connected to the first motor 142 and the second motor 144 is the first active joint part A1 . In the first active joint part A1 , the first link 210 and the second link 220 are moved by the driving of the first motor 142 and the second motor 144 .

도 4를 참조하면, 제3 링크(230)의 일단에는 제1 링크 연결부(214)와 회전 가능하게 연결되는 제3-1 링크 연결부(232a)와 제3-2 링크 연결부(232b)가 형성되고, 타단에는 제3-3 링크 연결부(236)가 형성된다.Referring to FIG. 4 , a 3-1 link connection part 232a and a 3-2 link connection part 232b rotatably connected to the first link connection part 214 are formed at one end of the third link 230 , and , a third-third link connection part 236 is formed at the other end.

제1 링크 연결부(214)가 제3-1 링크 연결부(232a) 및 제3-2 링크 연결부(232b) 사이에 위치한 상태에서 링크 연결축(231)이 삽입되면 제1 링크(210)와 제3 링크(230)가 회전가능하게 연결된다. 링크 연결축(231)에는 링크의 회전을 돕기 위해 베어링(233a, 233b)이 장착된다.When the link connecting shaft 231 is inserted in a state where the first link connecting portion 214 is positioned between the 3-1 link connecting portion 232a and the 3-2 link connecting portion 232b, the first link 210 and the third Links 230 are rotatably connected. Bearings 233a and 233b are mounted on the link connecting shaft 231 to help the link rotate.

여기서, 제1 링크(210) 및 제3 링크(230)가 서로 연결되는 부위는 제1 패시브 조인트부(P1)이다. 제1 패시브 조인트부(P1)에서 제3 링크(230)는 제1 링크(210)의 움직임에 따라 수동적으로 운동한다.Here, the portion where the first link 210 and the third link 230 are connected to each other is the first passive joint portion P1. In the first passive joint portion P1 , the third link 230 passively moves according to the movement of the first link 210 .

한편, 제2 링크(220)와 제4 링크(240)는 상술한 제1 링크(210)와 제3 링크(230)의 연결 구조와 동일하며, 이때의 연결 부위는 제2 패시브 조인트부(P2)이다.On the other hand, the second link 220 and the fourth link 240 have the same connection structure as the above-described first link 210 and the third link 230 , and the connection part at this time is the second passive joint part P2 . )to be.

제3 링크(230)와 제4 링크(240)는 대략 'L'자 형상을 갖는다. 따라서, 제3 링크(230)와 제4 링크(240)가 서로 마주보고 있는 상태에서 각각의 일단이 만날 수 있다. 제3 링크(230)와 제4 링크(240) 각각의 일단이 서로 만날 수 있다면 제3 링크(230) 및 제4 링크(240)가 다양한 형상을 갖는 변형예도 가능하다.The third link 230 and the fourth link 240 have an approximately 'L' shape. Accordingly, each end may meet in a state where the third link 230 and the fourth link 240 face each other. If one end of each of the third link 230 and the fourth link 240 can meet each other, a modified example in which the third link 230 and the fourth link 240 has various shapes is also possible.

여기서, 제3 링크(230)와 제4 링크(240)가 연결되는 부위는 제2 엑티브 조인트부(A2)이다.Here, the portion where the third link 230 and the fourth link 240 are connected is the second active joint part A2 .

도 5 및 도 6을 참조하면, 제2 엑티브 조인트부(A2)는 제3 모터(257), 제3 링크(230)와 제4 링크(240)를 결합하는 복수의 결합부를 포함한다.5 and 6 , the second active joint part A2 includes a third motor 257 , and a plurality of coupling parts for coupling the third link 230 and the fourth link 240 .

제3 모터(257)의 하단에는 액츄에이터 연결부(258)가 장착된다. 따라서, 제3 모터(257)가 회전하면 액츄에이터 연결부(258)도 함께 회전한다. 한편, 액츄에이터 연결부(258)에는 후술할 액츄에이터(270)가 삽입되는 삽입홈이 형성된다. 제3 모터(257)에는 엔코더가 내장될 수 있다.An actuator connection part 258 is mounted at the lower end of the third motor 257 . Accordingly, when the third motor 257 rotates, the actuator connection part 258 also rotates. On the other hand, the actuator connecting portion 258 is formed with an insertion groove into which the actuator 270, which will be described later, is inserted. An encoder may be embedded in the third motor 257 .

결합부는 제3 링크 상단 결합부(251), 제3 링크 하단 결합부(252), 제4 링크 상단 결합부(253) 및 제4 링크 하단 결합부(254)를 포함한다The coupling part includes a third link upper coupling part 251 , a third link lower coupling part 252 , a fourth link top coupling part 253 , and a fourth link lower coupling part 254 .

제3 링크 상단 결합부(251)와 제3 링크 하단 결합부(252)는 제3 링크(230)와 연결되는 구성이고, 제4 링크 상단 결합부(253)와 제4 링크 하단 결합부(254)는 제4 링크(240)와 연결되는 구성이다.The third link upper coupling part 251 and the third link lower coupling part 252 are configured to be connected to the third link 230 , and the fourth link upper coupling part 253 and the fourth link lower coupling part 254 are connected. ) is a configuration connected to the fourth link 240 .

제3 링크 상단 결합부(251)의 일측에는 조인트축(255)이 형성된다. 제3 링크 하단 결합부(252)의 중심부위는 액츄에이터 연결부(258)가 관통되는 홀이 형성된다.A joint shaft 255 is formed on one side of the third link upper coupling portion 251 . A hole through which the actuator connection part 258 passes is formed on the center of the third link lower coupling part 252 .

제3 링크 상단 결합부(251)와 제3 링크 하단 결합부(252)는 제3 모터(257)를 수용하면서 서로 결합될 수 있다.The third link upper coupling part 251 and the third link lower coupling part 252 may be coupled to each other while accommodating the third motor 257 .

제3 링크 상단 결합부(251)와 제3 링크 하단 결합부(252) 사이에 제3 링크(230)의 제3-3 링크 연결부(236)가 삽입되어 고정됨으로써, 제3 링크(230)가 제2 엑티브 조인트부(A2)에 결합된다.The 3-3 link connection part 236 of the third link 230 is inserted and fixed between the third link top coupling part 251 and the third link bottom coupling part 252, so that the third link 230 is It is coupled to the second active joint part A2.

제4 링크 상단 결합부(253)의 일측에는 조인트축(255)에 삽입되어 회전가능하게 연결되는 홀이 형성된다. 제4 링크 하단 결합부(254)의 일측에는 액츄에이터 연결부(258)가 관통되도록 홀이 형성된다.A hole is formed in one side of the fourth link upper coupling part 253 to be rotatably connected to being inserted into the joint shaft 255 . A hole is formed at one side of the fourth link lower coupling part 254 so that the actuator connection part 258 passes therethrough.

제3 링크 상단 결합부(251)의 일측에는 조인트축(255)이 형성된다. 제3 링크 하단 결합부(252)의 중심부위는 액츄에이터 연결부(258)가 삽입되어 회전가능하게 연결되는 홀이 형성된다.A joint shaft 255 is formed on one side of the third link upper coupling portion 251 . A hole is formed in the center of the third link lower coupling part 252 through which the actuator connection part 258 is inserted and rotatably connected.

제4 링크 상단 결합부(253)와 제4 링크 하단 결합부(254) 사이에 제4 링크(240)의 제4-3 링크 연결부(246)가 삽입되어 고정됨으로써, 제4 링크(240)가 제2 엑티브 조인트부(A2)에 결합된다.By inserting and fixing the 4-3 link connection part 246 of the fourth link 240 between the fourth link upper coupling part 253 and the fourth link lower coupling part 254, the fourth link 240 is It is coupled to the second active joint part A2.

정리하면, 제3 링크(230)와 제4 링크(240)는 각각 제2 엑티브 조인트부(A2)와 회전가능하게 연결된다.In summary, the third link 230 and the fourth link 240 are rotatably connected to the second active joint part A2, respectively.

액츄에이터(270)는 직선 운동하는 리니어 모터일 수 있다. 액츄에이터(270)의 일단은 액츄에이터 연결부(258)에 형성된 삽입홈에 삽입되고, 타단에는 엔드 이펙터(end effector)(280)가 탈착 가능하게 장착된다. 제3 모터(257)의 회전에 따라 액츄에이터 연결부(258)에 연결된 액츄에이터(270)도 함께 회전한다.The actuator 270 may be a linear motor that moves in a straight line. One end of the actuator 270 is inserted into the insertion groove formed in the actuator connection part 258 , and an end effector 280 is detachably mounted on the other end. As the third motor 257 rotates, the actuator 270 connected to the actuator connection part 258 also rotates.

엔드 이펙터(280)는 구조물 벽면 보수 또는 진단을 위한 장치가 장착될 수 있다. 예를 들어, 엔드 이펙터는 구조물 벽면의 균열 위치에 균열 도포재를 바르고 다질 수 있는 장치가 장착될 수 있다. 다만, 이에 한정되지 않으며, 작업 용도에 따른 다양한 장치가 엔드 이펙터(280)로 사용될 수 있다.The end effector 280 may be equipped with a device for repairing or diagnosing the wall of the structure. For example, the end effector may be equipped with a device capable of applying and compacting a crack coating material to a crack location on a wall of a structure. However, the present invention is not limited thereto, and various devices according to the purpose of work may be used as the end effector 280 .

한편, 본 발명의 일 실시예에 따르면 작업 위치를 촬영하기 위해 카메라 , 비전 시스템 등의 영상 수단이 더 장착될 수 있다. 영상 수단은 촬영 이미지를 제어부(134)에 전송한다.Meanwhile, according to an embodiment of the present invention, an imaging means such as a camera and a vision system may be further mounted to photograph the working position. The imaging unit transmits the captured image to the control unit 134 .

상술한 바와 같이, 본 발명은 등벽장치에 장착되므로, 모듈형 로봇팔이 가벼운 것이 바람직하다. 본 발명의 일 실시예에서 제1 내지 제3 모터(142, 144, 257)는 1kg 보다 가벼운 모터가 사용되었고, 제1 내지 제4 링크(210, 220, 230, 240)가 플라스틱 재료가 사용되었다. 다만, 모듈형 로봇팔이 구동될 때 각 부품들은 사용된 재료의 항복 응력을 넘지 않아야 한다.As described above, since the present invention is mounted on the back wall device, it is preferable that the modular robot arm is light. In an embodiment of the present invention, the first to third motors 142, 144, and 257 were motors lighter than 1 kg, and the first to fourth links 210, 220, 230, and 240 were plastic materials. . However, when the modular robot arm is driven, each part must not exceed the yield stress of the material used.

한편, 본 발명의 일 실시예에서는 4개의 링크(210, 220, 230, 240)가 사용되었으나, 작업의 종류, 엔드 이펙터(280)의 자유도 변경 등을 위해 링크의 개수, 길이, 형상, 모터의 개수 등이 다양하게 변경될 수 있다.Meanwhile, in an embodiment of the present invention, four links 210 , 220 , 230 , and 240 are used, but the number, length, shape, and motor of the links are used to change the type of operation and the degree of freedom of the end effector 280 . The number and the like may be variously changed.

< 모듈형 로봇팔의 동작 >< Operation of modular robot arm >

도 7은 본 발명에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔이 접힌 상태를 나타낸 도면이다.7 is a view showing a folded state of the modular robot arm for repair or diagnosis of the wall of the structure according to the present invention.

이하, 도 1 내지 도 7을 참조하여, 본 발명의 일 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 동작을 살펴본다.Hereinafter, with reference to FIGS. 1 to 7, the operation of the modular robot arm for repairing or diagnosing the wall of a structure according to an embodiment of the present invention will be described.

본 발명의 일 실시예에 따른 모듈형 로봇팔은 링크부(200)의 링크 운동을 통해 엔드 이펙터(280)의 위치를 변화시킨다. 이때, 링크부(200)는 동일 평면 상에서 링크 운동을 한다. 즉, 제1 모터(142) 및 제2 모터(144) 중 적어도 어느 하나의 구동(예를 들어 회전각 제어)에 의해 제1 링크 내지 제4 링크(210, 220, 230, 240)는 동일 평면 상에서 링크 운동을 수행하며, 이러한 운동에 따라 제2 엑티브 조인트부(A2)의 위치가 변하게 된다. 따라서, 본 발명에서 각 링크(210, 220, 230, 240)가 동일 평면 상에서 운동하므로 엔드 이펙터(280)가 구조물 벽면을 따라 이동하며 작업하기가 용이하다.The modular robot arm according to an embodiment of the present invention changes the position of the end effector 280 through the link movement of the link unit 200 . At this time, the link unit 200 performs a link movement on the same plane. That is, by driving at least one of the first motor 142 and the second motor 144 (eg, rotation angle control), the first to fourth links 210 , 220 , 230 , and 240 are coplanar The link movement is performed on the upper surface, and the position of the second active joint part A2 is changed according to the movement. Therefore, in the present invention, since each link (210, 220, 230, 240) moves on the same plane, the end effector 280 is easy to work while moving along the wall of the structure.

한편, 액츄에이터(270)는 상술한 링크 운동의 평면 방향과 수직 방향으로 움직일 수 있다. 상술한 링크 운동의 평면 방향이 x-y 평면 방향이라고 하면, 액츄에이터(270)는 z 방향으로 승하강 할 수 있다. 따라서, 제1 링크 내지 제4 링크(210, 220, 230, 240)의 링크 운동을 통해 제2 엑티브 조인트부(A2)를 x-y 평면 상의 특정 위치로 이동시킨 뒤, 액츄에이터(270)를 작동시켜 엔드 이펙터(280)를 z 방향으로 이동시켜 작업 위치까지 이동시킬 수 있다.Meanwhile, the actuator 270 may move in a direction perpendicular to the plane direction of the above-described link movement. If the plane direction of the above-described link motion is the x-y plane direction, the actuator 270 may ascend and descend in the z direction. Therefore, after moving the second active joint part A2 to a specific position on the x-y plane through the link movement of the first link to the fourth link 210, 220, 230, 240, the actuator 270 is operated to the end The effector 280 may be moved in the z-direction to move to a working position.

정리하면, 본 발명의 일 실시예에 따른 엔드 이펙터(280)의 x, y 좌표는 제1 모터(142) 및/또는 제2 모터(144)의 구동에 의해 제어될 수 있고, z 좌표는 액츄에이터(270)의 구동에 의해 제어될 수 있다.In summary, the x and y coordinates of the end effector 280 according to an embodiment of the present invention may be controlled by the driving of the first motor 142 and/or the second motor 144 , and the z coordinate is the actuator It can be controlled by the actuation of 270 .

또한, 액츄에이터(270)는 제3 모터(257)에 의해 회전하는 것이 가능하다. 따라서, 작업 지점에서 제3 모터(257)의 회전각을 제어하여 엔드 이펙터(280)를 동작시키는 것이 가능하다.In addition, the actuator 270 may be rotated by the third motor 257 . Accordingly, it is possible to operate the end effector 280 by controlling the rotation angle of the third motor 257 at the work point.

본 발명에 따르면 카메라 등의 영상 수단에서 파악된 보수 위치를 참고하여 제1 내지 제3 모터(142, 144, 257) 중 적어도 어느 하나 및 액츄에이터(270)를 구동시킬 수 있다.According to the present invention, at least one of the first to third motors 142 , 144 , and 257 and the actuator 270 may be driven with reference to the maintenance position identified by an image means such as a camera.

도 1은 본 발명의 일 실시예에 따른 모듈형 로봇팔이 완전히 펼쳐진 상태를 나타내고, 도 7은 모듈형 로봇팔이 완전히 접혀진 상태를 나타낸다. 모듈형 로봇팔의 펼쳐진 상태는 작업 중인 상태이며, 접혀진 상태는 작업을 마친 후의 상태일 수 있다.1 shows a state in which the modular robot arm is fully unfolded according to an embodiment of the present invention, and FIG. 7 shows a state in which the modular robot arm is fully folded. The unfolded state of the modular robot arm may be a working state, and the folded state may be a state after completing the work.

도 1에 도시된 바와 같이, 도 1에 도시된 상태를 기준으로 제1 모터(142)가 설정된 회전각 만큼 반시계 방향으로 회전하고 제2 모터(144)가 설정된 회전각 만큼 시계 방향으로 회전하면 각 링크(210, 220, 230, 240)가 펼쳐지도록 운동한다.As shown in Fig. 1, based on the state shown in Fig. 1, the first motor 142 rotates counterclockwise by the set rotation angle and the second motor 144 rotates clockwise by the set rotation angle. Each link (210, 220, 230, 240) is exercised to unfold.

반대로, 도 7에 도시된 상태를 기준으로, 제1 모터(142)가 설정된 회전각 만큼 시계 방향으로 회전하고, 제2 모터(144)가 설정된 회전각 만큼 반시계 방향으로 회전하면 각 링크(210, 220, 230, 240)가 접혀지도록 운동한다.Conversely, based on the state shown in FIG. 7 , when the first motor 142 rotates clockwise by a set rotation angle, and the second motor 144 rotates counterclockwise by the set rotation angle, each link 210 , 220, 230, 240) to be folded.

모듈형 로봇팔이 완전히 접혀진 상태에서는 공간을 차지하는 부피가 적으므로, 모듈형 로봇팔을 저장하기가 용이하다. 물론, 공간의 형상에 따라 링크(210, 220, 230, 240)를 운동 시킨 뒤 정지하여 모듈형 로봇팔을 저장하는 것도 가능하다.When the modular robot arm is fully folded, the volume occupied by the space is small, so it is easy to store the modular robot arm. Of course, it is also possible to store the modular robot arm by stopping after moving the links (210, 220, 230, 240) according to the shape of the space.

< 모듈형 로봇팔의 기구학적 모델 > < Kinematic model of modular robot arm >

도 8은 본 발명의 일 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 움직임을 해석하기 위한 기구학적 모델을 나타낸 도면이며, 도 9는 본 발명의 다른 실시예에 따른 구조물 벽면 보수 또는 진단용 모듈형 로봇팔의 움직임을 해석하기 위한 기구학적 모델을 나타낸 도면이다.8 is a view showing a kinematic model for analyzing the movement of a modular robot arm for repair or diagnosis of a structure wall according to an embodiment of the present invention, and FIG. It is a diagram showing a kinematic model for analyzing the movement of a modular robot arm.

본 발명의 일 실시예에 따른 모듈형 로봇팔은, 제1 내지 제4 링크(210, 220, 230, 240), 제1 모터(142)와 제2 모터(144) 간 가상의 링크로 구성된 5절 링크로 해석될 수 있다.The modular robot arm according to an embodiment of the present invention is composed of a virtual link between the first to fourth links 210 , 220 , 230 , 240 , the first motor 142 and the second motor 144 . It can be interpreted as a clause link.

본 발명의 모듈형 로봇팔을 이용하여 엔드 이펙터(280)의 위치를 작업 위치로 이동시키기 위해, 기구학적 모델을 통해 제1 모터(142) 및 제2 모터(144)의 회전각을 추정하는 것이 가능하다.In order to move the position of the end effector 280 to the working position using the modular robot arm of the present invention, estimating the rotation angles of the first motor 142 and the second motor 144 through a kinematic model is It is possible.

도 8을 참조하면, 아래와 같은 < 수학식 1 >에 의해

Figure 112021152465381-pat00001
,
Figure 112021152465381-pat00002
,
Figure 112021152465381-pat00003
,
Figure 112021152465381-pat00004
,
Figure 112021152465381-pat00005
가 계산될 수 있다. 이때, 제2 cos 법칙이 사용된다.Referring to FIG. 8, by the following <Equation 1>
Figure 112021152465381-pat00001
,
Figure 112021152465381-pat00002
,
Figure 112021152465381-pat00003
,
Figure 112021152465381-pat00004
,
Figure 112021152465381-pat00005
can be calculated. In this case, the second cos law is used.

< 수학식 1 >< Equation 1 >

Figure 112021152465381-pat00006
Figure 112021152465381-pat00006

Figure 112021152465381-pat00007
Figure 112021152465381-pat00007

Figure 112021152465381-pat00008
Figure 112021152465381-pat00008

Figure 112021152465381-pat00009
Figure 112021152465381-pat00009

Figure 112021152465381-pat00010
Figure 112021152465381-pat00010

여기서, 아래 < 수학식 2 >와 같이, 각 각도의 부호에 따라 4가지 경우(case 1 ~ case 4)가 생긴다.Here, as shown in <Equation 2> below, four cases (case 1 to case 4) occur according to the sign of each angle.

< 수학식 2 >< Equation 2 >

Figure 112021152465381-pat00011
Figure 112021152465381-pat00011

Case 1Case 1

Figure 112021152465381-pat00012
Figure 112021152465381-pat00012

Case 2Case 2

Figure 112021152465381-pat00013
Figure 112021152465381-pat00013

Case 3Case 3

Figure 112021152465381-pat00014
Figure 112021152465381-pat00014

Case 4Case 4

Figure 112021152465381-pat00015
Figure 112021152465381-pat00015

여기서, a는 역삼각함수 기호를 의미한다.Here, a means an inverse trigonometric function symbol.

한편, Case 3를 고려하는 경우, 제1 모터(142) 및 제2 모터(144)의 내장 엔코도로 각도를 측정하고, 이를 이용하여 정기구학 해석을 통해 엔드 이펙터(280)의 상대 위치를 계산하여 추정한다. 이때, 엔드 이펙터(280)의 x, y 좌표는 아래 < 수학식 3 >과 같이 계산될 수 있다.On the other hand, when considering Case 3, the angle is measured with the built-in encoders of the first motor 142 and the second motor 144, and the relative position of the end effector 280 is calculated through regular kinematic analysis using this. estimate In this case, the x and y coordinates of the end effector 280 may be calculated as shown in Equation 3 below.

< 수학식 3 >< Equation 3 >

Figure 112021152465381-pat00016
Figure 112021152465381-pat00016

한편, 도 9를 참조하면 본 발명의 다른 실시예에 따라 엔드 이펙터(280)의 위치를 계산할 수 있다.Meanwhile, referring to FIG. 9 , the position of the end effector 280 may be calculated according to another embodiment of the present invention.

< 수학식 4 >< Equation 4 >

Figure 112021152465381-pat00017
Figure 112021152465381-pat00017

Figure 112021152465381-pat00018
Figure 112021152465381-pat00018

상기 m, n 값을 이용하여 모터가 없는 패시브 조인트부(P1, P2)의 각도를 아래 < 수학식 5 >와 같이 구할 수 있다. 이때, 제2 cos 법칙이 사용된다.By using the m and n values, the angles of the passive joint parts P1 and P2 without a motor can be obtained as shown in Equation 5 below. In this case, the second cos law is used.

< 수학식 5 >< Equation 5 >

Figure 112021152465381-pat00019
Figure 112021152465381-pat00019

Figure 112021152465381-pat00020
Figure 112021152465381-pat00020

이때, 제1 모터(142) 및 제2 모터(144)의 각도에 따라 아래의 2가지 경우(case 1 및 case 2)가 생기며, 각 경우에서 엔드 이펙터(280)의 위치가 계산될 수 있다.In this case, the following two cases (case 1 and case 2) occur according to the angles of the first motor 142 and the second motor 144 , and the position of the end effector 280 may be calculated in each case.

Case 1Case 1

Figure 112021152465381-pat00021
Figure 112021152465381-pat00021

Case 2Case 2

Figure 112021152465381-pat00022
Figure 112021152465381-pat00022

한편, 상술한 실시예들에 따라 얻어낸 값을 1-cos 궤적으로 이동시켜 모터의 초기 속도를 0으로 만들어준다.Meanwhile, the value obtained according to the above-described embodiments is moved to a 1-cos trajectory to make the initial speed of the motor 0.

< 모듈형 로봇팔의 구동 실험 >< Driving experiment of modular robot arm >

도 10a는 본 발명의 일 실시예에 따른 모듈형 로봇팔의 링크 동작에 따른 엔드 이펙터의 이동 상태를 나타낸 도면이고, 도 10b는 도 10a에 도시된 각 엔드 이펙트의 x 및 y 방향 위치 변화를 나타낸 그래프이며, 도 11a는 본 발명의 일 실시예에 따른 모듈형 로보팔의 액츄에이터 동작에 따른 엔드 이펙터의 이동 상태를 나타낸 도면이고, 도 11b는 도 11a에 도시된 각 엔드 이펙터의 z 방향 위치 변화를 나타낸 그래프이다.Figure 10a is a view showing the movement state of the end effector according to the link operation of the modular robot arm according to an embodiment of the present invention, Figure 10b is a view showing the x and y direction position change of each end effect shown in Figure 10a It is a graph, and Fig. 11a is a view showing the movement state of the end effector according to the actuator operation of the modular robopal according to an embodiment of the present invention, and Fig. 11b is the z-direction position change of each end effector shown in Fig. 11a is the graph shown.

본 발명의 발명자는 실제 모듈형 로봇팔을 제작하여 각 링크(210, 220, 230, 240) 또는 액츄에이터(270)를 구동시켜 엔드 이펙터(280)의 위치 변화를 측정하였다. 이때, 엔드 이펙터(280)의 위치는 모션 캡쳐 장비를 이용하여 측정하였다.The inventor of the present invention measured the position change of the end effector 280 by manufacturing a real modular robot arm and driving each link 210 , 220 , 230 , 240 or actuator 270 . At this time, the position of the end effector 280 was measured using a motion capture device.

도 10a의 (a), (b), (c)에는 제1 모터(142) 및 제2 모터(144)를 구동시켜 엔드 이펙터(280)가 y방향으로 각각 0mm(도 10a의 (a)), 100mm(도 10a의 (b)), 0mm(도 10a의 (c))로 이동시키도록 모듈형 로봇팔에 데이터를 입력하였다. 이때, 액츄에이터(270)는 멈춘 상태이다.10A (a), (b), (c), the first motor 142 and the second motor 144 are driven so that the end effector 280 is 0 mm in the y-direction, respectively (Fig. 10a (a)) , 100 mm ((b) of FIG. 10A), and 0 mm ((c) of FIG. 10) were inputted to the modular robot arm to move the data. At this time, the actuator 270 is in a stopped state.

도 10b는 도 10a의 (a), (b), (c)에 도시된 각 상태에서 모션 캡쳐 장비를 이용하여 실제 엔드 이펙터(280)가 이동한 x 및 y 방향 위치 변화를 나타낸 그래프이다.FIG. 10B is a graph showing changes in the x and y directions of the actual movement of the end effector 280 using the motion capture device in each of the states shown in (a), (b) and (c) of FIG. 10A .

엔드 이펙터(280)의 y방향만을 고려할 때, 실제 모션 캡쳐 장비에 의해 측정된 결과를 살펴보면, 도 10a의 (a)에 도시된 상태에서 y방향 좌표는 0.005005mm, 도 10a의 (b)에 도시된 상태에서 y방향 좌표는 101.796mm, 도 10a의 (c)에 도시된 상태에서 y방향 좌표는 -0.379944mm 였다. 즉, 엔드 이펙터(280)를 y방향으로 0mm에서 100mm으로 움직이도록 명령했을 때, 제어 오차는 1.796mm 정도 였다.Considering only the y-direction of the end effector 280, looking at the results measured by the actual motion capture device, the y-direction coordinates in the state shown in (a) of FIG. 10A are 0.005005 mm, shown in (b) of FIG. 10A In the state shown in (c) of FIG. 10A, the y-direction coordinate was 101.796 mm, and the y-direction coordinate was -0.379944 mm in the state shown in (c) of FIG. 10A. That is, when the end effector 280 was commanded to move from 0 mm to 100 mm in the y-direction, the control error was about 1.796 mm.

도 11a의 (a), (b), (c)에는 액츄에이터(270)를 구동시켜 엔드 이펙터(280)가 z 방향으로 0mm(도 11a의 (a)), -50mm(도 11a의 (b)), 0mm(도 11a의 (c))로 이동시키도록 모듈형 로봇팔에 데이터를 입력하였다. 이때, 다른 모터(142, 144, 257)는 멈춘 상태이다.11A (a), (b), (c), the actuator 270 is driven so that the end effector 280 is 0 mm ((a) of FIG. 11 a), -50 mm ((b) of FIG. 11 a) in the z direction. ), data was input to the modular robot arm to move to 0 mm (Fig. 11a (c)). At this time, the other motors (142, 144, 257) are in a stopped state.

도 11b는 도 11a의 (a), (b), (c)에 도시된 각 상태에서 모션 캡쳐 장비를 이용하여 실제 엔드 이펙터(280)가 이동한 z 방향 위치 변화를 나타낸 그래프이다.11B is a graph showing a change in the z-direction position in which the end effector 280 actually moves using a motion capture device in each of the states shown in (a), (b), and (c) of FIG. 11A .

엔드 이펙터(280)의 z방향만을 고려할 때, 실제 모션 캡쳐 장비에 의해 측정된 결과를 살펴보면, 도 11a의 (a)에 도시된 상태에서 z방향 좌표는 0.011139mm, 도 11a의 (b)에 도시된 상태에서 z방향 좌표는 -50.0591mm, 도 11a의 (c)에 도시된 상태에서 z방향 좌표는 0.017639mm 였다. 즉, 엔드 이펙터(280)를 z방향으로 0mm에서 -50mm으로 움직이도록 명령했을 때, 제어 오차는 0.0591mm 정도 였다.Considering only the z-direction of the end effector 280, looking at the results measured by the actual motion capture device, the z-direction coordinates in the state shown in (a) of FIG. 11a are 0.011139 mm, shown in (b) of FIG. 11a In the state shown in (c) of FIG. 11a, the z-direction coordinate was -50.0591 mm, and the z-direction coordinate was 0.017639 mm in the state shown in (c) of FIG. 11A. That is, when the end effector 280 was commanded to move from 0 mm to -50 mm in the z direction, the control error was about 0.0591 mm.

상술한 실험 결과에서 알 수 있듯이 본 발명에 따르면 엔드 이펙터(280)는 x, y, z 방향으로 안정된 상태를 유지하며 이동할 수 있는 것을 알 수 있다. 따라서, 본 발명에 따른 모듈형 로봇팔은 등벽장치에 장착된 상태에서도 안정적으로 구조물 벽면의 보수 또는 진단을 수행하는 것이 가능하다.As can be seen from the above experimental results, it can be seen that according to the present invention, the end effector 280 can move while maintaining a stable state in the x, y, and z directions. Therefore, the modular robot arm according to the present invention can stably repair or diagnose the wall of the structure even in a state mounted on the back wall device.

본 발명은 첨부된 도면에 도시된 일 실시예를 참고로 설명되었으나 이는 예시적인 것에 불과하며, 당해 기술분야에서 통상의 지식을 가진 자라면 이로부터 다양한 변형 및 균등한 타 실시예가 가능하다는 점을 이해할 수 있을 것이다. 따라서, 본 발명의 진정한 보호 범위는 첨부된 청구 범위에 의해서만 정해져야 할 것이다.Although the present invention has been described with reference to an embodiment shown in the accompanying drawings, which is only exemplary, those skilled in the art will understand that various modifications and equivalent other embodiments are possible therefrom. will be able Accordingly, the true protection scope of the present invention should be defined only by the appended claims.

100 : 본체부 110 : 모듈 베이스
112 : 제1-1홀 114 : 제1-2홀
120 : 케이스 132 : 구동부
134 : 제어부 142 : 제1 모터
143 : 회전부 144 : 제2 모터
145 : 회전부 200 : 링크부
210 : 제1 링크 212 : 제1 모터 연결부
214 : 제1 링크 연결부 220 : 제2 링크
231 : 링크 연결축 233a, 233b : 베어링
230 : 제3 링크 232a : 제3-1 링크 연결부
232b : 제3-2 링크 연결부 236 : 제3-3 링크 연결부
240 : 제4 링크 242a : 제4-1 링크 연결부
242b : 제4-2 링크 연결부 246 : 제4-3 링크 연결부
251 : 제3 링크 상단 결합부 252 : 제3 링크 하단 결합부
253 : 제4 링크 상단 결합부 254 : 제4 링크 하단 결합부
255 : 조인트축 257 : 제3 모터
258 : 액츄에이터 연결부 270 : 액츄에이터
280 : 엔드 이펙터
100: main body 110: module base
112: Hall 1-1 114: Hall 1-2
120: case 132: driving unit
134: control unit 142: first motor
143: rotating part 144: second motor
145: rotating part 200: link part
210: first link 212: first motor connection part
214: first link connection unit 220: second link
231: link connecting shaft 233a, 233b: bearing
230: third link 232a: 3-1 link connection unit
232b: 3-2 link connection part 236: 3-3 link connection part
240: fourth link 242a: 4-1 link connection unit
242b: 4-2 link connection part 246: 4-3 link connection part
251: third link upper coupling part 252: third link lower coupling part
253: fourth link upper coupling part 254: fourth link lower coupling part
255: joint shaft 257: third motor
258: actuator connection part 270: actuator
280: end effector

Claims (12)

제1 모터와 제2 모터가 장착된 모듈 베이스;
상기 제1 모터의 회전 중심축과 연결된 제1 링크 및 상기 제2 모터의 회전 중심축과 연결된 제2 링크;
일단이 각각 상기 제1 링크 및 제2 링크와 연결되고, 타단이 서로 연결된 제3 링크 및 제4 링크; 및
상기 제3 링크와 제4 링크 간 연결 부위인 결합부에 장착된 엔드 이펙터;를 포함하고,
상기 결합부는,
상기 제3 링크의 타단이 삽입되어 연결되도록 상단과 하단에 각각 형성된 제3 링크 상단 결합부 및 제3 링크 하단 결합부; 및
상기 제4 링크의 타단이 삽입되어 연결되도록 상단과 하단에 각각 형성된 제4 링크 상단 결합부 및 제4 링크 하단 결합부;를 포함하고,
상기 결합부에는 제3 모터가 장착되고,
상기 제3 모터의 하부에는 상기 제3 모터의 회전 중심축 방향으로 액츄에이터가 연결되고,
상기 액츄에이터는 상기 제3 모터의 구동에 의해 회전하고,
상기 액츄에이터의 일단에는 상기 엔드 이펙터가 장착되고,
상기 제3 링크 상단 결합부와 상기 제3 링크 하단 결합부는 상기 제3 모터를 수용하면서 서로 결합되고,
상기 제3 링크 상단 결합부의 상면에는 조인트축이 형성되고,
상기 제4 링크 상단 결합부는 상기 조인트축에 회전가능하게 결합되고,
상기 제4 링크 하단 결합부는 상기 제3 링크 하단 결합부의 하부와 회전 가능하게 결합되고,
상기 제3 및 제4 링크 하단 결합부에는 상기 액츄에이터가 관통되도록 홀이 형성되고,
상기 결합부에서 상기 제3 링크 상단 결합부 및 제3 링크 하단 결합부 또는 제4 링크 상단 결합부 및 제4 링크 하단 결합부는 상기 결합부의 동일 중심축을 기준으로 회전가능하고,
상기 제1 모터 및 제2 모터의 회전에 따라 상기 제1 내지 제4 링크가 동일한 평면 방향에서 링크 운동하고,
상기 제1 내지 제3 모터는 동일 방향의 회전 중심축을 가지며,
상기 액츄에이터는 상기 평면 방향과 수직 방향으로 상기 엔드 이펙터를 이동시키는 것을 특징으로 하는,
구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
a module base on which the first motor and the second motor are mounted;
a first link connected to the central axis of rotation of the first motor and a second link connected to the central axis of rotation of the second motor;
a third link and a fourth link having one end connected to the first link and the second link, respectively, and the other end connected to each other; and
Including;;
The coupling part,
a third link upper coupling part and a third link lower coupling part respectively formed at the upper end and the lower end so that the other end of the third link is inserted and connected; and
and a fourth link upper coupling part and a fourth link lower coupling part respectively formed at the upper end and the lower end so that the other end of the fourth link is inserted and connected.
A third motor is mounted on the coupling part,
An actuator is connected to a lower portion of the third motor in the direction of the central axis of rotation of the third motor,
The actuator rotates by driving the third motor,
The end effector is mounted on one end of the actuator,
The third link upper coupling portion and the third link lower coupling portion are coupled to each other while accommodating the third motor,
A joint shaft is formed on the upper surface of the third link upper coupling part,
The fourth link upper coupling portion is rotatably coupled to the joint shaft,
The fourth link lower coupling portion is rotatably coupled to a lower portion of the third link lower coupling portion,
A hole is formed in the third and fourth link lower coupling portions to allow the actuator to pass therethrough,
In the coupling part, the third link upper coupling part and the third link lower coupling part or the fourth link upper coupling part and the fourth link lower coupling part are rotatable based on the same central axis of the coupling part,
The first to fourth links link motion in the same plane direction according to the rotation of the first motor and the second motor,
The first to third motors have a central axis of rotation in the same direction,
The actuator is characterized in that it moves the end effector in a direction perpendicular to the plane direction,
Modular robotic arm for structural wall repair or diagnostics.
제 1 항에 있어서,
상기 모듈 베이스에는, 상기 로봇팔의 전원을 공급하는 구동부 또는 움직임을 제어하는 제어부가 결합되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
A modular robot arm for repairing or diagnosing a structure wall, characterized in that a driving unit for supplying power to the robot arm or a control unit for controlling the movement is coupled to the module base.
제 1 항에 있어서,
상기 모듈 베이스에는 내부 공간을 갖는 케이스가 결합되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
A modular robot arm for repairing or diagnosing a structure wall, characterized in that a case having an internal space is coupled to the module base.
제 1 항에 있어서,
상기 제1 모터 또는 제2 모터에는 회전각을 측정하기 위한 엔코더가 장착되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
The first motor or the second motor is a modular robot arm for repair or diagnosis of a wall structure, characterized in that the encoder for measuring the rotation angle is mounted.
제 1 항에 있어서,
상기 제1 링크와 제3 링크 또는 제2 링크와 제4 링크는 링크 연결축에 의해 서로 회전 가능하게 연결되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
The first link and the third link or the second link and the fourth link is a modular robot arm for repairing or diagnosing a structure wall, characterized in that it is rotatably connected to each other by a link connecting shaft.
제 1 항에 있어서,
상기 제3 링크 및 제4 링크는 'L'자 형태로 형성되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
The third link and the fourth link is a modular robot arm for repair or diagnosis of a wall structure, characterized in that formed in an 'L' shape.
삭제delete 삭제delete 제 1 항에 있어서,
상기 제3 모터의 하부에는 상기 제3 모터의 상기 액츄에이터의 일단이 연결되는 연결부가 장착되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
A modular robot arm for repair or diagnosis of a structure wall, characterized in that a connection part to which one end of the actuator of the third motor is connected is mounted on a lower portion of the third motor.
제 9 항에 있어서,
상기 연결부에는 상기 액츄에이터의 일단이 삽입되도록 삽입홈이 형성되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
10. The method of claim 9,
A modular robot arm for repair or diagnosis of a wall structure, characterized in that an insertion groove is formed in the connection part so that one end of the actuator is inserted.
제 1 항에 있어서,
상기 엔드 이펙터는 상기 액츄에이터 끝단에 탈착 가능하게 연결된 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
The end effector is a modular robot arm for repair or diagnosis of a structure wall, characterized in that detachably connected to the end of the actuator.
제 1 항에 있어서,
보수 위치를 판별하도록 영상 수단이 더 포함되는 것을 특징으로 하는 구조물 벽면 보수 또는 진단용 모듈형 로봇팔.
The method of claim 1,
A modular robot arm for repairing or diagnosing a structure wall, characterized in that it further comprises an imaging means to determine the repair position.
KR1020210191672A 2021-12-01 2021-12-29 Module type robot arm for maintenance or diagnosis of surface of structure KR102429255B1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR20210170059 2021-12-01
KR1020210170059 2021-12-01

Publications (1)

Publication Number Publication Date
KR102429255B1 true KR102429255B1 (en) 2022-08-05

Family

ID=82826729

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020210191672A KR102429255B1 (en) 2021-12-01 2021-12-29 Module type robot arm for maintenance or diagnosis of surface of structure

Country Status (1)

Country Link
KR (1) KR102429255B1 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101243599B1 (en) 2011-12-19 2013-03-20 매그스위치 테크놀로지 코리아 (주) Wall panel attachment type work robot
KR101490773B1 (en) * 2013-12-16 2015-02-06 주식회사 포스코 Apparatus for inspecting elevated steel structure
KR20150123242A (en) * 2013-03-01 2015-11-03 코마츠 엔티씨 가부시끼가이샤 Two-dimensional movement closed-link structure
JP2016124081A (en) * 2015-01-06 2016-07-11 キヤノン電子株式会社 Parallel link robot

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101243599B1 (en) 2011-12-19 2013-03-20 매그스위치 테크놀로지 코리아 (주) Wall panel attachment type work robot
KR20150123242A (en) * 2013-03-01 2015-11-03 코마츠 엔티씨 가부시끼가이샤 Two-dimensional movement closed-link structure
KR101490773B1 (en) * 2013-12-16 2015-02-06 주식회사 포스코 Apparatus for inspecting elevated steel structure
JP2016124081A (en) * 2015-01-06 2016-07-11 キヤノン電子株式会社 Parallel link robot

Similar Documents

Publication Publication Date Title
Wen et al. A backdrivable kinematically redundant (6+ 3)-degree-of-freedom hybrid parallel robot for intuitive sensorless physical human–robot interaction
EP3530420B1 (en) Joint for a robot
Gallina et al. 3-dof wire driven planar haptic interface
US20070118249A1 (en) Robot and multiple robot control method
US20080249659A1 (en) Method and system for establishing no-entry zone for robot
US20070118250A1 (en) Robot and multi-robot interference avoidance method
CN104162892A (en) Hand-shaped manipulator
Gonzalez-Rodriguez et al. On the effects of the design of cable-Driven robots on kinematics and dynamics models accuracy
JP2020527472A (en) Omnidirectional traction module for robots
Patidar et al. Survey of robotic arm and parameters
TWI689389B (en) Multiaxial robot
CN109328124A (en) Execute the robot system of operation
US4585387A (en) Robot arm
JP6472854B1 (en) Work equipment
Chen et al. An integrated two-level self-calibration method for a cable-driven humanoid arm
CN108582031A (en) A kind of hot line robot branch based on force feedback master & slave control connects gage lap method
CN106002986B (en) A kind of specific robot palletizer for having double vertical slides
KR102429255B1 (en) Module type robot arm for maintenance or diagnosis of surface of structure
Chae et al. A tethered façade cleaning robot based on a dual rope windlass climbing mechanism: design and experiments
CN108565793A (en) A kind of hot line robot conducting wire mending method based on force feedback master & slave control
KR101021172B1 (en) Suspended-type parallel mechanism
JP6688204B2 (en) Link type articulated robot
JP2018187748A (en) Robot, robot control device, and robot system
CN105965485A (en) Non-orthogonal six-shaft teaching rod
US20230035296A1 (en) Method of suppressing vibrations of a robot arm with external objects

Legal Events

Date Code Title Description
E701 Decision to grant or registration of patent right
GRNT Written decision to grant