FORCE REFLECTING SYSTEM
20190332172 ยท 2019-10-31
Inventors
- Joon Bum Bae (Ulsan, KR)
- Jeong Soo Lee (Ulsan, KR)
- In Seong Jo (Ulsan, KR)
- Yeon Gyu Park (Ulsan, KR)
- Bum Jae You (Seoul, KR)
Cpc classification
G06F3/04815
PHYSICS
G06F3/016
PHYSICS
International classification
Abstract
Provided is a force conveyance system that is configured to have 6 degrees of freedom, thereby allowing freedom of movement such as opening/closing of a hand and adduction/abduction of a finger and reflecting a desired force to a fingertip without obstructing the movement of a finger. Also, the force conveyance system may estimate a fingertip position and a finger joint angle, measure a finger movement, and convey a more accurate force accordingly.
Claims
1. A force conveyance system comprising: a hand-back-wearable unit worn on the back of a hand; an active unit provided in the hand-back-wearable unit to generate a rotational force; an active link rotatably coupled to the active unit and rotatable by the rotational force; a passive link coupled to the active link by a first coupler to have 2 degrees of freedom; a finger-wearable unit coupled to the passive link by a second coupler to have 3 degrees of freedom and worn on the tip of a finger; and a controller which estimates a position of the fingertip and an angle of a finger joint and controls the rotational force of the active unit according to the estimation.
2. The force conveyance system of claim 1, wherein the active link includes: a first active link unit coupled to the active unit and extending upward from the hand-back-wearable unit; and a second active link unit inclined at a first preset angle from the first active link unit, formed to be inclined upward, and coupled to the first coupler.
3. The force conveyance system of claim 1, wherein the passive link includes: a first passive link unit coupled to the second coupler and extending upward from the second coupler; and a second passive link unit inclined at a second preset angle from the first passive link unit, formed to be inclined upward, and coupled to the first coupler.
4. The force conveyance system of claim 1, wherein the first coupler includes: one end coupled to the active link and coupled to be rotatable by the rotational force of the active unit around a first rotational axis arranged in an adduction/abduction direction of the finger; and another end coupled to the passive link and coupled to be rotatable by the movement of the finger around a second rotational axis arranged in a direction perpendicular to the back of the hand.
5. The force conveyance system of claim 1, wherein the second coupler includes: a first rotation unit coupled to the finger-wearable unit and coupled to be rotatable by the movement of the finger around a third rotational axis arranged in an adduction/abduction direction of the finger; a second rotation unit provided to protrude upward from the first rotation unit and coupled to be rotatable by the movement of the finger around a fourth rotational axis arranged in a lengthwise direction of the finger; and a third rotation unit configured to couple the second rotation unit and the passive link and coupled to be rotatable by the movement of the finger around a fifth rotational axis arranged in a lengthwise direction of the passive link.
6. The force conveyance system of claim 1, further comprising an active unit sensor which measures a rotation angle of the active unit.
7. The force conveyance system of claim 6, further comprising a first hole sensor provided at one end of the first coupler, wherein the first hole sensor measures a rotation angle of the active link.
8. The force conveyance system of claim 7, further comprising a second hole sensor provided at another end of the first coupler, wherein the second hole sensor measures a rotation angle of the passive link.
9. The force conveyance system of claim 8, wherein the controller calculates a tip position of the finger according to the rotation angle of the active unit measured by the active unit sensor, the rotation angle of the active link measured by the first hole sensor, and the rotation angle of the passive link measured by the second hole sensor, calculates an angle of the finger joint by using the tip position of the finger, and controls the rotational force of the active unit according to the angle of the finger joint.
10. The force conveyance system of claim 1, wherein the finger-wearable unit includes a finger holder formed in a ring shape to be fitted to the tip of the finger and formed to have one side open.
11. The force conveyance system of claim 10, wherein the finger-wearable unit further includes an opening/closing member configured to open/close an open portion of the finger holder.
12. The force conveyance system of claim 10, wherein an elastic member is provided at an inner circumferential surface of the finger holder.
13. The force conveyance system of claim 1, wherein the active unit is coupled to the hand-back-wearable unit and extending in a direction inclined at a preset angle with respect to a lengthwise direction of the finger.
14. The force conveyance system of claim 13, wherein a rotational axis of the active unit and a rotational axis of the active link are coupled by a bevel gear.
15. A force conveyance system comprising: a hand-back-wearable unit worn on the back of a hand; an active unit provided in the hand-back-wearable unit to generate a rotational force; an active link rotatably coupled to the active unit and rotatable by the rotational force; a passive link coupled to the active link by a first coupler to have 2 degrees of freedom; a finger-wearable unit coupled to the passive link by a second coupler to have 3 degrees of freedom and worn on the tip of a finger; an active unit sensor which measures a rotation angle of the active unit; a first hole sensor provided at one end of the first coupler, wherein the first hole sensor measures a rotation angle of the active link; a second hole sensor provided at another end of the first coupler, wherein the second hole sensor measures a rotation angle of the passive link; and a controller which calculates a tip position of the finger according to the rotation angle of the active unit measured by the active unit sensor, the rotation angle of the active link measured by the first hole sensor, and the rotation angle of the passive link measured by the second hole sensor; calculates an angle of the finger joint by using the tip position of the finger; and controls the rotational force of the active unit according to the angle of the finger joint, wherein the first coupler includes one end coupled to the active link and coupled to be rotatable by the rotational force of the active unit around a first rotational axis arranged in an adduction/abduction direction of the finger and another end coupled to the passive link and coupled to be rotatable by the movement of the finger around a second rotational axis arranged in a direction perpendicular to the back of the hand, and the second coupler includes a first rotation unit coupled to the finger-wearable unit and coupled to be rotatable by the movement of the finger around a third rotational axis arranged in an adduction/abduction direction of the finger, a second rotation unit protruding upward from the first rotation unit and coupled to be rotated by the movement of the finger around a fourth rotational axis arranged in a lengthwise direction of the finger, and a third rotation unit configured to couple the second rotation unit and the passive link and coupled to be rotatable by the movement of the finger around a fifth rotational axis arranged in a lengthwise direction of the passive link.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
BEST MODE
[0023] Hereinafter, embodiments of the present disclosure will be described with reference to the accompanying drawings.
[0024]
[0025] Referring to
[0026] As an example, the force conveyance system will be described as conveying a force to three fingers such as a thumb, an index finger, and a middle finger.
[0027] The force conveyance system may include a hand-back-wearable unit 10, an active unit 20, an active link 30, a passive link 40, a finger-wearable unit 50, a first coupler 60, a second coupler 70, an active unit sensor (not illustrated), first and second hole sensors (not illustrated), and a controller (not illustrated).
[0028] The hand-back-wearable unit 10 may be formed to be worn on the back of the hand of the user. The hand-back-wearable unit 10 may be formed to cover at least a portion of the hand back. The hand-back-wearable unit 10 may be worn on the wrist of the user in addition to the hand back of the user.
[0029] The active unit 20 may be installed on the hand-back-wearable unit 10. The active unit 20 may be detachably coupled to an active unit holder 11 provided at the hand-back-wearable unit 10.
[0030] As an example, the active unit 20 may include a rotary motor.
[0031] The active unit 20 may be arranged long in a direction inclined at a preset angle with respect to a lengthwise direction x of the finger. Herein, the preset angle may be, for example, about 45 degrees. Since the active unit 20 is arranged to be inclined at an angle of 45 degrees with respect to the lengthwise direction x of the finger, the area occupied by the active unit 20 on the hand-back-wearable unit 10 when a plurality of active units 20 are mounted may be minimized and thus the force conveyance system may be miniaturized.
[0032] The active link 30 may be rotatably coupled to the active unit 20 and may be rotated by the rotational force of the active unit 20. The active link 30 and the active unit 20 may be coupled by an active joint. In the present embodiment, since the active unit 20 and the active link 30 may be arranged to be inclined at 45 degrees with respect to the lengthwise direction x of the finger, a rotation axis of the active unit 20 and a sixth rotation axis 86 of the active link 30 may be coupled, for example, by a bevel gear 22. However, the present disclosure is not limited thereto, and the active link 30 and the active unit 20 may be coupled by a single rotation axis.
[0033] Referring to
[0034] The first active link unit 31 may be coupled to the active unit 20 and may be formed long upward from the hand-back-wearable unit 10. An end portion of the first active link unit 31 may be coupled to the active unit 20 by the sixth rotation axis 86. The sixth rotation axis 86 of the first active link unit 31 and the rotation axis of the active unit 20 may be coupled by the bevel gear 22. The first active link unit 31 may be rotated by the rotational force of the active unit 20.
[0035] The second active link unit 32 may be formed to extend from the first active link unit 31. The second active link unit 32 may be inclined upward and may be inclined at a first preset angle from the first active link unit 31. An end portion of the second active link unit 32 may be coupled to the first coupler 60. The first preset angle may be set differently according to the length of the first active link unit 31 and the second active link unit 32 or the length of the finger.
[0036] The passive link 40 may be moved by the rotational force transmitted from the active link 30 or may be moved according to the movement of the finger.
[0037] Referring to
[0038] The first passive link unit 41 may be coupled to the second coupler 70 and may be formed long upward from the second coupler 70. The first passive link unit 41 and the second coupler 70 may be coupled by a passive joint.
[0039] The second passive link unit 42 may be formed to extend from the first passive link unit 41. The second passive link unit 42 may be inclined upward and may be inclined at a second preset angle from the first passive link unit 41. An end portion of the second passive link unit 42 may be coupled to the first coupler 60. The second passive link unit 42 and the first coupler 60 may be coupled by a passive joint. The second preset angle may be set differently according to the length of the first passive link unit 41 and the second passive link unit 42 or the length of the finger.
[0040] Referring to
[0041] Meanwhile, in comparison with
[0042] The finger-wearable unit 50 may include a finger holder 51, an opening/closing member 52, and an elastic member 53.
[0043] The finger holder 51 may be formed in a ring shape to be fitted to the tip of the finger and may have an opening portion 51a having one side open. However, the present disclosure is not limited thereto, and the finger holder 51 may formed in any shape that may be fitted to the tip of the finger.
[0044] Referring to
[0045] The elastic member 53 may be provided at the inner circumferential surface of the finger holder 51 to improve the wearability thereof. As an example, the elastic member 53 may include silicon.
[0046]
[0047] Referring to
[0048] One end 61 of the first coupler 60 may be coupled to the active link 30 and may be coupled to be rotated by the rotational force of the active unit 20 around a first rotation axis 81 arranged in a movement direction of the finger. Herein, the movement direction of the finger may be described as being arranged long in an adduction/abduction direction y of the finger. The one end 61 of the first coupler 60 may be formed in a cylindrical bush shape to be coupled to the active link 30 by the first rotation axis 81.
[0049] The other end 62 of the first coupler 60 may be coupled to the passive link 40 and may be provided to be rotated around a second rotation axis 82 by the movement of the finger. The second rotation axis 82 may be arranged in a direction inclined at a certain angle with respect to a direction z perpendicular to the back of the hand. However, assuming that the certain angle is very small, the second rotation axis 82 may be described as being arranged long in the direction z perpendicular to the back of the hand.
[0050]
[0051] Referring to
[0052] The first rotation unit 71 may be coupled to the finger-wearable unit 50. That is, the first rotation unit 71 may be formed in a cylindrical shape and may be coupled by a third rotation axis 83 between a pair of brackets 54 protruding upward from the finger-wearable unit 50. The third rotation axis 83 may be arranged long in the adduction/abduction direction y of the finger. Thus, the first rotation unit 71 may be rotated around the third rotation axis 83 by the movement of the finger.
[0053] The second rotation unit 72 may be formed to protrude upward from the first rotation unit 71. The second rotation unit 72 may be coupled to the third rotation unit 73 by a fourth rotation axis 84. The fourth rotation axis 84 may be arranged in a direction inclined at a certain angle with respect to the lengthwise direction x of the finger. However, assuming that the certain angle is very small, the fourth rotation axis 84 may be described as being arranged long in the lengthwise direction x of the finger. Thus, the second rotation unit 72 may be rotated around the fourth rotation axis 84 by the movement of the finger.
[0054] The third rotation unit 73 may be configured to couple the second rotation unit 72 and the passive link 40. One end of the third rotation unit 73 may be coupled to the second rotation unit 72 by the fourth rotation axis 84 and the other end thereof may be coupled to the passive link 40 by a fifth rotation axis 85. The fifth rotation axis 85 may be arranged in the lengthwise direction of the passive link 40. In the present embodiment, since the lengthwise direction of the passive link 40 may be the direction z perpendicular to the back of the hand, the fifth rotation axis 85 may be the direction z perpendicular to the back of the hand.
[0055] The active unit sensor (not illustrated) may be a motor encoder for measuring the rotation angle of the active unit 20. It may be assumed that the rotation angle of the active unit 20 may be equal to a rotation angle 1 of the first active link unit 31 due to the rotation force of the active unit 20. When the difference between the rotation angle of the active unit 20 and the rotation angle 1 of the first active link unit 31 is great, the rotation angle 1 of the first active link unit 31 may be obtained from the rotation angle of the active unit 20.
[0056] The first hole sensor (not illustrated) may be provided at one end of the first coupler 60 to measure a rotation angle 2 of the second active link unit 32.
[0057] The second hole sensor (not illustrated) may be provided at the other end of the first coupler 60 to measure a rotation angle 3 of the second passive link unit 42.
[0058] Also, sensors for measuring a joint angle of the finger may be provided for accurate measurement of a finger movement, and the sensors may be provided at one end or the other end of the first coupler 60 or the second coupler 70.
[0059] The operation of the force conveyance system according to an embodiment of the present disclosure will be described below.
[0060] When the rotational force of the active unit 20 is determined under the control of the controller (not illustrated), the rotational force of the active unit 20 is transmitted to the finger through the active link 30 and the passive link 40.
[0061] In this case, the controller (not illustrated) may estimate the position of the fingertip and the joint angle of the finger and adjust the rotational force of the active unit 20 accordingly. The rotational force of the active unit 20 may be adjusted to adjust the force applied to the fingertip.
[0062]
[0063] Referring to
[0064] l1 denotes the length of the first active link unit 31, l2 denotes the length of the second active link unit 32, l3 denotes the length of the first coupler 60, l4 denotes the length of the second passive link unit 42, and l5 denotes the length of the first passive link unit 41. l1 to l5 may be values that may be obtained in advance from the structure information of the force conveyance system.
[0065] 1 is the rotation angle of the active unit 20, 2 is the rotation angle of the second active link unit 32, and 3 is the rotation angle of the second passive link unit 42. 1 to 3 may be values that may be measured from the active unit sensor and the first and second hole sensors (not illustrated).
[0066] denotes an angle between the first passive link unit 31 and the second passive link unit 32, and denotes an angle between the first passive link unit 41 and the second passive link unit 42. and may be values that may be obtained in advance from the structure information of the force conveyance system.
[0067] Equations 1 to 3 may be obtained by using the kinematic model illustrated in
[0068] In this case, assuming that an error due to the distance between the fingertip position and the position of the finger-wearable unit 50 is very small, it is assumed that the fingertip position and the position of the finger-wearable unit 50 are equal to each other.
Px=l.sub.1 cos .sub.1+l.sub.2 cos(+.sub.1)+l.sub.3 cos(+.sub.1+.sub.2)+l.sub.4 cos(+.sub.1+.sub.2)cos .sub.3+l.sub.5(sin sin(+.sub.1+.sub.2)+cos cos(+.sub.1+.sub.2)cos )Equation 1
Py=(l.sub.4+l.sub.5 cos )sin .sub.3Equation 2
Pz=l.sub.1 sin .sub.1+l.sub.2 sin(+.sub.1)+l.sub.3 sin(+.sub.1+.sub.2)+l.sub.4 sin(+.sub.1+.sub.2)cos .sub.3+l.sub.5(sin cos(+.sub.1+.sub.2)+cos sin(+.sub.1+.sub.2)cos .sub.3)Equation 3
[0069] The fingertip position (Px, Py, Pz) may be obtained with reference to Equations 1 to 3.
[0070] Meanwhile, when the fingertip position is known, an adduction/abduction angle A of the finger may be obtained through Equation 2.
[0071] Referring to
[0072] The adduction/abduction angle A may be represented as Equation 4.
[0073] The tip position of the finger rotating may be obtained according to the adduction/abduction angle obtained from Equation 4. Hereinafter, the tip position of the finger rotating according to the adduction/abduction angle will be referred to as a fingertip rotation position (Px, Py, Pz) of the finger.
[0074] The fingertip rotation position (Px, Py, Pz) may be represented as Equation 5.
[0075] When the fingertip rotation position (Px, Py, Pz) is known, the finger joint angle may be obtained through the following equations.
[0076]
[0077]
[0078] In
[0079] Meanwhile,
[0080] In
[0081] Herein, it is assumed that P and D are equal to each other. That is, it is assumed that P and D are equal to each other because the difference between the angle P of the proximal interphalangeal joint and the angle D of the distal interphalangeal joint is within an error range.
[0082] Since the fingertip rotation position (Px, Py, Pz) is known, the length of L1 may be represented as Equation 6 from
L.sub.1={square root over ((Px).sup.2+(Pz).sup.2)}Equation 6
[0083] Also, P, D, and M, which are the joint angles of the finger, may be obtained by using the kinematic models of Equation 6 and
[0084] Equations for P, D, and M may be represented as Equations 7 and 8.
[0085] As above, when a fingertip rotation position P is known, finger joint angles P, D, and M may be calculated.
[0086] Thus, the controller (not illustrated) may estimate the movement of the finger by using the fingertip rotation position P and the finger joint angles P, D, and M.
[0087] Also, the controller (not illustrated) may control the active unit 20 to convey a desired force to the fingertip without obstructing the movement of the finger. The controller (not illustrated) may control the current of the active unit 20 by using the fingertip rotation position P and the finger joint angles P, D, and M, thereby changing and conveying the forces generated by various objects such as a hard object and a soft object.
[0088] Since the force conveyance system configured as above is mounted on the back of the hand, it may be easy to bend the finger. Also, since the force conveyance system is configured to have 6 degrees of freedom, it may not obstruct movements such as opening/closing of the hand and adduction/abduction of the finger.
MODE OF DISCLOSURE
[0089]
[0090] Referring to
[0091]
[0092] Referring to
[0093] Although the present disclosure has been described with reference to the embodiments illustrated in the drawings, this is merely an example and those of ordinary skill in the art will understand that various modifications and other equivalent embodiments may be derived therefrom. Thus, the spirit and scope of the present disclosure should be defined by the appended claims.
INDUSTRIAL APPLICABILITY
[0094] The present disclosure may be applied to a force conveyance system. Although the present disclosure has been described above with reference to example embodiments thereof, those of ordinary skill in the art will understand that various changes in form and details may be made therein without departing from the spirit and scope of the present disclosure as defined by the following claims.