This application claims priority to Korean Patent Application No. 10-2012-0068612, filed on Jun. 26, 2012, and all the benefits accruing therefrom under 35 U.S.C. §119, the contents of which in its entirety are herein incorporated by reference.
1. Field
The present disclosure relates to a linkage mechanism, and more particularly, to a linkage mechanism capable of feeding contact information, applied to a physically connected robot at a remote place or a target in a virtual environment, back to a user precisely.
2. Description of the Related Art
A system that physically connects a human to a robot at a remote place or a target in a virtual environment so that the robot or target imitates the human and feeds a stimulus such as an external force, applied to the robot or target, back to the human has been studied.
In the conventional art, a robot remote control system using an arm-attached tool has been proposed, but a method of feeding an external force, applied to a robot, back to the human has not been proposed.
In addition, as a method of feeding an external force or the like, applied to a robot, back to a human, there is known a method of transferring a force to a terminal such as the fingertip of a human. However, in this method, it is impossible to figure out a portion of the robot arm with a multi-joint structure to which an external force is applied, and so there is a limit in checking an accurate status of a robot at a remote place.
The present disclosure is directed to providing a linkage mechanism, which is mechanically restricted to a human at several points to move together and generates a force to a connection portion so that a contact status of a target at a remote place or in a remote environment may be checked.
In one aspect, there is provided a linkage mechanism, which is coupled to a limb of a human including a second body articulated to a first body and a third body articulated to the second body, and includes: a plurality of link arms and a plurality of connection units for connecting the link arms to be adaptively movable according to a motion of the human; and an upper fixing portion and a lower fixing portion for fixing the linkage mechanism to the second body and the third body, wherein all or a part of the plurality of link arms are connected to each other to form a closed loop including the upper fixing portion and the lower fixing portion together with the second body and the third body, wherein actuators for generating power are provided to the plurality of connection units, and wherein the actuators are selectively operated to apply a force selectively to the upper fixing portion and the lower fixing portion.
The linkage mechanism may be a linkage mechanism for remotely controlling a limb of a robot including a second robot body articulated to a first robot body and a third robot body articulated to the second robot body, the linkage mechanism may be controlled to apply a force to the upper fixing portion when an external force is applied to the second robot body, and the linkage mechanism may be controlled to apply a force to the lower fixing portion when an external force is applied to the third robot body.
The link arm connected to the upper fixing portion and the link arm connected to the lower fixing portion may be connected to each other to form a closed loop.
The link arm connected to the upper fixing portion and the link arm connected to the lower fixing portion may be connected via another link arm to form a closed loop.
The link arm connected to the upper fixing portion and the link arm connected to the lower fixing portion may be connected through link arms connected to a connection unit which fixes the linkage mechanism to a support surface, and a closed loop including the upper fixing portion, the lower fixing portion and the connection unit for fixing the linkage mechanism to the support member may be formed.
The plurality of connection units may include a displacement measuring sensor for measuring a displacement of the connection unit.
The plurality of connection units may be each a hinge-type connection unit which connects two link arms by a hinge, and the actuator may be a torque actuator for rotating the hinge-type connection unit to generate a torque.
The plurality of connection units may be each a cylindrical connection unit where a link arm is inserted into a cylinder of another link arm so that both link arms are linearly movable, and the actuator may be a length actuator for restricting movement of the link arm inserted into the cylinder.
The plurality of connection units may be configured as a combination of a hinge-type connection unit which connects two link arms to each other by a hinge and a cylindrical connection unit where a link arm is inserted into a cylinder of another link arm so that both link arms are linearly movable, and the actuator may be a torque actuator for rotating the hinge-type connection unit to generate a torque or a length actuator for restricting movement of the link arm inserted into the cylinder.
The above and other aspects, features and advantages of the disclosed exemplary embodiments will be more apparent from the following detailed description taken in conjunction with the accompanying drawings in which:
Hereinafter, exemplary embodiments of the present disclosure will be described with reference to the accompanying drawings. Even though the present disclosure is described with reference to the embodiment shown in the drawings, it is just an example, and the technical spirit of the present disclosure and its essential components and operations are not limited thereto.
Even though the arm is depicted among various kinds of limbs, the present disclosure is not limited thereto.
In
Hereinafter, for convenience, the shoulder will be called a first body, the upper arm 101 will be called a second body, the forearm 102 will be called a third body, the shoulder joint 111 will be called an upper joint, the elbow joint 112 will be called a lower joint.
Here, the term “upper” means a location near the body of a human, and the term “lower” means a location far from the body of a human.
Meanwhile, according to this embodiment, even though the shoulder is called the first body, the upper arm 101 is called the second body, the forearm 102 is called the third body, the shoulder joint 111 is called the upper joint, and the elbow joint 112 is called the lower joint, these terms are not limited to the corresponding portions. For example, if the upper arm is called a first body, the forearm will be a second body, and the hand will be a third body. In addition, the upper joint will be an elbow joint, and the lower joint will be a wrist joint.
In addition, the linkage mechanism of this embodiment may be connected to the leg of a human, and the terms such as the first body may be suitably selected to correspond to each portion of the leg with reference to the above.
As shown in
Meanwhile, the linkage mechanism 200 includes an upper fixing portion 231 and a lower fixing portion 232 at the second body 101 and the third body 102. In this embodiment, the upper fixing portion 231 also plays a role of a connection unit which connects two link arms 202, 203.
The joints, the connection units and the fixing portions, depicted as thick points in
There are provided four link arms: namely first to fourth link arms 201, 202, 203, 204. Among them, the third link arm 203 and the fourth link arm 204 are respectively joint-connected to the upper fixing portion 231 and the lower fixing portion 232, and also joint-connected to each other at the second connection unit 212.
In other words, the third link arm 203 and the fourth link arm 204 are connected to form a closed loop 10 including the upper fixing portion 231 and the lower fixing portion 232 together with the second body 101 and the third body 102. Meanwhile, the first link arm 201 and the second link arm 202 are connected to form a closed loop connecting the connection units 231, 211, 220 and the shoulder joint 111 together with the second body 101. Therefore, the link mechanism of this embodiment is attached to the arm of a user in a state where two closed loops are connected in parallel.
The linkage mechanism 200 is used for operating a robot arm 300 having substantially the same structure as the arm of a human as shown in
The connection unit 211, the connection unit 212 and the connection unit 231 include displacement measuring sensors (not shown) for measuring displacements of the corresponding connection units. In this embodiment, a rotating displacement measuring sensor for measuring a rotating displacement of the corresponding connection unit is used as the displacement measuring sensor.
If a rotating displacement of each connection unit 211, 212, 231 is measured, rotating displacements of the joint portions 111, 112 of the arm may be calculated by a mechanical relation between the arm 100 and the fixed linkage mechanism 200.
The rotating displacements of the joint portions 111, 112 of the arm are respectively transferred to the robot, and the joint portions 311, 312 of the robot arm are rotated at the same rotating angle by the actuators respectively mounted to the robot arms so that the robot arm operates while imitating the motion of the human arm.
According to this embodiment, the connection units 211, 212, 220, 231 of the linkage mechanism 200 includes torque actuators A1, A2, A3, A4 for generating torque and may selectively apply force to the upper fixing portion 231 and the lower fixing portion 232 by operating the actuators suitably.
The second robot body 301 and the third robot body 302 of the robot arm 300 include force sensors (not shown) for measuring a force applied to the corresponding robot body. In
The linkage mechanism 200 of this embodiment reproduces the external force (Fb) applied to the second robot body 301 of the robot arm 300 as a force (F1) applied to the upper fixing portion 231 and reproduces the external force (Fa) applied to the third robot body 302 of the robot arm 300 as a force (F2) applied to the lower fixing portion 232.
In detail, the static relation between the torques (i) of the connection units of the linkage mechanism 200 and the force (F) may be represented by Equation 1 below.
τ=JTF Equation 1
Since the degree of freedom of the connection unit of the linkage mechanism 200 and the degree of freedom of the external force are respectively 4, Jacobian (JT) has a dimension of 4×4. In other words, with respect to an external force, the torque of each joint has a one-to-one relation, and so all external forces may be expressed.
In the embodiment shown in
In Equation 2, F1x and F1y respectively represent x component and y component of F1, and F2x and F2y respectively represent x component and y component of F2. In this embodiment, since the robot arm 300 and the human arm 100 are modeled as a two-dimensional operating mechanism, the force is expressed only with x component and y component. However in a case where the robot arm 300 and the human arm 100 are modeled as a three-dimensional operating mechanism, z component is added to expand Equation 2, as obvious to those having ordinary skill in the art.
In Equation 2, the item expressed by a text J is Jacobian representing a speed relation between the connection unit and the fixing portion, and such Jacobian may be obtained from the mechanical structure of the linkage mechanism 200 modeled as shown in
According to this embodiment, Equation 2 is used for calculating the torques applied by the actuators A1, A2, A3, A4 of the connection units.
First, if the force sensor measures that the external force (Fb) is applied only to the second robot body 301 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information and scales the external force (Fb) at a preset ratio to calculate the force (F1). At this time, the force (F1) is calculated as x component (F1x) and y component (F1y), respectively.
In this case, in Equation 2, since the F2 component becomes 0, the torque (τ3) and the torque (τ4) become 0, and the torque (τ1) and the torque (τ2) are calculated.
Therefore, as shown in
By doing so, at the human arm 100, the force (F1) is applied only to the upper fixing portion 231, and no force is applied to the lower fixing portion 232. Therefore, if force is applied only to the upper fixing portion 231, the user feels the force, and in this case, the user may understood that a force is applied to a point of the second robot body 301 of the robot arm 300 remotely controlled.
Next, if it is measured that the external force (Fa) is applied to the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information and scales the external force (Fa) at a preset ratio to calculate the force (F2). At this time, the force (F2) is calculated as x component (F2x) and y component (F2y), respectively.
In this case, in Equation 2, the F1 component becomes 0, but it may be understood that the torque (τ1) and the torque (τ2) do not become 0 and all of the torque (τ1) to the torque (τ4) may be calculated.
Therefore, the controller of the linkage mechanism 200 operates the actuator A1 to output the obtained torque (τ1), operates the actuator A2 to output the obtained torque (τ2), operates the actuator A3 to output the obtained torque (τ3), and operates the actuator A4 to output the obtained torque (τ4).
By doing so, in the human arm 100, the force (F2) may be applied to the lower fixing portion 232, and no force may be applied to the upper fixing portion 231. Therefore, if the user feels this force, the user may understand that a force is applied to a point of the third robot body 302 of the robot arm 300 remotely controlled.
Finally, if it is measured that the external force (Fb) and the external force (Fa) are simultaneously applied to the second robot body 301 and the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information, scales the external force (Fb) at a preset ratio to calculate the force (F1), and scales the external force (Fa) at a present ratio to calculate the force (F2). At this time, the forces are respectively calculated as x component and y component.
In this case, all of the torque (τ1) to the torque (τ4) are calculated by Equation 2.
Therefore, the controller of the linkage mechanism 200 operates the actuator A1 to output the obtained torque (τ1), operates the actuator A2 to output the obtained torque (τ2), operates the actuator A3 to output the obtained torque (τ3), and operates the actuator A4 to output the obtained torque (τ4).
By doing so, the feeling of the force (F1) applied to the upper fixing portion 231 and the feeling of the force (F2) applied to the lower fixing portion 232 are transferred to the human arm 100. If the user feels the forces, the user may understand that forces are simultaneously applied to a point of the second robot body 301 and a point of the third robot body 302 of the robot arm 300 remotely controlled.
The above operations may also be implemented while changing the link configurations of the linkage mechanism 200 in various ways.
Referring to
The connection unit 220 and the connection unit 212 respectively include a single actuator A1, A4, and the connection unit 211 includes two independent actuators A2, A3 together. In this embodiment, the upper fixing portion 231 does not have an actuator.
According to this embodiment, Equation 3 below is used for calculating a torque applied by the actuator A1, A2, A3, A4 of each connection unit.
Referring to
By doing so, in the human arm 100, the force (F1) is applied only to the upper fixing portion 231, and no force is applied to the lower fixing portion 232. Therefore, if the force is applied only to the upper fixing portion 231, the user may feel the force and thus may understand a point of the second robot body 301 of the robot arm 300 remotely adjusted, to which the force is applied.
Meanwhile, if it is measured that the external force (Fa) is applied to the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information and scales the external force (Fa) at a preset ratio to calculate the force (F2). At this time, the force (F2) is calculated as x component (F2x) and y component (F2y), respectively.
In this case, in Equation 3, the F1 component becomes 0 so that the torque (τ2) becomes 0, and the torque (τ1), the torque (τ3) and the torque (τ4) are calculated.
Therefore, the controller of the linkage mechanism 200 operates the actuator A1 to output the obtained torque (τ1), operates the actuator A3 to output the obtained torque (τ3), and operates the actuator A4 to output the obtained torque (τ4). The actuator A2 is not operated.
By doing so, in the human arm 100, the force (F2) may be applied to the lower fixing portion 232, and no force may be applied to the upper fixing portion 231. Therefore, if the user feels the force, the user may understand that a force is applied to a point of the third robot body 302 of the robot arm 300 remotely controlled.
Finally, if it is measured that the external force (Fb) and the external force (Fa) are simultaneously applied to the second robot body 301 and the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 calculates the force (F1) and the force (F2). At this time, the forces are respectively calculated as x component and y component.
In this case, all of the torque (τ1) to the torque (τ4) are calculated by Equation 3. Therefore, the controller of the linkage mechanism 200 operates the actuator A1 to output the obtained torque (τ1), operates the actuator A2 to output the obtained torque (τ2), operates the actuator A3 to output the obtained torque (τ3), and operates the actuator A4 to output the obtained torque (τ4).
By doing so, the feeling of the force (F1) is applied to the upper fixing portion 231 and the feeling of the force (F2) applied to the lower fixing portion 232 are transferred to the human arm 100. If the user feels the forces, the user may understand that forces are simultaneously applied to points of the second robot body 301 and the third robot body 302 of the robot arm 300 remotely controlled.
Referring to
The connection unit 211 and the connection unit 212 respectively include a single actuator A2, A4, and the connection unit 220 includes two independent actuators A1, A3. In this embodiment, the upper fixing portion 231 does not have an actuator.
According to this embodiment, Equation 4 below is used for calculating a torque applied by an actuator A1, A2, A3, A4 of each connection unit.
Referring to
By doing so, in the human arm 100, the force (F1) is applied only to the upper fixing portion 231, and no force is applied to the lower fixing portion 232. Therefore, if the force is applied to the upper fixing portion 231, the user may feel the force and thus may understand that a force is applied to a point of the second robot body 301 of the robot arm 300 remotely controlled.
Meanwhile, if it is measured that the external force (Fa) is applied to the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 calculates the force (F2). At this time, the force (F2) is calculated as x component (F2x) and y component (F2y), respectively.
In this case, in Equation 4, the F1 component becomes 0 so that the torque CO and the torque (τ2) become 0, and the torque (τ3) and the torque (τ4) are calculated.
Therefore, the controller of the linkage mechanism 200 operates the actuator A3 to output the obtained torque (τ3) and operates the actuator A4 to output the obtained torque (τ4). The actuator A1 and the actuator A2 are not operated.
By doing so, in the human arm 100, the force (F2) may be applied only to the lower fixing portion 232, and no force may be applied to upper fixing portion 231. Therefore, if the user may feel the force, the user may understand that a force is applied to a point of the third robot body 302 of the robot arm 300 remotely controlled.
Finally, if it is measured that the external force (Fb) and the external force (Fa) are simultaneously applied to the second robot body 301 and the third robot body 302 of the robot arm 300, respectively, the controller (not shown) of the linkage mechanism 200 calculates the force (F1) and the force (F2). At this time, the forces are respectively calculated as x component and y component.
In this case, all of the torque (τ1) to torque (τ4) are calculated by Equation 4. Therefore, the controller of the linkage mechanism 200 operates the actuator A1 to output the obtained torque (τ1), operates the actuator A2 to output the obtained torque (τ2), operates the actuator A3 to output the obtained torque (τ3), and operates the actuator A4 to output the obtained torque (τ4).
By doing so, the feeling of the force (F1) applied to the upper fixing portion 231 and the feeling of the force (F2) applied to the lower fixing portion 232 are transferred to the human arm 100. If the user feeds the forces, the user may understand that forces are simultaneously applied to points of the second robot body 301 and the third robot body 302 of the robot arm 300 remotely controlled.
Meanwhile, even though the above embodiments have been illustrated in a way that the link arms are connected by a hinge and the toque actuator is used as the actuator, the present disclosure is not limited thereto.
As shown in
In
Referring to
First, if the force sensor measures that the external force (Fb) is applied only to the second robot body 301 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information and scales the external force (Fb) at a preset ratio to calculate the force (F1). At this time, the force (F1) is calculated as x component (F1x) and y component (F1y), respectively.
The controller of the linkage mechanism 200 operates the actuator A1 to push the link arm 242 vertically so as to output a vertical force corresponding to the x component force (F1x). In addition, the controller operates the actuator A2 to pushes the link arm 243 horizontally so as to output a horizontal force corresponding to the y component force (F1y). At this time, the actuator A3 and the actuator A4 are not operated.
By doing so, the feeling of the force (F1) applied to the upper fixing portion 231 is transferred to the human arm 100, and no force is applied to the lower fixing portion 232. Therefore, if the user feels the force applied only to the upper fixing portion 231, the user may understand that a force is applied to a point of the second robot body 301 of the robot arm 300 remotely controlled.
Next, if it is measured that the external force (Fa) is applied to the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information and scales the external force (Fa) at a preset ratio to calculate the force (F2). At this time, the force (F2) is calculated as x component (F2x) and y component (F2y), respectively.
The controller of the linkage mechanism 200 operates the actuator A1 and the actuator A3 to push the link arm 242 and the link arm 244 vertically so as to output a vertical force corresponding to the x component force (F1x). At this time, the intensities of the forces applied by the actuator A1 and the actuator A3 are suitably adjusted by a mechanical model of the linkage mechanism 200.
In addition, the controller operates the actuator A2 and the actuator A4 to push the link arm 243 and the link arm 245 horizontally so as to output a horizontal force corresponding to the y component force (F1y). At this time, the intensities of the forces applied by the actuator A2 and the actuator A4 are suitably adjusted by a mechanical model of the linkage mechanism 200.
By doing so, in the human arm 100, the force (F2) may be applied to the lower fixing portion 232, and no force may be applied to the upper fixing portion 231. Therefore, if the user feels the force, the user may understand that a force is applied to a point of the third robot body 302 of the robot arm 300 remotely controlled.
Finally, if it is measured that the external force (Fb) and the external force (Fa) are simultaneously applied to the second robot body 301 and the third robot body 302 of the robot arm 300, the controller (not shown) of the linkage mechanism 200 receives the information, scales the external force (Fb) at a preset ratio to calculate the force (F1) and scales the external force (Fa) at a preset ratio to calculate the force (F2). At this time, the forces are respectively calculated as x component and y component.
The controller of the linkage mechanism 200 operates the actuator A1 and the actuator A3 to push the link arm 242 and the link arm 244 vertically so as to output a vertical force corresponding to the x component force (F1x). At this time, the intensities of the forces applied by the actuator A1 and the actuator A3 are suitably adjusted by a mechanical model of the linkage mechanism 200.
In addition, the controller operates the actuator A2 and the actuator A4 to push the link arm 243 and the link arm 245 horizontally so as to output a horizontal force corresponding to the y component force (F1y). At this time, the intensities of the forces applied by the actuator A2 and the actuator A4 are suitably adjusted by a mechanical model of the linkage mechanism 200.
By doing so, the feeling of the force (F1) applied to the upper fixing portion 231 and the feeling of the force (F2) applied to the lower fixing portion 232 are transferred to the human arm 100. If the user feels the forces, the user may understand that forces are simultaneously applied to points of the second robot body 301 and the third robot body 302 of the robot arm 300.
Referring to the embodiment shown in
The method and principle of providing a user with the feeling of force, employed in this embodiment, may be clearly understood from the former embodiments by those having ordinary skill in the art and thus they are not described in detail here.
According to the embodiment shown in
The method and principle of providing a user with the feeling of force, employed in this embodiment, may be clearly understood from the former embodiments by those having ordinary skill in the art and thus they are not described in detail here.
Meanwhile, according to another embodiment of the present disclosure, the plurality of connection units of the linkage mechanism 200 may be configured with a combination of the hinge-type connection units (see
It may be understood that the linkage mechanisms 200 shown in
The operations of the linkage mechanisms 200 shown in
In addition to the configurations shown in
As shown in
In
As shown in
Even though it has been described that a robot is adjusted by using the linkage mechanism 200 according to the embodiments of the present disclosure, the use of the present disclosure is not limited thereto. For example, the linkage mechanism 200 according to the embodiments of the present disclosure may be used for moving various characters and providing more realistic virtual environments by allow a user to directly feel an external force or the like applied to a character.
While the exemplary embodiments have been shown and described, it will be understood by those skilled in the art that various changes in form and details may be made thereto without departing from the spirit and scope of the present disclosure as defined by the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
10-2012-0068612 | Jun 2012 | KR | national |