KR20160148227A - Robot arm having weight compensation mechanism - Google Patents
Robot arm having weight compensation mechanism Download PDFInfo
- Publication number
- KR20160148227A KR20160148227A KR1020150084936A KR20150084936A KR20160148227A KR 20160148227 A KR20160148227 A KR 20160148227A KR 1020150084936 A KR1020150084936 A KR 1020150084936A KR 20150084936 A KR20150084936 A KR 20150084936A KR 20160148227 A KR20160148227 A KR 20160148227A
- Authority
- KR
- South Korea
- Prior art keywords
- link
- pulley
- elastic member
- center
- auxiliary
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
- B25J18/002—Arms comprising beam bending compensation means
-
- 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
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
Description
개시된 발명은 중력보상구조를 구비하는 로봇암에 관한 것이다.The disclosed invention relates to a robot arm having a gravity compensation structure.
로봇은 산업 현장에서 작업을 보조하기 위해 사용될 수 있다. 로봇은 관절(joint)을 중심으로 피봇가능하게 구비되는 암(arm)을 하나 이상 포함할 수 있다. 암은 고중량의 작업물을 이송하거나 지지할 수 있어야 한다. 암은 자중이나 작업물의 중량에 의해 토크를 받게 되고, 토크의 크기가 커질수록 암을 동작시키는 데에 필요한 모터와 같은 구동원의 크기가 커질 수 있다. 구동원의 크기가 커지면 슬림화된 로봇을 구현하기가 어려워진다.Robots can be used to assist in work in industrial settings. The robot may include at least one arm that is pivotable about a joint. The arm should be able to carry or support heavy workpieces. The arm is subjected to torque by its own weight or the weight of the workpiece, and as the magnitude of the torque increases, the size of the drive source, such as the motor, required to operate the arm, can be increased. As the size of the driving source increases, it becomes difficult to realize a slimmed robot.
개시된 일 실시예에 따르면, 로봇암의 하중을 상쇄시킬 수 있는 중력보상구조를 구비하는 로봇암을 제공한다.According to the disclosed embodiment, there is provided a robot arm having a gravity compensation structure capable of canceling the load of the robot arm.
일 실시에에 따른 중력보상구조를 구비하는 로봇암은, 제1링크; 제1관절을 통해 상기 제1링크에 피봇가능하게 연결되는 제2링크; 상기 제1링크와 소정 간격 이격되어 배치되는 제1보조링크; 상기 제1보조링크에 구비되는 제1풀리; 상기 관절에 구비되는 제2풀리; 상기 제2링크에 장착되어 상기 제2링크와 함께 움직이는 제3풀리; 상기 제1풀리, 상기 제2풀리 및 상기 제3풀리를 연결하는 와이어; 일측이 상기 제1보조링크에 장착되고 타측이 상기 와이어에 연결되어, 상기 제2링크의 하중을 보상하도록 탄성력을 제공하는 탄성부재;를 포함한다.A robot arm having a gravity compensation structure according to one embodiment includes: a first link; A second link pivotally connected to the first link via a first joint; A first auxiliary link disposed at a predetermined distance from the first link; A first pulley provided on the first auxiliary link; A second pulley provided on the joint; A third pulley mounted on the second link and moving with the second link; A wire connecting the first pulley, the second pulley, and the third pulley; And an elastic member which is provided on one side of the first auxiliary link and on the other side of which is connected to the wire to provide an elastic force to compensate the load of the second link.
상기 와이어는 상기 제1풀리, 제2풀리, 제3풀리의 외측을 감싸도록 구비된다.The wire is provided to surround the outer sides of the first pulley, the second pulley, and the third pulley.
상기 와이어의 일측은 상기 제1풀리에 고정되고, 상기 제1풀리, 상기 제2풀리, 상기 제3풀리를 지나, 상기 와이어의 타단부는 상기 탄성부재와 연결된다.One side of the wire is fixed to the first pulley, and the other end of the wire passes through the first pulley, the second pulley, and the third pulley, and is connected to the elastic member.
상기 제1풀리의 지름, 상기 제2풀리의 지름, 상기 제3풀리의 지름은 동일한 크기를 갖는다.The diameter of the first pulley, the diameter of the second pulley, and the diameter of the third pulley have the same size.
상기 제3풀리의 중심은, 상기 제2링크의 중심을 지나고 상기 제2링크의 연장 방향을 따라 연장된 중심선으로부터 소정 간격 이격되어 위치된다.The center of the third pulley is positioned at a predetermined distance from a center line extending along the extending direction of the second link, passing through the center of the second link.
상기 제2링크가 상기 관절을 중심으로 피봇됨에 따라 상기 제1풀리의 중심과 상기 제3풀리의 중심 간의 거리는 가변된다.The distance between the center of the first pulley and the center of the third pulley is variable as the second link is pivoted about the joint.
상기 제2링크가 상기 관절을 중심으로 피봇되더라도 상기 제2풀리의 중심과 상기 제3풀리의 중심 간의 거리는 일정하게 유지된다.The distance between the center of the second pulley and the center of the third pulley is kept constant even if the second link is pivoted about the joint.
상기 제2링크가 상기 관절을 중심으로 시계 방향 또는 반시계 방향으로 회전하면 상기 제3풀리는 상기 제2풀리를 중심으로 시계 방향 또는 반시계 방향으로 회전한다.When the second link rotates clockwise or counterclockwise about the joint, the third pulley rotates clockwise or counterclockwise around the second pulley.
상기 제1보조링크에는 상기 탄성부재가 수용될 수 있는 수용부가 형성된다.The first auxiliary link is formed with a receiving portion in which the elastic member can be received.
상기 제1보조링크와 상기 관절을 연결하는 제2보조링크를 더 포함한다.And a second auxiliary link connecting the first auxiliary link and the joint.
상기 제1보조링크와 상기 제1링크는 평행하게 배치된다.The first auxiliary link and the first link are arranged in parallel.
상기 탄성부재는 복수의 탄성부재들이 중첩되어 구비된다.The elastic member is provided so as to overlap a plurality of elastic members.
상기 복수의 탄성부재들은, 단부에 장착되는 캡에 의해 고정된다.The plurality of elastic members are fixed by a cap mounted on the end portion.
상기 캡의 내측면에는 나사산이 형성되고, 상기 나사산에 의해 상기 복수의 탄성부재들이 고정된다.A thread is formed on the inner surface of the cap, and the plurality of elastic members are fixed by the thread.
상기 캡에는 상기 탄성부재들이 삽입될 수 있는 수용부가 형성되고, 상기 수용부의 개수는 상기 복수의 탄성부재의 개수에 대응되어 구비된다.The cap has a receiving portion into which the elastic members can be inserted, and the number of the receiving portions is provided corresponding to the number of the plurality of elastic members.
상기 수용부를 형성하는 상기 캡의 내측면에는, 상기 탄성부재를 고정시킬 수 있는 나사산이 형성된다.On the inner surface of the cap forming the accommodating portion, a screw thread capable of fixing the elastic member is formed.
상기 캡에는 상기 탄성부재의 장력을 조절하기 위한 조정장치가 구비된다.The cap is provided with an adjusting device for adjusting the tension of the elastic member.
상기 조정장치는 외주면에 나사산이 형성되고 상기 캡을 관통한다.The adjustment device is threaded on the outer circumferential surface and penetrates the cap.
상기 샤프트를 회전시켜 상기 탄성부재의 장력을 조절할 수 있다.The tension of the elastic member can be adjusted by rotating the shaft.
일 실시예에 따른 중력보상구조를 구비하는 로봇암은, 탄성부재의 탄성력에 의해 링크의 하중을 보상하는 중력보상구조를 구비하는 로봇암으로서, 상기 로봇암은, 평행하게 배치되는 제1링크 및 제1보조링크; 상기 제1링크에 피봇가능하게 연결되는 제2링크; 상기 제1보조링크에 구비되는 제1풀리; 상기 제1풀리와 동일한 직경을 갖도록 구비되고, 상기 제1링크와 상기 제2링크가 연결되는 관절에 장착되는 제2풀리; 상기 제1풀리와 동일한 직경을 갖도록 구비되고, 상기 제2링크와 함께 움직이도록 상기 제2링크에 장착되는 제3풀리; 상기 제1풀리, 상기 제2풀리, 상기 제3풀리를 감싸는 와이어; 상기 제1보조링크의 연장방향을 따라 배치되고, 일측은 상기 제1보조링크에 고정되고, 타측은 상기 와이어에 연결되는 탄성부재;를 포함한다.A robot arm having a gravity compensation structure according to an embodiment is a robot arm having a gravity compensation structure for compensating a load of a link by an elastic force of an elastic member, the robot arm comprising: a first link arranged in parallel; A first auxiliary link; A second link pivotally connected to the first link; A first pulley provided on the first auxiliary link; A second pulley having a diameter equal to that of the first pulley, the second pulley being mounted on a joint to which the first link and the second link are connected; A third pulley having a same diameter as the first pulley and mounted to the second link to move with the second link; A wire surrounding the first pulley, the second pulley, and the third pulley; And an elastic member disposed along the extending direction of the first auxiliary link, one side fixed to the first auxiliary link, and the other side connected to the wire.
개시된 일 실시예에 의하면, 중력보상구조에 의해 로봇암에 포함되는 링크의 하중이 상쇄되어 구동원의 크기를 줄일 수 있고 슬림화된 로봇을 구현할 수 있다.According to the disclosed embodiment, the load of the link included in the robot arm is canceled by the gravity compensation structure, so that the size of the driving source can be reduced, and a slim robot can be realized.
도 1은 일 실시예에 따른 중력보상구조의 원리를 설명하기 위한 도면이다.
도 2는 일 실시예에 따른 로봇암을 도시한 도면이다.
도 3은 일 실시예에 따른 로봇암의 중력보상구조를 도시한 개략도이다.
도 4는 일 실시예에 따른 로봇암이 제1위치에 있을 때의 모습을 도시한 도면이다.
도 5는 일 실시예에 따른 로봇암이 제2위치에 있을 때의 모습을 도시한 도면이다.
도 6은 일 실시예에 따른 로봇암의 중력보상구조를 설명하기 위한 도면이다.
도 7a 내지 도 7c는 일 실시예에 따른 로봇암의 가동각을 설명하기 위한 도면이다.
도 8 내지 도 11은 일 실시예에 따른 탄성부재를 도시한 도면이다.1 is a view for explaining the principle of a gravity compensation structure according to an embodiment.
2 is a view showing a robot arm according to an embodiment.
3 is a schematic view showing a gravity compensation structure of a robot arm according to an embodiment.
4 is a view showing a state in which the robot arm according to one embodiment is in the first position.
5 is a view showing a state in which the robot arm according to the embodiment is in the second position.
6 is a view for explaining a gravity compensation structure of a robot arm according to an embodiment.
7A to 7C are views for explaining the operating angle of the robot arm according to one embodiment.
8 to 11 are views showing an elastic member according to an embodiment.
이하, 개시된 발명의 일 실시예에 따른 중력보상구조를 구비하는 로봇암에 관하여 도면을 참조하여 상세히 설명한다.Hereinafter, a robot arm having a gravity compensation structure according to an embodiment of the present invention will be described in detail with reference to the drawings.
도 1은 일 실시예에 따른 중력보상구조의 원리를 설명하기 위한 도면이다.1 is a view for explaining the principle of a gravity compensation structure according to an embodiment.
도 1을 참조하면, 탄성부재(100)의 일단부는 기준면(g)의 a 에 고정되고, 링크(200)는 기준면(g)의 b에 고정될 수 있다. 탄성부재(100)의 타단부는 링크(200)의 고정부 c에 고정될 수 있다. 적절한 탄성계수(k)를 갖는 탄성부재(100)의 탄성력(f)에 의해 링크(200)의 하중(mg)이 상쇄되어 링크(200)가 고정된 b에서 링크(200)의 하중(mg)에 의한 토크가 0이 될 수 있다.Referring to Fig. 1, one end of the
이하에서는 탄성부재(100)가 고정된 a와 링크(200)가 고정된 b 간의 거리를 h2라 하고, b로부터 링크(200)에서 탄성부재(100)가 결합된 고정부 c까지의 거리를 h1이라 할 수 있다. b로부터 링크(200)의 하중(mg)까지의 거리는 L이라 할 수 있다. 탄성부재(100)와 a,b가 위치하는 기준면(g) 사이의 각도는 θ라 할 수 있다.Hereinafter, a distance between a fixed member a and
고정부 c에서, 탄성부재(100)의 탄성력(f)는 링크(200)의 길이 방향에 따른 f1과 링크(200)의 하중(mg)과 평행하고 방향이 반대인 f2 로 분해될 수 있다. f1 성분은 링크(200)의 길이 방향으로 작용되는 힘으로서 b 지점에서 토크를 발생시키지 않는다. 그러나 f2 성분의 경우 f2h1cosθ의 크기만큼 b에서 토크를 발생시킨다. In the fixing portion c, the elastic force f of the
링크(200)의 하중(mg)에 의한 토크의 크기는 mgLcosθ이다. 탄성부재(100)의 f2 성분과 의한 토크와 링크(200)의 하중(mg)에 의한 토크의 크기가 동일한 경우, 즉, mgLcosθ=f2h1cosθ(식 1)를 만족하는 경우에 탄성부재(100)에 의해 링크(200)의 하중(mg)이 상쇄될 수 있다. 한편, 도 1의 a,b,c가 형성하는 삼각형에서 f2=fh2/x (식 2)가 유도될 수 있다. 탄성부재(100)의 탄성계수를 k라 하면, 탄성부재(100)의 탄성력 f=kx (식 3)를 만족할 수 있다. The magnitude of the torque due to the load (mg) of the
식 2, 식 3을 식 1에 대입하여 정리하면, k=mgL/(h1h2) 가 유도될 수 있다.By substituting Equation 2 and Equation 3 into
이와 같이, 탄성부재(100)의 탄성계수 k가 k=mgL/(h1h2) 를 만족하도록 설정되면, 링크(200)에 대해 중력보상이 가능하다.Thus, when the elastic modulus k of the
이하에서는, 적절한 탄성계수를 갖는 탄성부재를 이용하여 로봇암의 하중을 상쇄시킬 수 있는 중력보상구조에 관하여 설명한다.Hereinafter, a gravity compensation structure capable of canceling the load of the robot arm using an elastic member having a suitable elastic modulus will be described.
도 2는 일 실시예에 따른 로봇암을 도시한 도면이다.2 is a view showing a robot arm according to an embodiment.
도 2를 참조하면, 일 실시예에 따른 로봇암(1)은 복수의 링크가 피봇가능하게 연결되어 구비될 수 있다. 로봇암(1)은, 베이스(10), 베이스(10)에 피봇가능하게 연결된 제1링크(20)를 포함할 수 있다. 제1링크(20)의 일단부는 제1관절(11)을 통해 베이스(10)와 연결될 수 있다. 제1링크(20)는 구동원(미도시)에 의해 제1관절(11)을 중심으로 피봇될 수 있다.Referring to FIG. 2, the
제1링크(20)의 타단부에는 제2링크(30)가 피봇가능하게 연결될 수 있다. 제1링크(20)의 타단부와 제2링크(30)의 일단부는 제2관절(12)을 통해 연결될 수 있다. 제2링크(30)의 타단부에는 직접 하중이 가해질 수 있다. 제2링크(30)는 구동원에 의해 제2관절(12)을 중심으로 피봇될 수 있다.The
로봇암(1)에는 제2링크(30)의 하중을 상쇄시킬 수 있는 중력보상구조가 구비될 수 있다. 로봇암(1)에 구비되는 중력보상구조에 의해, 제2링크(30)의 하중에 의한 제2관절(12)에서의 토크가 상쇄될 수 있다. 제2링크(30)의 하중에 의한 토크가 상소됨으로써 제2링크(30)를 구동시키기 위한 구동원의 사양을 최소화시킬 수 있다.The
제2링크(30)에 대한 중력보상구조는, 제1링크(20)에 평행하게 위치되는 제1보조링크(21), 제1보조링크(21)에 고정되는 탄성부재(56), 제1보조링크(21)와 제2보조링크(22)를 연결하는 제1보조관절(220)에 장착되는 제1풀리(43), 제2관절(12)에 장착되는 제2풀리(44) 및 제2링크(30)에 장착되는 제3풀리(45)를 포함한다.The gravity compensation structure for the
제1보조링크(21)는 제1링크(20)와 평행하게 위치되고, 제1링크(20)가 제1관절(11)을 중심으로 피봇될 때에도 항상 제1링크(20)와 평행한 상태를 유지할 수 있다. The first
제1보조링크(21)는 제2보조링크(22)에 의해 제1링크(20)의 타단부 측에 연결될 수 있다. 제1보조링크(21)와 제1링크(20)는 소정 간격 이격되어 항상 평행한 상태를 유지할 수 있다. 제2보조링크(22)는 베이스(10)가 위치되는 기준면(G)과 평행하게 위치될 수 있다. 제1보조링크(21)의 타단부와 제2보조링크(22)는 제1회전축(220)을 중심으로 피봇가능하게 마련될 수 있다. 제2보조링크(22)와 제1링크(20)의 타단부 측은 제2관절(12)를 중심으로 피봇가능하게 마련될 수 있다.The first
한편, 제1보조링크(21)는 제3보조링크(23)에 의해 제1관절(11)과 연결될 수 있다. 제3보조링크(23)는 제1관절(11)을 중심으로 피봇가능하게 구비될 수 있다.Meanwhile, the first
제1풀리(43)는 제1보조링크(21)와 제2보조링크(22)가 피봇가능하게 연결되는 제1보조관절(220)에 장착될 수 있다. 제1풀리(43)는, 제1보조링크(21)와 제2보조링크(22)가 장착되는 회전축에 장착될 수 있다.The
제2풀리(44)는 제2관절(12)에 장착될 수 있다. 제3풀리(45)는 제2링크(30)에 장착되어 제2링크(30)와 함께 움직일 수 있다. 제3풀리(45)는 제2링크(30)의 중심선으로부터 소정 간격(h1) 이격되어 위치될 수 있다.And the
제1풀리(43), 제2풀리(44) 및 제3풀리(45)는 동일한 지름(r)을 갖도록 구비될 수 있다.The
제1풀리(43), 제2풀리(44) 및 제3풀리(45)는 와이어(w)에 의해 감싸질 수 있다. 와이어(w)의 일단은 제1풀리(43), 제2풀리(44) 및 제3풀리(45)를 감싼 후 제1풀리(43)의 d 지점에 고정될 수 있다. 와이어(w)의 타단은 탄성부재(56)와 연결될 수 있다. The
탄성부재(56)의 일측단은 제1보조링크(21)에 고정될 수 있다. 탄성부재(56)의 타측단은 와이어(w)와 연결될 수 있다. One end of the
이러한 복수의 풀리(43,44,45), 탄성부재(56) 및 와이어(w)를 포함하는 중력보상구조에 의해 제2링크(30)의 하중은 상쇄될 수 있다. 제2링크(30)의 중력보상구조가 로봇암(1)을 구성하는 링크 및 관절에 위치되므로 중력보상구조에 의해 로봇암(1)의 부피가 불필요하게 커지는 것을 방지할 수 있다.The load of the
일 실시예에 따른 중력보상구조는, 복수의 풀리의 지름과 무관하게 적절한 탄성계수를 갖는 탄성부재(56)를 통해 제2링크(30)의 하중을 상쇄시킬 수 잇다. 이하에서는 일 실시예에 따른 중력보상구조에서 제2링크(30)의 하중을 상쇄시키기 위한 탄성부재(56)의 탄성계수의 설정에 관하여 설명한다.The gravity compensation structure according to the embodiment can cancel the load of the
도 3은 일 실시예에 따른 로봇암의 중력보상구조를 도시한 개략도이다.3 is a schematic view showing a gravity compensation structure of a robot arm according to an embodiment.
도 3을 참조하면, 일 실시예에 따른 중력보상구조를 설명하기 위해 로봇암(1)의 구조가 단순화되어 도시되고 있다. 도면부호 20a는 제1링크(20)의 연장방향을 따라 제1링크(20)의 중심을 지나는 직선을 의미한다. 도면부호 30a는 제2링크(30)의 연장 방향을 따라 제2링크(30)의 중심을 지나는 직선을 의미한다. 도면부호 21a는 제1보조링크(21)의 연장방향을 따라 제1보조링크(21)의 중심을 지나는 직선을 의미한다. 도면부호 22a는 제2보조링크(22)의 연장방향을 따라 제2보조링크(22)의 중심을 지나는 직선을 의미한다. Referring to FIG. 3, the structure of the
제1보조링크의 중심선(21a)과 제1링크의 중심선(20a) 간의 거리는 h2라 한다. 제2풀리(44)의 중심(44a)과 제3풀리(45)의 중심(45a) 간의 거리는 h1이라 할 수 있다. 제2링크(30)가 제2관절(12)을 중심으로 피봇됨에 따라 제1풀리(43)의 중심(43a)과 제2풀리(44)의 중심(44a) 간의 거리는 가변될 수 있다.The distance between the
와이어(w)는 일단부가 제1풀리(43)의 c 지점에 고정되고, 제1풀리(43), 제2풀리(44) 및 제3풀리(45)를 감쌀 수 있다. 와이어(w)의 타단부는 탄성부재(56)와 연결될 수 있다. 탄성부재(56)와 제1풀리(43)가 만나는 지점을 e라 할 수 있다. The wire w is fixed at the point c of the
제2풀리(44)의 중심(44a)과 제3풀리(45)의 중심(45a)를 연결한 직선과 제2링크의 중심선(30a)은 직각을 이룰 수 있다.The straight line connecting the
도 4는 일 실시예에 따른 로봇암이 제1위치에 있을 때의 모습을 도시한 도면이고, 도 5는 일 실시예에 따른 로봇암이 제2위치에 있을 때의 모습을 도시한 도면이다.FIG. 4 is a view showing a state in which the robot arm according to the embodiment is in the first position, and FIG. 5 is a view showing a state in which the robot arm according to the embodiment is in the second position.
도 4 및 도 5를 참조하면, 일 실시예에 따른 로봇암(1)은 제1풀리(43)의 중심(43a), 제2풀리(44)의 중심(44a) 및 제3풀리(45)의 중심(45a)이 일직선 상에 위치하고, 제2링크의 중심선(30a)이 제1풀리(43)의 중심(43a), 제2풀리(44)의 중심(44a) 및 제3풀리(45)의 중심(45a)을 연결한 직선과 수직할 때 제1위치에 있다고 할 수 있다. 4 and 5, the
도 4에 도시된 바와 같이, 제1위치에서, 제1풀리(43)의 중심(43a)과 제2풀리(44)의 중심(44a) 사이의 거리는 x(0)이라 할 수 있다. 여기서 와이어(w)가 제1풀리(43)에 고정된 c 지점과 탄성부재(56)가 제1풀리(43)와 만나는 지점 d 간의 거리(WL)는 다음과 같다.4, at the first position, the distance between the
(식 1) (Equation 1)
도 5에 도시된 바와 같이, 제1위치에서 제2링크(30)가 제2관절(12)을 중심으로 소정 각도(θ)회전한 상태를 로봇암(1)이 제2위치에 있다고 한다면, 제2위치에서 제1풀리(43)의 중심(43a)과 제2풀리(44)의 중심(44a) 간의 거리는 x(θ)라 할 수 있다. 제2링크(30)가 제2관절(12)을 중심으로 회전함에 따라 제3풀리(45)는 제2풀리(44)를 중심으로 시계 방향으로 회전하고, 제1풀리(43)의 중심(43a), 제2풀리(44)의 중심(44a) 및 제3풀리(45)의 중심(45a)은 각각 삼각형 형태의 꼭지점에 위치될 수 있다.5, if the
여기서 와이어(w)가 제1풀리(43)에 고정된 c 지점과 탄성부재(56)가 제1풀리(43)와 만나는 지점 d 간의 거리(WL)는 다음과 같다.The distance WL between the point c at which the wire w is fixed to the
(식 2) (Equation 2)
식 1과 식 2를 비교하면, c,d 간의 와이어의 길이는 h1+h2+πr이라는 상수항을 제외하면 제1풀리(43)와 제2풀리(44) 사이의 거리인 x(θ)의 함수로 표현됨을 알 수 있다. 이를 통해, 와이어(w)의 길이는 풀리(43,44,45)의 지름과는 무관하다는 것을 알 수 있다. Comparing
도 6은 일 실시예에 따른 로봇암의 중력보상구조를 설명하기 위한 도면이다.6 is a view for explaining a gravity compensation structure of a robot arm according to an embodiment.
일 실시예에 따른 로봇암(1)의 중력보상구조는, 도 6과 같이 도식화될 수 있다. 제1풀리(43)의 중심(43a)과 제2풀리(44)의 중심(44a) 간의 거리는 h2, 제2풀리(44)의 중심(44a)과 제3풀리(45)의 중심(45a) 간의 거리는 h1, 제1풀리(43)의 중심(43a)과 제3풀리(45)의 중심(45a) 간의 거리는 x이다.The gravity compensation structure of the
제2링크(30)에 의한 하중(mg)은 제2풀리(44)의 중심(44a)으로부터 소정 거리(L) 이격된 부분에 가해지는 것으로 볼 수 있다.It can be seen that the load (mg) by the
도 6에 도시된 중력보상구조는 도 1에 도시된 구조와 실질적으로 동일한 구조라고 볼 수 있다. 상세히, 제1풀리의 중심(43a)과 제2풀리의 중심(44a) 간의 거리 h2는 도 1의 h2에 대응되고, 제2풀리의 중심(44a)과 제3풀리의 중심(45a) 간의 거리 h1은 도 1의 h1에 대응되며, 제1풀리의 중심(43a)과 제3풀리의 중심(45a) 간의 거리 x는 도 1의 x에 대응되는 것으로 볼 수 있다. The gravity compensation structure shown in Fig. 6 can be regarded as substantially the same structure as that shown in Fig. Specifically, the distance h2 between the
또한 제2풀리의 중심(44a)을 기준으로, 도 6에서 제2링크(30)의 하중(mg)에 의한 토크는 도1에서의 링크(200)의 하중(mg)에 의한 토크와 실질적으로 동일한 것으로 볼 수 있다.6, the torque due to the load (mg) of the
따라서 도 1의 구조에서 설명한 바와 같이, 도 6의 중력보상구조에서 탄성부재(56)의 탄성계수(k)가, 도 1에서와 같이, k=mgL/(h1h2)를 만족하도록 설정된 경우, 제1링크(20)의 하중이 상쇄될 수 있다.Therefore, as described in the structure of Fig. 1, when the elastic modulus k of the
이와 같이, 일 실시예에 따른 탄성부재(56)의 탄성계수 k가 k=mgL/(h1h2)를 만족하도록 구비되면 제2링크(30)의 하중은 상쇄될 수 있다. 제1링크(20)의 하중이 상쇄됨에 따라 제2링크(30)를 구동하는 구동원은 제2링크(30)를 구동시키기 위한 구동력을 고려하지 않아도 되므로 중력보상구조가 구비되지 않은 경우에 비해 더 적은 용량으로 구비될 수 있다. Thus, if the elastic modulus k of the
종래의 경우, 중력보상구조는 로봇암의 외측에 별도의 부피를 차지하도록 구비되었다. 따라서 중력보상구조가 구비되는 경우 부피가 커지는 단점이 있었다. 또한 중력보상구조가 로봇암의 외측에 구비되는 경우, 도 1에 도시된 중력보상구조가 그대로 적용되기 힘들다는 단점이 있었다.In the conventional case, the gravity compensation structure is provided so as to occupy a separate volume outside the robot arm. Therefore, when the gravity compensating structure is provided, there is a disadvantage that the volume becomes large. Also, when the gravity compensation structure is provided outside the robot arm, the gravity compensation structure shown in FIG. 1 is not applied as it is.
일 실시예에 따른 중력보상구조에 포함된 탄성부재(56) 및 풀리들(41,42,43) 등은 로봇암(1)의 구성요소들의 내부, 즉, 제2링크(30), 제1보조링크(21) 및 로봇암(1) 내의 관절부에 배치될 수 있다. 따라서 도 1에 도시된 중력보상구조가 그대로 적용될 수 있어, 도 1에서 설명한 바와 같이 적절한 탄성계수를 갖는 탄성부재(56)에 의해 제1링크(20)의 하중이 상쇄될 수 있다. 또한, 일 실시예에 따른 중력보상구조에 포함된 풀리(43,44,45), 탄성부재(56) 등은 로봇암의 외부에 위치되지 않으므로 로봇의 부피가 커지지 않을 수 있다.The
일 실시예에 따른 중력보상구조는 와이어(w)의 길이가 풀리(43,44,45)의 지름과 무관하고 제1풀리(43)의 중심과 제2풀리(44)의 중심 사이의 거리에 대한 함수로 표현되므로, 풀리(43,44)의 지름이 커지더라도 적절한 탄성계수를 갖는 탄성부재에 의해 제2링크(30)의 하중이 상쇄될 수 있다. 따라서 안정적으로 제2링크(30)를 지지하기 위해 지름이 큰 풀리들(43,44,45)을 이용하여 중력보상구조를 구현할 수 있다.The gravity compensation structure according to one embodiment is such that the length of the wire w is independent of the diameter of the
도 7a 내지 도 7c는 일 실시예에 따른 로봇암의 가동각을 설명하기 위한 도면이다.7A to 7C are views for explaining the operating angle of the robot arm according to one embodiment.
도 7a 내지 도 7c에 의하면, 일 실시예에 따른 제2링크(30)는 넓은 가동각을 확보할 수 있다. 제1링크(20), 제1보조링크(21), 제2보조링크(22) 및 제2링크(30)의 구조를 적절히 설계하면 제2링크(30)는 대략 360˚에 이르는 가동각을 가질 수도 있다.7A to 7C, the
도 8 내지 도 11은 일 실시예에 따른 탄성부재를 도시한 도면이다.8 to 11 are views showing an elastic member according to an embodiment.
도 8 내지 도 11을 참조하면, 일 실시예에 따른 중력보상구조에 구비되는 탄성부재(56)는 제1보조링크(21)의 내부에 마련된 수용공간에 수용될 수 있다. 이와 같이 탄성부재(56)가 제1보조링크(21)에 마련된 수용공간에 수용됨으로써 중력보상구조가 구비되더라도 로봇암(1)의 부피가 불필요하게 커지는 것을 방지할 수 있다.8 to 11, the
탄성부재(56)는 복수의 탄성부재들이 중첩되어 구비될 수 있다. 하중이 큰 제2링크(30)을 지지할 수 있도록 큰 탄성계수를 갖는 탄성부재(56)를 구현하는 데에는 비용이 많이 들거나 구현하기가 용이하지 않을 수 있다. 따라서 큰 탄성계수를 갖는 탄성부재(56)는 작은 탄성계수를 갖는 탄성부재를 복수 개 중첩되도록 위치시켜 구현할 수 있다.The
일례로, 탄성부재(56)는, 제1탄성부재(561), 제1탄성부재(561)의 내부에 수용되는 제2탄성부재(562), 제2탄성부재(562)의 내부에 수용되는 제3탄성부재(563)를 포함할 수 있다. For example, the
탄성부재(56)의 양쪽 끝단에는 탄성부재(56)를 고정시킬 수 있는 캡(57)이 구비될 수 있다. 캡(57)의 내부에는 제1탄성부재(561)의 일부가 삽입되어 고정되는 제1수용부(571), 제2탄성부재(562)의 일부가 삽입되어 고정되는 제2수용부(572), 제3탄성부재(563)의 일부가 삽입되어 고정되는 제3수용부(573)가 구비될 수 있다.At both ends of the
캡(57)은 제1탄성부재(561)의 외측 일부를 커버하는 제1캡(576), 제1캡(576)의 내부에 수용되어 제1캡(576)의 내측면과 함께 제1수용부(571)를 형성하는 제2캡(577), 제2캡(577)의 내부에 수용되어 제2캡(577)의 내측면과 함께 제2수용부(572)를 형성하는 제3캡(578), 제3캡(578)의 내부에 수용되어 제3캡(578)의 내측면과 함께 제3수용부(573)을 형성하는 제4캡(579)를 포함할 수 있다.The
제1탄성부재(561), 제2탄성부재(562) 및 제3탄성부재(563)는 회전하면서 각각 제1수용부(571), 제2수용부(572) 및 제3수용부(573)에 삽입될 수 있다. 제1탄성부재(561), 제2탄성부재(562) 및 제3탄성부재(563)는 회전하면서 각각 제1수용부(571), 제2수용부(572) 및 제3수용부(573)에 삽입될 수 있다. The first
제1탄성부재(561), 제2탄성부재(562) 및 제3탄성부재(563)가 회전하면서 각각 제1수용부(571), 제2수용부(572) 및 제3수용부(573)에 삽입될 수 있도록, 각각의 수용부(571,522,523)를 형성하는 캡(57)의 내측면에는 나사산이 형성될 수 있다. 상세히, 제2캡(577), 제3캡(578), 제4캡(579)의 외측면에는 오목한 나사산(571a, 572a, 573a)이 형성되어 제1탄성부재(561), 제2탄성부재(562) 및 제3탄성부재(563)가 장착될 수 있다.The first
캡(57)에 복수의 탄성부재(56)가 장착된 후, 체결부재(53)에 의해 캡(57) 전체가 체결될 수 있다. 이로써 복수의 탄성부재(56)가 고정될 수 있다.After the plurality of
필요한 탄성계수를 갖는 탄성부재를 구현하기 위해 탄성부재의 개수는 이에 한정되지 않는다. 또한 복수의 탄성부재들을 고정하는 캡(57)의 형태는 상기 기재된 바에 한정되지 않는다. 제1탄성부재(561), 제2탄성부재(562), 제3탄성부재(563)를 고정시키는 캡(57)은 일체로 형성될 수도 있다.The number of the elastic members to implement the elastic member having the necessary elastic modulus is not limited thereto. The shape of the
캡(57)에는 탄성부재(56)의 초기 장력을 조절하기 위한 조정장치(54)가 구비될 수 있다. 조정장치(54)는 캡(57)의 중심을 관통하는 샤프트의 형태로 구비될 수 있다. 캡(57)의 중심에는 중심홀(570)에 형성되고, 중심홀(570)을 형성하는 내측면에는 나사산(미도시)이 형성될 수 있다. 조정장치(54)의 외측면에는 중심홀(570)의 내측면에 형성된 나사산에 대응되는 나사산이 형성될 수 있다. 조정장치(54)는 중심홀(520)에 삽입되어 회전함으로써 탄성부재(56)의 장력을 조절할 수 있다.The
1: 로봇암
10: 베이스
11: 제1관절
12: 제2관절
20: 제1링크
21: 제1보조링크
22: 제2보조링크
23: 제3보조링크
30: 제2링크
43: 제1풀리
44: 제2풀리
45: 제3풀리
56: 탄성부재
w: 와이어1: Robot arm 10: Base
11: first joint 12: second joint
20: first link 21: first auxiliary link
22: second auxiliary link 23: third auxiliary link
30: second link 43: first pulley
44: second pulley 45: third pulley
56: elastic member w: wire
Claims (20)
제1관절을 통해 상기 제1링크에 피봇가능하게 연결되는 제2링크;
상기 제1링크와 소정 간격 이격되어 배치되는 제1보조링크;
상기 제1보조링크에 구비되는 제1풀리;
상기 관절에 구비되는 제2풀리;
상기 제2링크에 장착되어 상기 제2링크와 함께 움직이는 제3풀리;
상기 제1풀리, 상기 제2풀리 및 상기 제3풀리를 연결하는 와이어;
일측이 상기 제1보조링크에 장착되고 타측이 상기 와이어에 연결되어, 상기 제2링크의 하중을 보상하도록 탄성력을 제공하는 탄성부재;를 포함하는 중력보상구조를 구비하는 로봇암.A first link;
A second link pivotally connected to the first link via a first joint;
A first auxiliary link disposed at a predetermined distance from the first link;
A first pulley provided on the first auxiliary link;
A second pulley provided on the joint;
A third pulley mounted on the second link and moving with the second link;
A wire connecting the first pulley, the second pulley, and the third pulley;
And a resilient member for elastically supporting the first link and the second link to elastically force the first link and the second link, respectively, so as to compensate the load of the second link.
상기 와이어는 상기 제1풀리, 제2풀리, 제3풀리의 외측을 감싸도록 구비되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the wire has a gravity compensating structure provided so as to surround an outer side of the first pulley, the second pulley, and the third pulley.
상기 와이어의 일측은 상기 제1풀리에 고정되고, 상기 제1풀리, 상기 제2풀리, 상기 제3풀리를 지나, 상기 와이어의 타단부는 상기 탄성부재와 연결되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein one end of the wire is fixed to the first pulley and the other end of the wire passes through the first pulley, the second pulley, and the third pulley, and the other end of the wire is connected to the elastic member. .
상기 제1풀리의 지름, 상기 제2풀리의 지름, 상기 제3풀리의 지름은 동일한 크기를 갖는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the diameter of the first pulley, the diameter of the second pulley, and the diameter of the third pulley have the same size.
상기 제3풀리의 중심은, 상기 제2링크의 중심을 지나고 상기 제2링크의 연장 방향을 따라 연장된 중심선으로부터 소정 간격 이격되어 위치되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the center of the third pulley has a gravity compensation structure that is located at a predetermined distance from a center line extending from the center of the second link and extending along the extending direction of the second link.
상기 제2링크가 상기 관절을 중심으로 피봇됨에 따라 상기 제1풀리의 중심과 상기 제3풀리의 중심 간의 거리는 가변되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein a distance between a center of the first pulley and a center of the third pulley is variable as the second link is pivoted about the joint.
상기 제2링크가 상기 관절을 중심으로 피봇되더라도 상기 제2풀리의 중심과 상기 제3풀리의 중심 간의 거리는 일정하게 유지되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein a distance between a center of the second pulley and a center of the third pulley is kept constant even if the second link is pivoted about the joint.
상기 제2링크가 상기 관절을 중심으로 시계 방향 또는 반시계 방향으로 회전하면 상기 제3풀리는 상기 제2풀리를 중심으로 시계 방향 또는 반시계 방향으로 회전하는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the third pulley rotates clockwise or counterclockwise about the second pulley when the second link rotates clockwise or counterclockwise about the joint.
상기 제1보조링크에는 상기 탄성부재가 수용될 수 있는 수용부가 형성되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the first auxiliary link is provided with a receiving portion capable of receiving the elastic member.
상기 제1보조링크와 상기 관절을 연결하는 제2보조링크를 더 포함하는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
And a gravity compensation structure further comprising a second auxiliary link connecting the first auxiliary link and the joint.
상기 제1보조링크와 상기 제1링크는 평행하게 배치되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the first auxiliary link and the first link are arranged in parallel.
상기 탄성부재는 복수의 탄성부재들이 중첩되어 구비되는 중력보상구조를 구비하는 로봇암.The method according to claim 1,
Wherein the elastic member has a gravity compensation structure in which a plurality of elastic members are overlapped.
상기 복수의 탄성부재들은, 단부에 장착되는 캡에 의해 고정되는 중력보상구조를 구비하는 로봇암.13. The method of claim 12,
Wherein the plurality of elastic members have a gravity compensation structure fixed by a cap mounted on an end portion thereof.
상기 캡의 내측면에는 나사산이 형성되고, 상기 나사산에 의해 상기 복수의 탄성부재들이 고정되는 중력보상구조를 구비하는 로봇암.14. The method of claim 13,
And a gravity compensation structure in which a plurality of elastic members are fixed by the threads.
상기 캡에는 상기 탄성부재들이 삽입될 수 있는 수용부가 형성되고, 상기 수용부의 개수는 상기 복수의 탄성부재의 개수에 대응되어 구비되는 중력보상구조를 구비하는 로봇암.14. The method of claim 13,
Wherein the cap has a receiving portion into which the elastic members can be inserted, and the number of the receiving portions is provided corresponding to the number of the plurality of elastic members.
상기 수용부를 형성하는 상기 캡의 내측면에는, 상기 탄성부재를 고정시킬 수 있는 나사산이 형성되는 중력보상구조를 구비하는 로봇암.16. The method of claim 15,
Wherein a gravity compensating structure is provided on an inner surface of the cap forming the accommodating portion to form a screw thread capable of fixing the elastic member.
상기 캡에는 상기 탄성부재의 장력을 조절하기 위한 조정장치가 구비되는 중력보상구조를 구비하는 로봇암.14. The method of claim 13,
Wherein the cap has a gravity compensation structure having an adjusting device for adjusting a tension of the elastic member.
상기 조정장치는 외주면에 나사산이 형성되고 상기 캡을 관통하는 중력보상구조를 구비하는 로봇암.18. The method of claim 17,
Wherein the adjusting device has a gravity compensating structure in which a thread is formed on an outer peripheral surface and penetrates the cap.
상기 샤프트를 회전시켜 상기 탄성부재의 장력을 조절할 수 있는 중력보상구조를 구비하는 로봇암.19. The method of claim 18,
And a gravity compensating structure capable of rotating the shaft to adjust the tension of the elastic member.
상기 로봇암은, 평행하게 배치되는 제1링크 및 제1보조링크;
상기 제1링크에 피봇가능하게 연결되는 제2링크;
상기 제1보조링크에 구비되는 제1풀리;
상기 제1풀리와 동일한 직경을 갖도록 구비되고, 상기 제1링크와 상기 제2링크가 연결되는 관절에 장착되는 제2풀리;
상기 제1풀리와 동일한 직경을 갖도록 구비되고, 상기 제2링크와 함께 움직이도록 상기 제2링크에 장착되는 제3풀리;
상기 제1풀리, 상기 제2풀리, 상기 제3풀리를 감싸는 와이어;
상기 제1보조링크의 연장방향을 따라 배치되고, 일측은 상기 제1보조링크에 고정되고, 타측은 상기 와이어에 연결되는 탄성부재;를 포함하는 중력보상구조를 구비하는 로봇암.A robot arm having a gravity compensation structure for compensating a load of a link by an elastic force of an elastic member,
The robot arm includes: a first link and a first auxiliary link arranged in parallel;
A second link pivotally connected to the first link;
A first pulley provided on the first auxiliary link;
A second pulley having a diameter equal to that of the first pulley, the second pulley being mounted on a joint to which the first link and the second link are connected;
A third pulley having a same diameter as the first pulley and mounted to the second link to move with the second link;
A wire surrounding the first pulley, the second pulley, and the third pulley;
And a resilient member disposed along the extending direction of the first auxiliary link, one side fixed to the first auxiliary link and the other side connected to the wire.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020150084936A KR102363642B1 (en) | 2015-06-16 | 2015-06-16 | Robot arm having weight compensation mechanism |
US14/995,801 US10471610B2 (en) | 2015-06-16 | 2016-01-14 | Robot arm having weight compensation mechanism |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020150084936A KR102363642B1 (en) | 2015-06-16 | 2015-06-16 | Robot arm having weight compensation mechanism |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20160148227A true KR20160148227A (en) | 2016-12-26 |
KR102363642B1 KR102363642B1 (en) | 2022-02-17 |
Family
ID=57733784
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020150084936A KR102363642B1 (en) | 2015-06-16 | 2015-06-16 | Robot arm having weight compensation mechanism |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102363642B1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020175949A1 (en) * | 2019-02-28 | 2020-09-03 | 한국기술교육대학교 산학협력단 | Gravity compensation assembly, and robot waist structure including same |
KR20200105292A (en) * | 2019-02-28 | 2020-09-07 | 한국기술교육대학교 산학협력단 | Gravity Compensation Assembly Having Elasticity Unit and Waist Structure Having the Same |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1158287A (en) * | 1997-08-12 | 1999-03-02 | Fanuc Ltd | Balance device for robot |
US20090314131A1 (en) * | 2008-06-23 | 2009-12-24 | Intuitive Surgical, Inc. | Spring Counterbalance for Rotating Load |
-
2015
- 2015-06-16 KR KR1020150084936A patent/KR102363642B1/en active IP Right Grant
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1158287A (en) * | 1997-08-12 | 1999-03-02 | Fanuc Ltd | Balance device for robot |
US20090314131A1 (en) * | 2008-06-23 | 2009-12-24 | Intuitive Surgical, Inc. | Spring Counterbalance for Rotating Load |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020175949A1 (en) * | 2019-02-28 | 2020-09-03 | 한국기술교육대학교 산학협력단 | Gravity compensation assembly, and robot waist structure including same |
KR20200105292A (en) * | 2019-02-28 | 2020-09-07 | 한국기술교육대학교 산학협력단 | Gravity Compensation Assembly Having Elasticity Unit and Waist Structure Having the Same |
Also Published As
Publication number | Publication date |
---|---|
KR102363642B1 (en) | 2022-02-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6511939B2 (en) | robot | |
US9827682B2 (en) | Joint structure for robot including motor for causing arm to be swung | |
JP6500344B2 (en) | Ceiling robot | |
US8220765B2 (en) | Spring counterbalance for rotating load | |
JP5676756B2 (en) | Parallel motion device with gimbal holder | |
KR102206699B1 (en) | Industrial robot | |
JP5949745B2 (en) | Robot and robot maintenance method | |
JP2011240487A (en) | Load compensating device | |
KR101790863B1 (en) | Robot arm with gravity compensation mechanism | |
US20110252914A1 (en) | Umbilical member arrangement unit of robot wrist section | |
EP2998081B1 (en) | Link actuation device | |
KR20160148227A (en) | Robot arm having weight compensation mechanism | |
JP6525541B2 (en) | Robot arm mechanism | |
KR101734217B1 (en) | An pedestal apparatus mounted to an antenna being capable of driving biaxially | |
US10471610B2 (en) | Robot arm having weight compensation mechanism | |
JP2006231484A (en) | Robot arm | |
KR102361191B1 (en) | Robot arm having weight compensation mechanism | |
KR101777266B1 (en) | Cable protective device | |
JP2008188719A (en) | Expansion arm | |
WO2019244799A1 (en) | Surgical tool | |
US20140064901A1 (en) | Transporting device | |
JP6455060B2 (en) | Robot adjustment method | |
US10238567B2 (en) | Arm mechanism | |
JP2018042454A (en) | Link device | |
JP2021010954A (en) | Balancer device for robot |
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 |