Robot

Abstract

A robot includes a link portion including a plurality of link members and a drive portion to rotate the link members, and axes of rotation of the drive portion extending from end portions of the link members is positioned at an identical point.

Claims

1. A robot comprising: a link portion comprising a plurality of link members; and a drive portion to rotate the plurality of link members, wherein axes of rotation of the drive portion extending from end portions of the plurality of link members are positioned at an identical point; wherein the plurality of link members comprise: a first link member; and a second link member connected to an end portion of the first link member; and wherein the first link member and the second link member are provided in a form of arcs and disposed on concentric spheres, respectively.

2. The robot of claim 1, wherein the axes of rotation of the drive portion are positioned at a center of the concentric spheres.

3. The robot of claim 1, wherein the first link member and the second link member are disposed away from a location at which the first link member and the second link member are radially spaced with respect to each other.

4. The robot of claim 1, wherein the first link member and the second link member are provided in different lengths, and between the first link member and the second link member, an externally disposed link member is provided to have a greater length than an internally disposed link member.

5. The robot of claim 1, wherein the drive portion comprises: a first drive member disposed at one end of the first link member to rotate the first link member on a first axis of rotation; and a second drive member disposed at another end of the first link member to rotate the second link member on a second axis of rotation.

6. The robot of claim 5, wherein the first axis of rotation and the second axis of rotation are positioned at the identical point, and a length of the first link member is determined based on an angle between the first axis of rotation and the second axis of rotation.

7. The robot of claim 5, wherein the first axis of rotation is perpendicular to a tangential direction of the one end of the first link member, and the second axis of rotation is perpendicular to a tangential direction of the another end of the first link member.

8. The robot of claim 1, and further comprising an emitting member disposed at another end of the second link member to face a target, and wherein the emitting member comprises a linear accelerator to emit radiation for radiation therapy.

9. The robot of claim 8, wherein the emitting member is disposed to be perpendicular to a tangential direction of an end portion of the second link member.

10. The robot of claim 8, wherein the emitting member is moved spherically around the target along a trajectory of rotation of the second link member.

11. The robot of claim 8, and further comprising an angle adjustment element disposed at the second link member or the emitting member to adjust an angle at which the emitting member faces the target.

12. A robot comprising: a first link member; a first drive member disposed at one end of the first link member to rotate the first link member on a first axis of rotation; a second link member connected to another end of the first link member; a second drive member disposed between the another end of the first link member and one end of the second link member to rotate the second link member on a second axis of rotation; and an emitting member disposed at another end of the second link member, wherein the first axis of rotation and the second axis of rotation are positioned at an identical location of a target, wherein the first link member and the second link member are provided in a form of arcs and disposed on concentric spheres on which the target is centered, respectively.

13. The robot of claim 12, wherein a length of the first link member is determined based on an angle between the first axis of rotation and the second axis of rotation.

14. The robot of claim 12, wherein the first axis of rotation is perpendicular to a tangential direction of the one end of the first link member, and the second axis of rotation is perpendicular to a tangential direction of the one end of the second link member.

15. The robot of claim 12, wherein a third axis is formed in a direction extending from the emitting member to the target, and a length of the second link member is determined based on an angle between the second axis of rotation and the third axis.

16. The robot of claim 12, and further comprising an angle adjustment element disposed at the second link member or the emitting member to adjust an angle at which the emitting member faces the target.

17. A robot comprising: a first link member; a first drive member disposed at one end of the first link member to rotate the first link member on a first axis of rotation; a second link member connected to another end of the first link member; a second drive member disposed between the another of the first link member and one end of the second link member to rotate the second link member on a second axis of rotation; and an emitting member disposed at another end of the second link member; wherein the first axis of rotation and the second axis of rotation are positioned at an identical location of a target; and wherein the first link member and the second link member are disposed away from a location at which the first link member and the second link member are radially spaced with respect to each other.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) These and/or other aspects, features, and advantages of the invention will become apparent and more readily appreciated from the following description of exemplary embodiments, taken in conjunction with the accompanying drawings of which:

(2) FIG. 1 is a front view illustrating a robot according to an embodiment of the present invention;

(3) FIG. 2 is a view illustrating axes of rotation being positioned at an identical point in a robot according to an embodiment of the present invention;

(4) FIG. 3 is a view illustrating an angle adjustment element provided at an emitting member of a robot according to embodiment of the present invention;

(5) FIG. 4 is a view illustrating a radiation range of an emitting member of a robot according to an embodiment of the present invention;

(6) FIG. 5 illustrates a direction of an emitting member in a robot according to an embodiment of the present invention; and

(7) FIG. 6 illustrates spherical coordinates.

DETAILED DESCRIPTION

(8) Reference will now be made in detail to exemplary embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like reference numerals refer to the like elements throughout. Exemplary embodiments are described below to explain the present invention by referring to the figures.

(9) FIG. 1 is a front view illustrating a robot 10 according to an embodiment of the present invention. FIG. 2 is a view illustrating axes of rotation being positioned at an identical point in the robot 10. FIG. 3 is a view illustrating an angle adjustment element provided at an emitting member 300 of the robot 10. FIG. 4 is a view illustrating a radiation range of the emitting member 300 of the robot 10.

(10) Referring to FIG. 1, the robot 10 may include a link portion 100 and a drive portion 200.

(11) The link portion 100 may include a plurality of link members. The plurality of link members may include a first link member 110 and a second link member 120.

(12) The first link member 110 and the second link member 120 may be connected to each other.

(13) The first link member 110 and the second link member 120 may be connected to each other, with the drive portion 200 disposed therebetween.

(14) The first link member 110 and the second link member 120 may be provided in a form of arcs and disposed on concentric spheres, respectively.

(15) For example, the first link member 110 may correspond to an arc disposed on a large concentric sphere, and the second link member 120 may correspond to an arc disposed on a small concentric sphere. The first link member 110 and the second link member 120 may be disposed away from a location at which the first link member 110 and the second link member 120 are radially spaced from each other.

(16) The first link member 110 and the second link member 120 may be provided in different lengths. For example, the first link member 110 may have a greater length than the second link member 120. Thus, when the second link member 120 rotates inside the first link member 110, a mutual collision between the first link member 110 and the second link member 120 may be prevented.

(17) However, the shape and the disposition of the first link member 110 and the second link member 120 are not limited thereto. The first link member 110 and the second link member 120 may be provided in any shape and disposition in which the first link member 110 and the second link member 120 may not mutually collide while being rotated in response to an operation of the drive portion 200.

(18) The drive portion 200 may be disposed on the first link member 110 and the second link member 120 to rotate the first link member 110 and the second link member 120.

(19) The drive portion 200 may include a first drive member 210 and a second drive member 220.

(20) The first drive member 210 may be disposed at one end of the first link member 110. For example, the first link member 110 may be disposed in an upper portion of the first drive member 210.

(21) Referring to FIG. 2, the first drive member 210 may rotate the first link member 110 on a first axis of rotation X.sub.1. When a longitudinal central axis of the first drive member 210 matches the first axis of rotation X.sub.1, the first link member 110 may rotate on the longitudinal central axis of the first drive member 210.

(22) The second drive member 220 may be disposed at another end of the first link member 110.

(23) When a connection element 112 is provided to compensate for a level difference between the first link member 110 and the second drive member 220, the second drive member 220 may be disposed on the connection element 112.

(24) In this example, the connection element 112 and the second drive member 220 may be disposed on an identical axis, and the connection element 112 may be disposed to be in contact with an upper end of the second drive member 220.

(25) The second drive member 220 may be disposed at one end of the second link member 120. For example, the second link member 120 may be disposed in a lower portion of the second drive member 220.

(26) The second drive member 220 may rotate the second link member 120 on a second axis of rotation X.sub.2. When a longitudinal central axis of the second drive member 220 matches the second axis of rotation X.sub.2, the second link member 120 may rotate on the longitudinal central axis of the second drive member 220.

(27) The first axis of rotation X.sub.1 and the second axis of rotation X.sub.2 may extend to be positioned at an identical point.

(28) When the first axis of rotation X.sub.1 is formed in a vertical direction, the second axis of rotation X.sub.2 may be formed to tilt at a degrees () with respect to the first axis of rotation X.sub.1. Thus, an angle between the first axis of rotation X.sub.1 and the second axis of rotation X.sub.2 may correspond to .

(29) The identical point at which the first axis of rotation X.sub.1 and the second axis of rotation X.sub.2, provided at both end portions of the first link member 110, are positioned may correspond to a central point O of the concentric spheres on which the first link member 110 and the second link member 120 are disposed.

(30) When the emitting member 300, which will be described later, is disposed on the second link member 120, the emitting member 300 may be easily aimed at a target.

(31) The drive portion 200 may have two degrees of freedom by means of the first drive member 210 and the second drive member 220, thereby spherically moving the emitting member 300. In this example, two motors may be used. Since a relatively few motors are used, an overall weight of the robot 10 may decrease.

(32) The first link member 110 and the second link member 120 may rotate on the first axis of rotation X.sub.1 and the second axis of rotation X.sub.2 in different areas, respectively. Thus, an area accessed by the first link member 110 and the second link member 120 may be extended by the first drive member 210 and the second drive member 220, whereby a directivity of the link portion 100 with respect to a target may increase.

(33) The emitting member 300 may be disposed at another end of the second link member 120.

(34) Hereinafter, the emitting member 300 will be described based on a linear accelerator that emits radiation for radiation therapy.

(35) However, the emitting member 300 is not limited thereto. The emitting member 300 may emit another material including a liquid or gas.

(36) The second link member 120 may be disposed at a center of the emitting member 300. The emitting member 300 may be disposed to be perpendicular to a tangential direction of an end portion of the second link member 120.

(37) Radiation or other materials may be emitted from a lower end of the emitting member 300. An angle at which radiation or other materials are emitted may be changed based on a tilting angle of the emitting member 300.

(38) Referring to FIG. 2 again, the emitting member 300 may be disposed to tilt with respect to the second axis of rotation X.sub.2, and disposed to tilt + with respect to the first axis of rotation X.sub.1.

(39) Angles and may be determined so that the first link member 110 and the second link member 120 may be smoothly rotated by the first drive member 210 and the second drive member 220 and the emitting member 300 may aim at a target over a relatively broader area.

(40) A portion of the emitting member 300 at which radiation is emitted may be disposed on a third axis X.sub.3. Thus, the radiation may be emitted from the emitting member 300 along the third axis X.sub.3.

(41) Similar to first axis of rotation X.sub.1 and the second axis of rotation X.sub.2, the third axis X.sub.3 may also be positioned at the central point O of the concentric spheres.

(42) That is, the first axis of rotation X.sub.1, the second axis of rotation X.sub.2, and the third axis X.sub.3 may intersect at the central point O of the concentric spheres of the first link member 110 and the second link member 120.

(43) Thus, a point at which radiation is to be emitted through the emitting member 300 may be adjusted by the link portion 100 and the drive portion 200.

(44) Referring to FIG. 3, an angle adjustment element 310 may be additionally provided at an end portion of the second link member 120 or the emitting member 300.

(45) The angle adjustment element 310 may be disposed at a point at which the emitting member 300 and the second link member 120 meet. The emitting member 300 may move in a direction of an arrow on the third axis X.sub.3, and have a yaw movement.

(46) As described above, the emitting member 300 including the angle adjustment element 310 may perform a small-angle movement. Thus, the angle adjustment element 310 may be useful when a minute angle adjustment is required after the emitting member 300 aims at a target by means of the drive portion 200.

(47) The robot 10 may further include a controller (not shown). The first drive member 210 and the second drive member 220 may be easily controlled by the controller.

(48) In detail, the controller may selectively or simultaneously operate the first drive member 210 or the second drive member 220 to dispose the emitting member 300 to face the target, and operate the angle adjustment element 310, as necessary.

(49) The controller may control an operation of the first drive member 210 or the second drive member 220 to adjust a rotation velocity or a rotation direction of the first link member 110 or the second link member 120. Thus, a radiation surgery or treatment time may be reduced.

(50) The robot 10 configured as described above according to an embodiment of the present invention may operate as follows. By operating the first drive member 210 or the second drive member 220, the first link member 110 or the second link member 120 may rotate.

(51) The first link member 110 and the second link member 120 may be disposed on concentric spheres, and relatively rotate on different axes of rotation X.sub.1, and X.sub.2, respectively. Thus, the first link member 110 and the second link member 120 may smoothly rotate without a collision.

(52) In addition, the first drive member 210 and the second drive member 220 may operate simultaneously or selectively. Thus, by operating the first drive member 210 and the second drive member 220 simultaneously, the first link member 110 and the second link member 120 may rotate simultaneously. Also, after the first link member 110 rotates by operating the first drive member 210, the second link member 120 may rotate by operating the second drive member 220.

(53) In response to the rotation of the first link member 110 and the second link member 120, the emitting member 300 disposed at an end portion of the second link member 120 may move in a spherical pattern.

(54) The angle adjustment element 310 may selectively operate.

(55) The angle adjustment element 310 may minutely adjust an angle since the emitting member 300 may have a yaw movement on the third axis X.sub.3.

(56) Radiation may be emitted through the emitting member 300.

(57) The radiation may be used to treat a target T, for example, an affected area of a patient.

(58) Referring to FIG. 4, the emitting member 300 may emit radiation within an area A.

(59) The area A may include an area in which the first link member 110 is rotated on the first axis of rotation X.sub.1 by the first drive member 210, and an area in which the second link member 120 is rotated on the second axis of rotation X.sub.2 by the second drive member 220.

(60) When the first drive member 210 and the second drive member 220 operate simultaneously, a position of the emitting member 300 may be freely adjusted within the area A.

(61) By operating the first drive member 210 and the second drive member 220, the emitting member 300 may aim at the target T or the affected area to be treated, and radiation emitted from the emitting member 300 may be concentrated on the target T.

(62) When the emitting member 300 is to be relocated during treatment, by controlling the first drive member 210, the second drive member 220, or the angle adjustment element 310 through the controller, the emitting member 300 may be relocated more rapidly and accurately. When minute adjustment is required after the emitting member 300 is relocated, the minute adjustment may be performed by controlling the angle adjustment element 310.

(63) As described above, a robot 10 according to an embodiment of the present invention may reduce a treatment or surgery time by aiming at a target more rapidly and accurately, increase a directivity with respect to the target through easy control, and reduce an overall weight through a compact design. In addition, the robot 10 may prevent a mutual collision between link members 110 and 120 during an operation of a drive portion 200, and adjust an angle at which a material is emitted from an emitting member 300 or an angle at which the emitting member 300 faces the target through an additional angle adjustment element 310 disposed at an end portion of a second link member 120 or the emitting member 300.

(64) Hereinafter, a kinematical analysis on a structure of the robot 10 will be described in detail. Forward kinematics of a robot arm may be expressed as follows.
x=f()[Equation 1]

(65) In the Equation 1, denotes a joint angle, and x denotes a location and direction of an end-effector. Coordinates of an emitting member may be estimated based on an angle at which link members are connected to each other.

(66) In addition, when a Denavit-Hartenberg (D-H) convention is used, the kinematics of the robot may include four parameters, for example, a link length a of a line member, a link offset d, a link distortion , and a joint angle . In this example, when a joint rotates around a z axis, transformation matrices may be expressed as follows.

(67) $\begin{array}{cc}{}_1^{0}T=\begin{array}{cccc}c1& -c1s1& s1s1& 0\\ s1& c1c1& -s1c1& 0\\ 0& s1& c1& R\\ 0& 0& 0& 1\end{array}& \left[\mathrm{Transformation}\mathrm{Matrix}1\right]\\ {}_2^{1}T=\begin{array}{cccc}c2& -c2s2& s2s2& 0\\ s2& c2c2& -s2c2& 0\\ 0& s2& c2& R\\ 0& 0& 0& 1\end{array}& \left[\mathrm{Transformation}\mathrm{Matrix}2\right]\end{array}$

(68) In Transformation Matrices 1 and 2, s denotes sine, and c denotes cosine. Through the above transformation matrices, a transformation matrix may be derived as follows.

(69) $\left[\mathrm{Transformation}\mathrm{Matrix}3\right]$${}_2^{0}T=\begin{array}{cccc}\begin{array}{c}c1c2-\\ c1s1c1\end{array}& \begin{array}{c}s1s2s1-\\ c2(c1c2s1+\\ c1s2)\end{array}& \begin{array}{c}c2s1s1+\\ \begin{array}{c}s2(c1c\mathrm{2s}1+\\ c1s2)\end{array}\end{array}& 0\\ \begin{array}{c}c2s1+\\ c1c1s2\end{array}& \begin{array}{c}-c\mathrm{1s}1s2+\\ \begin{array}{c}c2(c1c1c2-\\ s1s2)\end{array}\end{array}& \begin{array}{c}\begin{array}{c}-c1(c2s1+\\ c1c2s2)+\end{array}\\ s2s1s2\end{array}& 0\\ s1s2& \begin{array}{c}c\mathrm{2c}2s1+\\ c1s2\end{array}& \begin{array}{c}c1c2-\\ c\mathrm{2s}1s2\end{array}& R\\ 0& 0& 0& 1\end{array}$

(70) The above transformation matrix may represent a case in which two link members are provided. A point to which relocation is to be performed by a translation, an offset, a scale, or a rotation on a three-dimensional (3D) coordinate system may be estimated using the transformation matrix.

(71) In addition, a location and direction of the emitting member 300 or the end-effector may be expressed as follows.

(72) $\begin{array}{cc}{}_2^{0}T=\left[\begin{array}{cccc}{}^{0}x_2& {}^{0}y_2& {}^{0}z_2& {}^{0}p_2\\ 0& 0& 0& 1\end{array}\right]& \left[\mathrm{Transformation}\mathrm{Matrix}4\right]\\ {}^{0}p_2=\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]& \left[\mathrm{Transformation}\mathrm{Matrix}5\right]\end{array}$

(73) In this example, the location of the emitting member 300 or the end-effector may be constantly uniform.

(74) FIG. 5 illustrates a direction of the emitting member 300 in the robot 10. Referring to FIG. 5, the emitting member 300 may face a z axis, and have a roll movement of rotating on the z axis, a yaw movement of oscillating up and down based on the z axis, and a pitch movement of rotating up and down based on the z axis. In this example, a roll direction may be insignificant in the emitting member 300. Only a z-vector may be considered for a direction of the emitting member 300. Thus, Transformation Matrix 2 may be arranged as follows.

(75) $\begin{array}{cc}{}^{0}z_2=\left[\begin{array}{c}{z}_1\\ z_2\\ z_3\end{array}\right]=[\begin{array}{c}c\mathrm{2s}1s1+s2\left(c1c2s1+c1s2\right)\\ -c1\left(c2s1+c1c2s2\right)+s2s1s2\\ c1c2-c2s1s2\end{array}]& \left[\mathrm{Transformation}\mathrm{Matrix}6\right]\end{array}$

(76) A desired direction of the emitting member 300 may be designated as spherical coordinates and of FIG. 6. When the direction of the emitting member 300 is given as a and of FIG. 6, rotation matrices corresponding to the direction may be expressed as follows.

(77) $\begin{array}{cc}{R}_{\mathrm{spherical}}=R_{z,}{R}_{y,}=\left[\begin{array}{ccc}cc& -s& cs\\ sc& c& ss\\ -s& 0& c\end{array}\right]& \left[\mathrm{Rotation}\mathrm{Matrix}1\right]\\ R_{\mathrm{spherical}}=\left[\begin{array}{ccc}{x}_1& y_1& z_1\\ x_2& y_2& z_2\\ x_3& y_3& z_3\end{array}\right]& \left[\mathrm{Rotation}\mathrm{Matrix}2\right]\end{array}$

(78) Based on and from Rotation Matrices 1 and 2, .sup.0x.sub.2=[x.sub.1, x.sub.2, x.sub.3].sup.T, .sup.0y.sub.2=[y.sub.1, y.sub.2, y.sub.3].sup.T, and .sup.0z.sub.2=[z.sub.1, z.sub.2, z.sub.3].sup.T may be determined, and .sub.1 and .sub.2 may also be determined. Such a relationship may be expressed by inverse kinematics as follows.
=f(x).sup.1[Equation 2]

(79) In Equation 2, x denotes a vector .sup.0z.sub.2=[z.sub.1, z.sub.2, z.sub.3].sup.T and, denotes a vector including .sub.1 and .sub.2. Equation 2 may be an inverse function of Equation 1.

(80) The joints angles .sub.1 and .sub.2 may be calculated based on orthonormal vectors .sup.0x.sub.2, .sup.0y.sub.2, and .sup.0z.sub.2. An intuitive method of calculating such vectors may be performed using spherical coordinates. When a direction is given as and , a rotation matrix corresponding to the direction may be expressed as follows.

(81) $\begin{array}{cc}{R}_{\mathrm{spherical}}=R_{z,}{R}_{y,}=\left[\begin{array}{ccc}cc& -s& cs\\ sc& c& ss\\ -s& 0& c\end{array}\right]& \left[\mathrm{Rotation}\mathrm{Matrix}3\right]\end{array}$

(82) In this example, constituent elements of the vectors may correspond to .sup.0x.sub.2=[x.sub.1, x.sub.2, x.sub.3].sup.T, .sup.0y.sub.2=[y.sub.1, y.sub.2, y.sub.3].sup.T, and .sup.0z.sub.2=[z.sub.1, z.sub.2, z.sub.3].sup.T.

(83) The following Equations may be extracted from Transformation Matrix 3.
x.sub.3=s.sub.1s.sub.2
z.sub.3=c.sub.1c.sub.2c.sub.2s.sub.1s.sub.2[Equation 3]

(84) In Equation 3, .sub.2 may be induced as follows.

(85) $\begin{array}{cc}s{}_2=x_3-s{}_{1}c{}_2=\frac{z_3+c{}_{1}c{}_2}{s{}_{1}s{}_2}\tan {}_2=\frac{s{}_{1}s{}_2\left(x_3-s{}_1\right)}{z_3+c{}_{1}c{}_2}{}_2=\arctan 2\left(x_3-s{}_1,\frac{z_3+c{}_{1}c{}_2}{s{}_{1}s{}_2}\right)& \left[\mathrm{Equation}4\right]\end{array}$

(86) A function arctan 2, an arctangent function including two input variables, may be used due to a stability of being close to zero input values and a characteristic of a final angle returning to an appropriate quadrant. .sub.1 may be calculated as follows. The following Equations 5 through 7 may be obtained from Transformation Matrix 4.

(87) $\begin{array}{cc}\left(x_2=c{}_{2}s{}_1+c{}_{1}c{}_{1}s{}_2\right)c{}_{1}s{}_2\left(x_1=-s{}_{1}c{}_{1}s{}_2+c{}_{1}c{}_2\right)c{}_2& \left[\mathrm{Equation}5\right]\\ c{}_{1}s{}_2{x}_2+c{}_2{x}_1=c^2{}_1{s}^2{}_{2}c{}_1+c^2{}_{2}c{}_{1}c{}_1=\frac{c{}_{1}s{}_2{x}_2+c{}_2{x}_1}{c_1^{}{s}^2{}_2+c^2{}_2}& \left[\mathrm{Equation}6\right]\\ z_1=\left(c{}_{2}s{}_1+s{}_{2}c{}_{1}c{}_2\right)s{}_1+s{}_{2}s{}_{2}c{}_1{z}_2=-\left(c{}_{2}s{}_1+s{}_{2}c{}_{1}c{}_2\right)c{}_1+s{}_{2}s{}_{2}s{}_1& \left[\mathrm{Equation}7\right]\end{array}$

(88) In addition, the following may be assumed.
a=c.sub.2s.sub.1+s.sub.2c.sub.1
b=s.sub.2s.sub.2[Equation 8]

(89) Through Equations 7 and 8, the following may be calculated.

(90) $\begin{array}{cc}a\left(z_1=\mathrm{as}{}_1+\mathrm{bc}{}_1\right)b\left(z_2=-\mathrm{ac}{}_1+\mathrm{bs}{}_1\right){\mathrm{az}}_1=a^{2}s{}_1+\mathrm{abc}{}_1{\mathrm{bz}}_2=b^{2}s{}_1-\mathrm{abc}{}_1{\mathrm{az}}_1+{\mathrm{bz}}_2=\left(a^2+b^2\right)s{}_{1}s{}_1=\frac{{\mathrm{az}}_2+{\mathrm{bz}}_2}{a^2+b^2}& \left[\mathrm{Equation}9\right]\end{array}$

(91) Through Equations 6 and 9, .sub.1 may be calculated as follows.

(92) 0$\begin{array}{cc}{}_1=\arctan 2\left(\frac{{\mathrm{az}}_1+{\mathrm{bz}}_2}{a^2+b^2},\frac{c{}_{1}s{}_2{x}_2+c{}_2{x}_1}{c^2{}_1{s}^2{}_2+c^2{}_2}\right)& \left[\mathrm{Equation}10\right]\end{array}$

(93) From Equations 4 and 10, the two joint angles .sub.1 and .sub.2 may be determined. A Jacobian matrix will be described hereinafter. A linear mapping between a -space and an x-space may be as follows. Equation 1 may be differentiated as follows.

(94) $\begin{array}{cc}{}^0\stackrel{.}{x}={}^{0}J\stackrel{.}{}{}^{0}J=\left[\begin{array}{cc}{}^{0}z_0\left({}^{0}p_n-{}^{0}p_0\right)& {}^{0}z_1\left({}^{0}p_n-{}^{0}p_1\right)\\ {}^{0}z_0& {}^{0}z_1\end{array}\right]& \left[\mathrm{Jacobian}\mathrm{Matrix}1\right]\end{array}$

(95) The Transformation Matrix 1 may be expressed as follows.

(96) $\begin{array}{cc}{}_1^{0}T=\left[\begin{array}{cccc}{}^{0}x_1& {}^{0}y_1& {}^{0}z_1& {}^{0}p_1\\ 0& 0& 0& 1\end{array}\right]=\begin{array}{cccc}c1& -c1s1& s1s1& 0\\ s1& c1c1& -s1c1& 0\\ 0& s1& c1& R\\ 0& 0& 0& 1\end{array}& \left[\mathrm{Rotation}\mathrm{Matrix}7\right]\end{array}$

(97) Thus, the Jacobian matrix may be expressed as follows.

(98) $\begin{array}{cc}{}^{0}J=[\begin{array}{cc}\left[\begin{array}{c}0\\ 0\\ 1\end{array}\right]\left(\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]-\left[\begin{array}{c}0\\ 0\\ 0\end{array}\right]\right)& \left[\begin{array}{c}s1s1\\ -s1c1\\ c1\end{array}\right]\left(\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]-\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]\right)\\ \left[\begin{array}{c}0\\ 0\\ 1\end{array}\right]& \left[\begin{array}{c}s1s1\\ -s1c1\\ c1\end{array}\right]\end{array}]& \left[\mathrm{Jacobian}\mathrm{Matrix}2\right]\\ \begin{array}{c}{}^{0}J=\left[\begin{array}{cc}{}^{0}z_0\left({}^{0}p_n-{}^{0}p_0\right)& {}^{0}z_1\left({}^{0}p_n-{}^{0}p_1\right)\\ {}^{0}z_0& {}^{0}z_1\end{array}\right]\\ =\left[\begin{array}{cc}\left[\begin{array}{c}0\\ 0\\ 1\end{array}\right]\left(\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]-\left[\begin{array}{c}0\\ 0\\ 0\end{array}\right]\right)& \left[\begin{array}{c}s1s1\\ -s1c1\\ c1\end{array}\right]\left(\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]-\left[\begin{array}{c}0\\ 0\\ R\end{array}\right]\right)\\ \left[\begin{array}{c}0\\ 0\\ 1\end{array}\right]& \left[\begin{array}{c}s1s1\\ -s1c1\\ c1\end{array}\right]\end{array}\right]\\ =\left[\begin{array}{cc}\left[\begin{array}{c}0\\ 0\\ 0\end{array}\right]& \left[\begin{array}{c}0\\ 0\\ 0\end{array}\right]\\ \left[\begin{array}{c}0\\ 0\\ 1\end{array}\right]& \left[\begin{array}{c}s1s1\\ -s1c1\\ c1\end{array}\right]\end{array}\right]\end{array}& \left[\mathrm{Jacobian}\mathrm{Matrix}3\right]\end{array}$

(99) Thus, the Jacobian matrix may be expressed as follows.

(100) $\begin{array}{cc}J=\left[\begin{array}{cc}0& s1s1\\ 0& -s1c1\\ 1& c1\end{array}\right]& \left[\mathrm{Jacobian}\mathrm{Matrix}4\right]\end{array}$

(101) Through Jacobian Matrix 4, when only an angular velocity is considered and a translational velocity is not considered, a singularity may not be achieved except for a case in which =n and nN are satisfied.

(102) As described above, a relationship between a joint velocity of a link member and a velocity of an emitting member may be determined through a Jacobian matrix. Thus, a moving velocity of the emitting member may be estimated based on the joint velocity of the link member. In addition, when a desired velocity of the emitting member is given, a joint velocity of the link member that may achieve the desired velocity of the emitting member may be inversely calculated.

(103) In detail, a location of the emitting member may be estimated based on a current location of a link member. Conversely, to enable the emitting member to face a central point or a target, an operation of a link member may be controlled based on a current location of the emitting member.

(104) Although a few exemplary embodiments of the present invention have been shown and described, the present invention is not limited to the described exemplary embodiments. Instead, it would be appreciated by those skilled in the art that changes may be made to these exemplary embodiments without departing from the principles and spirit of the invention, the scope of which is defined by the claims and their equivalents.