ASSIST DEVICE, SWINGING JOINT DEVICE, LINEAR MOTION VARIABLE RIGIDITY UNIT, AND MACHINE TOOL
20170181917 ยท 2017-06-29
Assignee
Inventors
- Hiromichi OHTA (Kariya-shi, JP)
- Yoshitaka YOSHIMI (Okazaki-shi, JP)
- Kazuyoshi OHTSUBO (Chiryu-shi, JP)
Cpc classification
A61H3/008
HUMAN NECESSITIES
B25J13/088
PERFORMING OPERATIONS; TRANSPORTING
A61H2201/1463
HUMAN NECESSITIES
B25J9/0006
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
An assist device is connected to a moving body that performs a reciprocating swing motion. The assist device includes a first output portion configured to swing around a swing center as a center of a swing motion; a variable rigidity device including an elastic body configured to accumulate energy and release the energy in accordance with a first swinging angle as a swinging angle of the first output portion, and a rigidity varying unit configured to change an apparent rigidity of the elastic body seen from the first output portion; a first angle detecting portion configured to detect the first swinging angle; and a control device configured to adjust the apparent rigidity of the elastic body seen from the first output portion by controlling the rigidity varying unit in accordance with the first swinging angle detected by the first angle detecting portion.
Claims
1. An assist device connected to a moving body that performs a reciprocating swing motion, the assist device comprising: a first output portion configured to swing around a swing center as a center of a swing motion; a variable rigidity device including an elastic body configured to accumulate energy and release the energy in accordance with a first swinging angle as a swinging angle of the first output portion, and a rigidity varying unit configured to change an apparent rigidity of the elastic body seen from the first output portion; a first angle detecting portion configured to detect the first swinging angle; and a control device configured to adjust the apparent rigidity of the elastic body seen from the first output portion by controlling the rigidity varying unit in accordance with the first swinging angle detected by the first angle detecting portion.
2. The assist device according to claim 1, wherein: the moving body is a body of a user; the assist device further includes a body attachment member configured to be attached to the body of the user; the variable rigidity device includes a variable rigidity mechanism, and the variable rigidity mechanism includes the elastic body and is configured such that a rigidity of the variable rigidity mechanism is changed; the first output portion is an output link; a rotation central part of the output link is connected to the body attachment member at a predetermined position via the variable rigidity mechanism, the predetermined position corresponding to a hip joint of the user; a rotation free end of the output link is configured to be attached to a femoral region; the rigidity varying unit is a rigidity variable actuator configured to change an apparent rigidity of the variable rigidity mechanism seen from the output link; the first swinging angle is a swinging angle of the output link; the first angle detecting portion is an angle detecting portion configured to detect the swinging angle of the output link; the assist device further includes an input device configured to input an input value; the control device controls the rigidity variable actuator based on a detection angle detected by the angle detecting portion and the input value input by the input device; and the control device changes the apparent rigidity of the variable rigidity mechanism seen from the output link such that a load is applied to the femoral region in a reciprocating rotational motion of the femoral region around the hip joint, by controlling the rigidity variable actuator.
3. The assist device according to claim 2, wherein: the reciprocating rotational motion of the femoral region around the hip joint is a walking motion; the input device is configured to input, to the control device, a stride central angle of the femoral region in an ideal walking motion; and the control device is configured such that, when the stride central angle of the output link in an actual walking motion deviates from the stride central angle of the femoral region in the ideal walking motion, the control device increases the load applied to the femoral region in accordance with a deviation angle of the stride central angle of the output link.
4. The assist device according to claim 3, wherein: the input device is configured to input, to the control device, a maximum stride angle of the femoral region in the ideal walking motion; and when a maximum stride angle of the output link in the actual walking motion is different from the maximum stride angle of the femoral region in the ideal walking motion, the control device changes the apparent rigidity of the variable rigidity mechanism seen from the output link such that the maximum stride angle of the output link approaches the maximum stride angle of the femoral region in the ideal walking motion, by controlling the rigidity variable actuator.
5. The assist device according to claim 4, wherein: the input device is configured to input, to the control device, a gait improvement rate that determines a degree of an influence of an angular difference on a control of the apparent rigidity of the variable rigidity mechanism seen from the output link, the angular difference being a difference between the maximum stride angle of the output link and the maximum stride angle of the femoral region in the ideal walking motion.
6. The assist device according to claim 2, wherein: the input device is configured to input, to the control device, a load factor that determines a degree of the load applied to the femoral region; and the control device changes the apparent rigidity of the variable rigidity mechanism seen from the output link such that the load is applied to the femoral region based on the load factor, by controlling the rigidity variable actuator.
7. The assist device according to claim 2, wherein: the elastic body of the variable rigidity mechanism is a spiral spring provided coaxially with a rotation center of the output link; one end of the spiral spring is directly or indirectly connected to the rigidity variable actuator, and another end of the spiral spring is directly or indirectly connected to the output link; and the rigidity variable actuator changes the apparent rigidity of the variable rigidity mechanism seen from the output link by changing a rotation angle of the one end of the spiral spring.
8. The assist device according to claim 1, wherein: the moving body is a body of a user; the assist device further includes a body attachment member configured to be attached to the body of the user; the variable rigidity device includes a variable rigidity mechanism, and the variable rigidity mechanism includes the elastic body and is configured such that a rigidity of the variable rigidity mechanism is changed; the first output portion is an output link; a rotation central part of the output link is connected to the body attachment member at a predetermined position via the variable rigidity mechanism, the predetermined position corresponding to a joint of the user; a rotation free end of the output link is configured to be attached to a part of the body, the part being rotated around the joint; the rigidity varying unit is a rigidity variable actuator configured to change an apparent rigidity of the variable rigidity mechanism seen from the output link; the first swinging angle is a swinging angle of the output link; the first angle detecting portion is an angle detecting portion configured to detect the swinging angle of the output link; the assist device further includes a distance measuring portion configured to measure a distance between a position where the user receive a mass from an object and a rotation center of the output link; the control device controls the rigidity variable actuator based on a detection angle detected by the angle detecting portion and a measurement distance measured by the distance measuring portion; and the control device changes the apparent rigidity of the variable rigidity mechanism seen from the output link such that a load applied to the user is reduced, by controlling the rigidity variable actuator.
9. The assist device according to claim 8, wherein the distance measuring portion includes a first acceleration sensor configured to be attached to the position where the user receives the mass from the object, a second acceleration sensor configured to be attached to the rotation center of the output link, and a calculation portion configured to calculate a distance between the first acceleration sensor and the second acceleration sensor based on detection values of the first acceleration sensor and the second acceleration sensor.
10. The assist device according to claim 8, wherein: the elastic body of the variable rigidity mechanism is a spiral spring provided coaxially with the rotation center of the output link; one end of the spiral spring is directly or indirectly connected to the rigidity variable actuator, and another end of the spiral spring is directly or indirectly connected the output link; and the rigidity variable actuator changes the apparent rigidity of the variable rigidity mechanism seen from the output link by changing a rotation angle of the one end of the spiral spring.
11. The assist device according to claim 10, wherein a speed reducer is provided between the spiral spring and the output link, and the speed reducer is configured to maintain the swinging angle of the output link such that the swinging angle of the output link is reduced at a predetermined ratio relative to a swinging angle of the other end of the spiral spring.
12. The assist device according to claim 1, wherein: the assist device is a swinging joint device connected to the moving body that performs the reciprocating swing motion, the swinging joint device being configured to alternately repeat an energy accumulation mode and an energy release mode, the energy accumulation mode being a mode in which energy is accumulated in the elastic body by a motion of the moving body, and the energy release mode being a mode in which the energy accumulated in the elastic body is released so as to assist the motion of the moving body; the rigidity varying unit of the variable rigidity device is an apparent rigidity varying unit configured to change an apparent rigidity of the elastic body seen from the first output portion; the control device controls the apparent rigidity varying unit in accordance with the first swinging angle detected by the first angle detecting portion, so as to adjust the apparent rigidity of the elastic body seen from the first output portion; and the control device adjusts the apparent rigidity of the elastic body seen from the first output portion based on the first swinging angle and at least one of i) a gravitational force applied to the moving body in accordance with the first swinging angle, ii) an inertia force applied to the moving body in accordance with the first swinging angle and a motion state of the moving body, and iii) a central position of a reciprocating swing motion locus of the first output portion.
13. The assist device according to claim 12, wherein: the elastic body is a flat spiral spring; one end of the flat spiral spring is connected to a first output portion-side input-output shaft portion that is turned around a spring center as a center of the flat spiral spring at an angle in accordance with the first swinging angle of the first output portion; another end of the flat spiral spring is connected to a rigidity adjustment member that is turned around the spring center by a rigidity adjustment electric motor; the apparent rigidity of the elastic body is an apparent spring constant of the flat spiral spring; the apparent rigidity varying unit is constituted by the rigidity adjustment electric motor and the rigidity adjustment member; and the apparent rigidity of the elastic body seen from the first output portion is adjusted by adjusting a turning angle of the rigidity adjustment member by the rigidity adjustment electric motor.
14. The assist device according to claim 12, wherein: in a case where the apparent rigidity of the elastic body seen from the first output portion is adjusted based on the gravitational force and the first swinging angle, the control device adjusts the apparent rigidity of the elastic body seen from the first output portion based on a moving body mass that is a mass of the moving body including the first output portion, a moving body gravity center distance that is a distance from the swing center to a gravity center of the moving body including the first output portion, an angular frequency of swinging, gravitational acceleration, and the first swinging angle.
15. The assist device according to claim 12, wherein: the moving body includes a femoral region of a body of a user from a hip joint to a knee, and a lower leg below the knee; the lower leg swings relative to the femoral region around a knee center that is a knee joint; the first output portion is connected to the femoral region; a second output portion swingable relative to the first output portion around the knee center is connected to the first output portion at a position corresponding to the knee center; the second output portion is connected to the lower leg and includes a second angle detecting portion configured to detect a second swinging angle, the second swinging angle being a swinging angle of the second output portion relative to the first output portion; and in a case where the apparent rigidity of the elastic body seen from the first output portion is adjusted based on the gravitational force, the inertia force, and the first swinging angle, the control device adjusts the apparent rigidity of the elastic body seen from the first output portion based on i) a femoral region mass that is a mass of the femoral region including the first output portion, ii) a femoral region length that is a distance from the swing center to the knee center; iii) a femoral region gravity center distance that is a distance from the swing center to a gravity center of the femoral region including the first output portion; iv) a lower leg mass that is a mass of the lower leg including the second output portion; v) a lower leg length that is a distance from the knee center as one end of the lower leg to another end of the lower leg; vi) a lower leg gravity center distance that is a distance from the knee center to a gravity center of the lower leg including the second output portion; vii) an angular frequency of swinging of the first output portion; viii) gravitational acceleration; ix) the first swinging angle; and x) the second swinging angle.
16. The assist device according to claim 12, wherein: in a case where the apparent rigidity of the elastic body seen from the first output portion is adjusted based on the gravitational force, the central position, and the first swinging angle, the control device adjusts the apparent rigidity of the elastic body seen from the first output portion based on i) a moving body mass that is a mass of the moving body including the first output portion; ii) a moving body gravity center distance that is a distance from the swing center to a gravity center of the moving body including the first output portion; iii) an angular frequency of swinging; iv) gravitational acceleration; v) a central angle that is an angle formed between a gravitational acceleration direction and a virtual straight line connecting the swing center to the central position; and vi) the first swinging angle.
17. A linear motion variable rigidity unit comprising: a linear motion-rotation conversion mechanism including a linear-motion input-output portion and a rotational motion input-output portion; a variable rigidity mechanism including an elastic body connected to the rotational motion input-output portion; a rigidity variable actuator connected to the variable rigidity mechanism; a control device configured to control the rigidity variable actuator; and a support member configured to support the linear motion-rotation conversion mechanism, the variable rigidity mechanism, and the rigidity variable actuator, wherein: the linear-motion input-output portion is connected to a linear reciprocating body that linearly reciprocates; the linear motion-rotation conversion mechanism performs an energy accumulation operation that converts a linear reciprocating motion input from the linear-motion input-output portion to a rotational reciprocating motion so as to output the rotational reciprocating motion from the rotational motion input-output portion, and an energy release operation that converts the rotational reciprocating motion input from the rotational motion input-output portion to the linear reciprocating motion so as to output the linear reciprocating motion from the linear-motion input-output portion; in a case where the linear motion-rotation conversion mechanism performs the energy accumulation operation, the elastic body in the variable rigidity mechanism accumulates input energy that is input from the rotational motion input-output portion via the linear-motion input-output portion, the input energy being energy from the linear reciprocating body; and in a case where the linear motion-rotation conversion mechanism performs the energy release operation, the elastic body releases accumulated energy that is energy accumulated in the elastic body, toward the linear reciprocating body via the rotational motion input-output portion and the linear-motion input-output portion; and the rigidity variable actuator changes a rigidity of the elastic body of the variable rigidity mechanism seen from the linear motion-rotation conversion mechanism.
18. The linear motion variable rigidity unit according to claim 17, wherein: the elastic body is a spiral spring; one end of the spiral spring is connected to the rotational motion input-output portion and another end of the spiral spring is connected to the rigidity variable actuator; and the rigidity variable actuator is configured to turn the spiral spring around a central axis of the spiral spring so as to change an apparent spring constant seen from the linear motion-rotation conversion mechanism, the apparent spring constant being a rigidity of the spiral spring seen from the linear motion-rotation conversion mechanism.
19. The linear motion variable rigidity unit according to claim 18, wherein: the control device changes the apparent spring constant in real time by controlling the rigidity variable actuator to reduce drive energy that causes the linear reciprocating body to linearly reciprocate, based on a mass of the linear reciprocating body, an angular frequency at which the rotational motion input-output portion rotates in a reciprocating manner, and a current rotation angle of the rotational motion input-output portion.
20. A machine tool comprising: the linear motion variable rigidity unit according to claim 17; a reciprocation table as the linear reciprocating body that linearly reciprocates at a predetermined frequency; and a table drive device configured to cause the reciprocation table to linearly reciprocate, wherein the linear motion variable rigidity unit is attached to the reciprocation table.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0058] Features, advantages, and technical and industrial significance of exemplary embodiments of the disclosure will be described below with reference to the accompanying drawings, in which like numerals denote like elements, and wherein:
[0059]
[0060]
[0061]
[0062]
[0063]
[0064]
[0065]
[0066]
[0067]
[0068]
[0069]
[0070]
[0071]
[0072]
[0073]
[0074]
[0075]
[0076]
[0077]
[0078]
[0079]
[0080]
[0081]
[0082]
[0083]
[0084]
[0085]
[0086]
[0087]
[0088]
[0089]
[0090]
[0091]
[0092]
[0093]
[0094]
[0095]
[0096]
[0097]
[0098]
[0099]
[0100]
[0101]
[0102]
[0103]
[0104]
[0105]
[0106]
[0107]
[0108]
[0109]
[0110]
[0111]
[0112]
[0113]
[0114]
DETAILED DESCRIPTION OF EMBODIMENTS
[0115] The following describes an assist device 10 according to Embodiment 1 of the disclosure based on
[0116] As illustrated in
[0117] As illustrated in
[0118] Further, as illustrated in
[0119] As illustrated in
[0120] The variable rigidity mechanism 20 is a mechanism configured such that an apparent rigidity thereof seen from the output link 30 can be changed, and includes an input portion 22, a spiral spring 24, and a speed reducer 26 as illustrated in
[0121] As illustrated in
[0122] The speed reducer 26 is a member configured to amplify a rotating torque caused due to the spring force of the spiral spring 24, and transmit the amplified rotating torque to the output link 30. The speed reducer 26 includes the input rotating shaft 26e, the output rotating shaft 26p, a gear mechanism (not shown) provided between the input rotating shaft 26e and the output rotating shaft 26p, and the like. The input rotating shaft 26e and the output rotating shaft 26p of the speed reducer 26 are maintained coaxially, and when the input rotating shaft 26e rotates n times, the output rotating shaft 26p rotates once. Further, a torque transfer efficiency of the speed reducer 26 is set to .
[0123] A positioning hole 26u to which a rotation center pin (not shown) of the output link 30 is fitted is formed in a center of the output rotating shaft 26p of the speed reducer 26 as illustrated in
[0124] As illustrated in
[0125] As illustrated in
[0126] Further, as illustrated in
[0127] Further, the input device 44 is configured to input a gait improvement rate to the controller unit 52. The gait improvement rate is a coefficient multiplied by a difference (A.sub.hA.sub.I) between an actual maximum stride angle A.sub.h of the femoral region (a maximum stride angle A.sub.h of the output link 30) and the ideal maximum stride angle A.sub.I (see
[0128] The amplitude correction gain is expressed as =({1(A.sub.hA.sub.I)A.sub.h}, and is used for calculating the assist torque (described later) applied to the output link 30. For example, at the time of the gait improvement rate =0, the walk improvement relative to the difference (A.sub.hA.sub.I) in the maximum stride angle is not performed, and the amplitude correction gain =1 is obtained. Further, at the time of the gait improvement rate =1, the maximum walk improvement relative to the angular difference (A.sub.hA.sub.I) in the maximum stride angle is performed, and the amplitude correction gain =A.sub.I+A.sub.h is obtained.
[0129] The controller unit 52 controls a rotation angle .sub.1 of the motor 40 based on the detection value of the angle detector 43 and the input value from the input device 44 at the time of the walking motion of the user (described later). When the rotating shaft 41 of the motor 40 rotates by an angle .sub.1, the outer-peripheral-side spring end portion 24e of the spiral spring 24 of the variable rigidity mechanism 20 also rotates by the angle .sub.1, as illustrated in
[0130] Next will be described an operation of the assist device 10 based on a flowchart of
[0131] Before walking, a gait improvement rate is set first (step S101), and the gait improvement rate is input into the controller unit 52 from the input device 44 (step S102). Then, when a user starts walking (step S103), a signal of the angle detector 43 that detects a swinging angle of the output link 30 is input into the controller unit 52 (step S104). Thus, as illustrated in
[0132] Subsequently, with reference to
[0133] Further, a torque caused due to an inertia moment J around the hip joint is expressed as a value shown in Expression 1.
J{umlaut over ()}Expression 1
A torque caused due to a viscosity d around the hip joint is expressed as a value shown in Expression 2.
{umlaut over (d)}Expression 2
Therefore, a motion torque .sub.H required at the time when the femoral region and the output link 30 rotate upward by the angle is expressed as Expression 3.
.sub.H=J{umlaut over ()}+d{umlaut over ()}+k.sub.R+mgL sin Expression 3
[0134] Here, when the angle is small, sine in Expression 3 is expressed as shown in Expression 4.
sin Expression 4
Therefore, when a value of Expression 4 is substituted into Expression 3 so as to transform Expression 3, the torque .sub.H is expressed as an expression shown in Expression 5.
.sub.H=J{umlaut over ()}+d{dot over ()}+(k.sub.R+mgL)Expression 5
[0135] Here, the angle (hereinafter referred to as the angle of the output link 30) of the femoral region and the output link 30 at the time when the user performs the walking motion can be approximated to a sine curve as illustrated in
[0136] Here, as illustrated in
[0137] When the angle .sub.1 of the femoral region in the ideal walking motion, i.e., .sub.1=A.sub.Isin t, is substituted into Expression 5, a motion torque .sub.S of the leg in an ideal walking state is obtained. That is, the motion torque .sub.S is expressed as follows:
.sub.S=A.sub.IJ.sup.2sin t+A.sub.Idcos t+A.sub.1(k.sub.R+mgL)sin t
When this expression is transformed, the following expression is obtained:
.sub.S=A.sub.I(k.sub.R+mgLJ.sup.2)sin t+A.sub.Idcos t
Thus, when the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is adjusted so as to be J.sup.2mgL, the motion torque .sub.S of the leg in the ideal walking state satisfies .sub.S=A.sub.Idcos t, so that a load applied to the femoral region is minimized.
[0138] Subsequently, an angle of the output link 30 at the time when the user actually performs a walking motion, namely, =A.sub.hsin t+.sub.e=(A.sub.I+A.sub.e)sin t+.sub.e is substituted into Expression 5, a motion torque .sub.H of the leg in an actual walking state is obtained as follows:
.sub.H=(A.sub.I+A.sub.e)J.sup.2sin t+(A.sub.I+A.sub.e)dcos t+(k.sub.R+mgL){(A.sub.I+A.sub.e)sin t+.sub.e}
When this expression is transformed, the following expression is obtained:
.sub.H=(A.sub.I+A.sub.e)(k.sub.R+mgLJ)sin t+(A.sub.I+A.sub.e)dcos t+(k.sub.R+mgL).sub.e
Here, when the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is adjusted so as to be J.sup.2mgL, the motion torque .sub.H of the leg in the actual walking state satisfies .sub.H=(A.sub.I+A.sub.e)dcos t+(k.sub.R+mgL).sub.e, so that a load applied to the femoral region is minimized.
[0139] Further, as described above, the motion torque .sub.s of the leg in the ideal walking state is expressed as .sub.S=A.sub.Idcos t, and thus, the motion torque .sub.H of the leg in the actual walking state is expressed with the motion torque .sub.S of the leg in the ideal walking state as follows:
.sub.H=.sub.S+A.sub.edcos t+(k.sub.R+mgL).sub.e
Here, A.sub.edcos t is a very small value and can be regarded as substantially zero. Thus, the motion torque .sub.H of the leg in the actual walking state is expressed as .sub.H=.sub.S+(k.sub.R+mgL).sub.e. Thus, even when the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is adjusted to J.sup.2mgL, the motion torque .sub.H of the leg in the actual walking state is a value larger than the motion torque .sub.s of the leg in the ideal walking state by (k.sub.R+mgL).sub.e.
[0140] That is, when the stride central angle .sub.e of the output link 30 in the actual walking motion state deviates from the stride central angle .sub.0(.sub.0=0) in the ideal walking state by the angle .sub.e as illustrated in
[0141] Next will be described a procedure for expressing the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 (hereinafter referred to as the apparent rigidity k.sub.R) with the use of the spring constant k.sub.1 of the spiral spring 24 and the rotation angle .sub.1 of the motor 40. As illustrated in
[0142] Now a case is assumed where a neutral point of the variable rigidity mechanism 20 (the spiral spring 24) seen from a motor 40-side is rotated by the motor 40 by an angle .sub.1. In this case, a torque .sub.1 applied to the input rotating shaft 26e of the speed reducer 26 in a state where the output link 30 and the like rotate by an angle is expressed as .sub.1=k.sub.1(n.sub.1). Therefore, an assist torque .sub.1 applied to the output rotating shaft 26p of the speed reducer 26 can be expressed as =n.sub.1=nk.sub.1(n.sub.1)=n.sup.2k.sub.1(1.sub.1/n). Accordingly, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is expressed as k.sub.R=n.sup.2k.sub.1(1.sub.1/n). That is, by controlling the rotation angle .sub.1 of motor 40, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 can be changed, and thus, the assist torque can be controlled.
[0143] Next will be described a method for performing walk improvement with the use of the gait improvement rate and the amplitude correction gain . Here, the amplitude correction gain is expressed as =({1(A.sub.hA.sub.I)A.sub.h} as described above. The amplitude correction gain is used in an expression for obtaining the apparent rigidity k.sub.R of the variable rigidity mechanism 20. That is, with the use of the amplitude correction gain , the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is expressed as k.sub.R=n.sup.2k.sub.1(1.sub.1/n ). Therefore, in a case of the gait improvement rate =1, for example, the rigidity k.sub.R is expressed as k.sub.R=n.sup.2k.sub.1(1.sub.1/(A.sub.IA.sub.h) n) . . . Expression (1). Note that Expression (1) is different from Expression 1 described above. Accordingly, as illustrated in
[0144] Further, when the maximum stride angle A.sub.I at the time of the ideal walking is smaller than the maximum stride angle A.sub.h at the time of the actual walking, the value in the parentheses of Expression (1) is small and the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is small. Therefore, the assist torque =k.sub.R is adjusted to decrease, so that the maximum stride angle A.sub.h at the time of the actual walking is decreased naturally. Further, for example, at the time of the gait improvement rate =0, the amplitude correction gain =1 is obtained, so that the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is expressed as n.sup.2k.sub.1(1.sub.1/n). Therefore, walk improvement based on an angular difference between the maximum stride angle A.sub.I at the time of the ideal walking and the maximum stride angle A.sub.h at the time of the actual walking is not performed. Further, by changing the gait improvement rate between 0 and 1, it is possible to adjust the degree of the walk improvement based on the angular difference between the maximum stride angle A.sub.I, at the time of the ideal walking and the maximum stride angle A.sub.h at the time of the actual walking.
[0145] Here, the present embodiment describes the motion of one leg at the time of the walking motion. However, phases of motions of right and left legs are shifted from each other by 180 degrees, and the motions of the legs can be regarded as the same.
[0146] In the assist device 10, the controller unit 52 (the control device) controls the motor 40 (the rigidity variable actuator) based on a detection angle detected by the angle detector 43 (the angle detecting portion) and an input value input from the input device 44 (the input device). The controller unit 52 changes the apparent rigidity k.sub.R of the variable rigidity mechanism 20 such that a predetermined load is applied to the femoral region, by controlling the motor 40. Thus, the assist torque applied to the output link 30 is controlled. This makes it possible to reduce power consumption in comparison with a conventional assist device that applies a rotating torque of a motor in a rotation direction of an output link.
[0147] Further, when the stride central angle .sub.e of the output link 30 in the actual walking motion deviates from the ideal stride central angle .sub.0 (.sub.0=0) of the femoral region in the walking motion, the controller unit 52 can increase the load applied to the femoral region in accordance with the deviation angle .sub.e. In general, at the time of walking, a user walks unconsciously such that a load applied to the femora region becomes small. Because of this, the user walks such that the stride central angle .sub.e of the output link approaches the ideal stride central angle .sub.0 (.sub.0=0) of the femoral region. That is, a walk of the user approaches an ideal walk, so that walk improvement is achieved.
[0148] Further, the input device 44 is configured to input the maximum stride angle A.sub.I of the femoral region in the ideal walking motion to the controller unit 52. The controller unit 52 changes the apparent rigidity k.sub.R of the variable rigidity mechanism 20 such that the maximum stride angle A.sub.h of the output link 30 in the actual walking motion approaches the ideal maximum stride angle A.sub.I, by controlling the motor 40. Therefore, the walk of the user approaches an ideal walk, and thus, walk improvement is achieved. Further, since the gait improvement rate s can be input into the controller unit 52, it is possible to adjust the walk improvement in accordance with a condition of a body of the user such that the walk improvement is performed immediately or the walk improvement is performed gently.
[0149] Next will be described an assist device 10 according to Embodiment 2 of the disclosure based on
[0150] First, a load factor is set before walking (step S121 in
[0151] Next will be described a procedure for obtaining the apparent rigidity k.sub.R of the variable rigidity mechanism 20 with the use of the load factor . As illustrated in
.sub.H=J{umlaut over ()}+d{dot over ()}+(k.sub.R+mgL)Expression 6
Further, a swinging angle of the output link 30 in the actual walking motion is assumed based on
[0152] When the swinging angle of the output link 30 is substituted into Expression 6, the motion torque .sub.H of the leg in an actual walking state is as follows:
.sub.H=A.sub.hJ.sup.2sin t+A.sub.hdcos t+A.sub.h(k.sub.R+mgL)sin t
When this expression is transformed, the following expression is obtained:
.sub.H=A.sub.h(k.sub.R+mgLJ.sup.2)sin t+A.sub.hdcos t
Subsequently, a target motion torque of the leg in the actual walking state is assumed to be .sub.H0, and the target motion torque .sub.H0 is expressed with the use of the load factor as follows. That is, the target motion torque .sub.H0 is expressed as .sub.H0=A.sub.h(mgLJ.sup.2)sin t+A.sub.hdcos t. When the motion torque .sub.H of the leg in the actual walking state is set to be equal to the target motion torque .sub.H0, A.sub.h(k.sub.R+mgLJ.sup.2)=A.sub.h(mgLJ.sup.2) is obtained. When this expression is transformed, the following is obtained: k.sub.R=(1)(mgLJ.sup.2) . . . Expression (2).
Note that Expression (2) is different from Expression 2 described above.
[0153] Here, for example, a case of the load factor =0 is assumed. In this case, when =0 is substituted into Expression (2), k.sub.R=(mgLJ.sup.2) is obtained. When this expression is substituted into the expression of the motion torque .sub.H of the leg in the actual walking state, that is, .sub.H=A.sub.h(k.sub.R+mgLJ.sup.2)sin t+A.sub.hdcos t, .sub.H=A.sub.hdcos t is obtained, and thus, the motion torque .sub.H of the leg in the actual walking state is minimized. That is, the load applied to the femoral region is reduced due to an action of the variable rigidity mechanism 20. Subsequently, in a case of the load factor =1, when =1 is substituted into Expression (2), k.sub.R=0 is obtained. That is, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is zero, which causes a state where the variable rigidity mechanism 20 does not operate. In this case, the motion torque .sub.H of the leg is expressed as .sub.H=A.sub.h(mgLJ.sup.2)sin t+A.sub.hdcos t. That is, the motion torque .sub.H of the leg is larger than the motion torque .sub.H at the minimum by A.sub.h(mgLJ.sup.2)sin t, and thus, the load applied to the femoral region is increased.
[0154] Subsequently, in a case of the load factor =2, when =2 is substituted into Expression (2), k.sub.R=(mgLJ.sup.2) is obtained. In this case, the motion torque of the leg is expressed as .sub.H=A.sub.h2(mgLJ.sup.2)sin t+A.sub.hdcos t. That is, the motion torque .sub.H of the leg is larger than the motion torque TH at the minimum by A.sub.h2(mgLJ.sup.2)sin t, and thus, the load applied to the femoral region is further increased due to the operation of the variable rigidity mechanism 20. That is, by setting the load factor appropriately, it is possible to adjust the degree of the load applied to the femoral region in the walking training or the like.
[0155] Here, as described in Embodiment 1, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 can be expressed with the spring constant k.sub.1 of the spiral spring 24 of the variable rigidity mechanism 20 and the rotation angle .sub.1 of the motor 40. That is, the apparent rigidity k.sub.R can be expressed as k.sub.R=n.sup.2k.sub.1(1.sub.1/n). Therefore, when the rotation angle .sub.1 of the motor 40 is controlled so as to satisfy .sub.1=(nk.sub.R/nk.sub.1), the apparent rigidity k.sub.R can be adjusted to control the assist torque (=k.sub.R) applied to the output link 30.
[0156] Here, the disclosure is not limited to the above embodiments, and various modifications can be made without departing from the scope of the disclosure. For example, the present embodiments deal with an example in which the assist device 10 is used for the walk improvement or the walking training. However, the assist device 10 can be used for other trainings such as a squat training. Further, the present embodiments deal with an example in which the spiral spring 24 is used as an elastic body of the variable rigidity mechanism 20. However, instead of the spiral spring 24, a coiled spring can be used or a rubbery elastic body can be used. Further, the present embodiments deal with an example in which the speed reducer 26 is used in the variable rigidity mechanism 20, but the speed reducer 26 can be omitted depending on strength of the spring. Further, the present embodiments deal with an example in which the variable rigidity mechanisms 20 and the output links 30 are provided on right and left sides, but they may be provided only on one side depending on a type of the training.
[0157] The following describes an assist device 10 according to Embodiment 3 of the disclosure based on
[0158] As illustrated in
[0159] As illustrated in
[0160] Further, as illustrated in
[0161] As illustrated in
[0162] The variable rigidity mechanism 20 is a mechanism configured such that an apparent rigidity thereof seen from the output link 30 can be changed, and the variable rigidity mechanism 20 includes an input portion 22, a spiral spring 24, and a speed reducer 26 as illustrated in
[0163] As illustrated in
[0164] The speed reducer 26 is a member configured to amplify a rotating torque caused due to the spring force of the spiral spring 24, and to transmit the amplified rotating torque to the output link 30. The speed reducer 26 includes the input rotating shaft 26e, the output rotating shaft 26p, a gear mechanism (not shown) provided between the input rotating shaft 26e and the output rotating shaft 26p, and the like. The input rotating shaft 26e and the output rotating shaft 26p of the speed reducer 26 are maintained coaxially, and when the input rotating shaft 26e rotates n times, the output rotating shaft 26p rotates once. Further, a torque transfer efficiency of the speed reducer 26 is set to .
[0165] A positioning hole 26u to which a rotation center pin (not shown) of the output link 30 is fitted is formed in a center of the output rotating shaft 26p of the speed reducer 26 as illustrated in
[0166] As illustrated in
[0167] As illustrated in
[0168] The controller unit 52 controls a rotation angle .sub.1 of the motor 40 based on values of the distance L between the rotation central part of the output link 30 and the wrist, the swinging angle of the output link 30, the mass mw of the burden W, and the like such that a work load of the user is minimized. When the rotating shaft 41 of the motor 40 rotates by an angle .sub.1, the outer-peripheral-side spring end portion 24e of the spiral spring 24 of the variable rigidity mechanism 20 also rotates by the angle .sub.1, as illustrated in
[0169] That is, the controller unit 52 may be regarded as a control device of the disclosure, and the motor 40 may be regarded as a rigidity variable actuator of the disclosure. Further, the first acceleration sensor 744, the second acceleration sensor 46, and the controller unit 52 may be regarded as a distance measuring portion of the disclosure, and the controller unit 52 may be regarded as a calculation portion in the distance measuring portion of the disclosure.
[0170] Next will be described a procedure for calculating the rotation angle .sub.1 of the motor 40 in the assist device 10. Here, a program for calculating the rotation angle .sub.1 of the motor 40 is stored in a memory (not shown) of the controller unit 52. As illustrated in
L=x.sub.1x2={umlaut over (x)}.sub.1dt{umlaut over (x)}.sub.2dtExpression 7
[0171] Next will be described a procedure for obtaining a virtual mass m.sub.h of the upper arm and the forearm to be intensively applied to a position of the wrist, as a preparation for calculation of the rotation angle .sub.1 of the motor 40. As illustrated in
[0172] Next will be described a procedure for obtaining a mass mw of the burden W from the load current I of the motor 40. When a torque constant is , a generated torque .sub.M of the motor is expressed as .sub.M=torque constant load current I. Further, a generated torque .sub.M of the motor at the time of lifting the burden W is expressed as a sum of a rotating torque To for lifting the arm, expressed as .sub.G=(virtual mass m.sub.hgtorque radius L), and a rotating torque .sub.W for lifting the burden W, expressed as .sub.W=(mass m.sub.Wg of burden Wtorque radius L). Therefore, (rotating torque .sub.W for lifting burden W)=(generated torque .sub.M of motor)(rotating torque .sub.G for lifting arm) is obtained. That is, (mass m.sub.Wg of burden Wtorque radius L)=(torque constantload current I)(virtual mass m.sub.hgtorque radius L) is obtained. Accordingly, the mass m.sub.W of the burden W is expressed as m.sub.W=(Im.sub.hgL)L. Further, a mass m intensively applied to the wrist is expressed as m=(virtual mass m.sub.h+mass mw of burden W).
[0173] Next will be described a procedure for obtaining an inertia moment J at the time when the upper arm having a mass m.sub.1 and the forearm having a mass m.sub.2 are rotated around the shoulder joint. A distance from the shoulder joint of the upper arm to the gravity center is assumed to be of the length L.sub.1 of the upper arm. Similarly, a distance from the elbow joint of the forearm to the gravity center is assumed to be of the length L.sub.2 of the forearm. In this case, coordinates of the gravity center of the upper arm, with a center of the shoulder joint serving as an origin, are as follows: L.sub.1g=(L.sub.1gx,L.sub.1gy)=(L.sub.1sin , L.sub.1cos ) Here, L.sub.1, is a distance from the center of the shoulder joint (the origin) to the gravity center of the upper arm. Further, coordinates of the gravity center of the forearm, with the center of the shoulder joint serving as an origin, are as follows:
L.sub.2g=(L.sub.2gx,L.sub.2gy)=(L.sub.1sin +L.sub.2sin .sub.2,L.sub.1cos +L.sub.2cos .sub.2)
Here, L.sub.2g is a distance from the center of the shoulder joint (the origin) to the gravity center of the forearm.
[0174] Coordinates of a gravity center of a whole arm are expressed with the coordinates of the gravity center of the upper arm and the coordinates of the gravity center of the forearm as follows. That is, the coordinates of the gravity center of the whole arm are expressed as L=(L.sub.gx, L.sub.gy)=((m.sub.1L.sub.1gx+m.sub.2L.sub.2p)/(m.sub.1+m.sub.2), (m.sub.1L.sub.1gy+m.sub.2L.sub.2gy)/(m.sub.1+m.sub.2)). Here, |L.sub.g| is obtained as a distance from the center of the shoulder joint (the origin) to the gravity center of the whole arm according to Expression 8.
L={square root over (L.sub.gx.sup.2+L.sub.gy.sup.2)}Expression 8
When it is assumed that a uniform rod having a mass (m.sub.1+m.sub.2) is rotated, the inertia moment J around the shoulder joint is expressed as the following expression according to the parallel axis theorem.
Inertia Moment J= 1/12(m.sub.1+m.sub.2)(2|L|).sup.2+(m.sub.1+m.sub.2)(|L.sub.g|).sup.2
[0175] Next will be described a procedure for calculating the rotation angle .sub.1 of the motor 40 more specifically, based on
[0176] A torque caused due to the inertia moment J around the shoulder joint is a value shown in Expression 9.
J{umlaut over ()}Expression 9
Further, when a viscosity of the user in a rotating operation is d, a torque caused due to the viscosity d is a value shown in Expression 10.
d{dot over ()}Expression 10
Further, as illustrated in
T=J{umlaut over ()}+d{dot over ()}+k.sub.R(.sub.0)+mgL.sub.0 sin Expression 11
[0177] Then, a sum total of energy E of a system is obtained. First, energy caused due to the inertia moment J is expressed as Expression 12.
J{dot over ()}.sup.2Expression 12
Further, elastic energy of the variable rigidity mechanism 20 is expressed as k.sub.R(.sub.0).sup.2. Further, potential energy is expressed as mgL.sub.0(1cos ). Therefore, the sum total of the energy E of the system is expressed by Expression 13.
E=J{dot over ()}2+k.sub.R(.sub.0).sup.2+mgL.sub.0(1cos )Expression 13
[0178] Subsequently, a condition for minimizing the energy E of the system is obtained. The condition for minimizing the energy E of the system is a condition that a value obtained by differentiating the energy E with respect to time is zero. Therefore, an expression shown in Expression 13 is differentiated. When Expression 13 is differentiated, Expression 14 is obtained.
Thus, the condition for minimizing the energy E of the system is as shown in Expression 15.
J{umlaut over ()}+k.sub.R(.sub.0)+mgL.sub.0 sin =Expression 15
When Expression 15 is transformed to obtain a neutral point .sub.0 of the output rotating shaft 26p of the variable rigidity mechanism 20, Expression 16 is obtained.
That is, by adjusting the neutral point .sub.0 to the angle shown in Expression 16, the energy E of the system can be minimized. That is, a work load of the user can be minimized.
[0179] Next will be described a procedure for expressing the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 (hereinafter referred to as the apparent rigidity k.sub.R) with the use of an actual spring constant k.sub.1 of the spiral spring 24. Here, the calculation is performed first, assuming that the neutral point .sub.0 is held at an origin (.sub.0=0). As illustrated in
[0180] Now a case is assumed where a neutral point of the variable rigidity mechanism 20 (the spiral spring 24) seen from a motor 40-side is rotated by the motor 40 by an angle .sub.1. In this case, a torque .sub.1 applied to the input rotating shaft 26e of the speed reducer 26 in a state where the output link 30 and the like rotate by an angle can be expressed as .sub.1=k.sub.1(n+.sub.1). Therefore, an assist torque t applied to the output rotating shaft 26p of the speed reducer 26 can be expressed as =nk.sub.1(n+.sub.1)=n.sup.2k.sub.1(1+.sub.1/n). Accordingly, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is expressed as k.sub.R=n.sup.2k.sub.1(1+.sub.1/n). That is, by controlling the rotation angle .sub.1 of the motor 40, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 can be changed, and thus, the assist torque can be controlled.
[0181] As described above, since the neutral point of the variable rigidity mechanism 20 seen from the motor 40-side is moved by the angle .sub.1, the neutral point .sub.0 of the output rotating shaft 26p of the variable rigidity mechanism 20 is expressed as .sub.1=n.sub.0. When the expression is substituted into the expression of the apparent rigidity k.sub.R, k.sub.R=n.sup.2k.sub.1(1+.sub.0/) is obtained. When this expression is substituted into Expression 16, Expression 17 is obtained as follows.
[0182] Then, when both sides of Expression 17 are multiplied by .sub.0 and transformed, Expression 18 is obtained.
[0183] Further, when Expression 18 is transformed, Expression 19 is obtained.
[0184] Here, as described above, L.sub.0 indicates the linear distance from the rotation center C of the output link 30 to the wrist (the first acceleration sensor 744). Therefore, L.sub.0sin is equal to a torque radius L obtained from the first acceleration sensor 744 at the wrist and the second acceleration sensor 46 of the output link 30. Accordingly, when L.sub.0sin of Expression 19 is replaced with L, an expression shown as Expression 20 is obtained.
[0185] Here, a neutral point .sub.1 of the spiral spring 24 of the variable rigidity mechanism 20 seen from the motor 40-side is expressed as n.sub.0, and thus, Expression 20 can be rewritten as shown in Expression 21.
The controller unit 52 of the assist device 10 controls the rotation angle of the motor 40 to .sub.1. Thus, the outer-peripheral-side spring end portion 24e of the spiral spring 24 of the variable rigidity mechanism 20 rotates so as to have the angle .sub.1. As a result, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is adjusted such that the energy E of the system is minimized, and thus, the assist torque applied to the output link 30 from the output rotating shaft 26p of the variable rigidity mechanism 20 is controlled. That is, when the user lifts the burden W, the assist torque of the variable rigidity mechanism 20 is applied to the output link 30 in a direction where the upper arm is lifted up. Thus, a work load of the user is reduced.
[0186] In the assist device 10, the controller unit 52 (the control device) controls the motor 40 (the rigidity variable actuator) based on the swinging angle of the output link 30 and the distance L (the torque radius L) between the rotation center C of the output link 30 and a position where the user receives the mass of the burden W. Further, the controller unit 52 changes the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 such that a load applied to the user is minimized, by controlling the motor 40. That is, the controller unit 52 can change the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 by the motor 40 during an operation of the assist device 10. Therefore, in comparison with a conventional assist device in which a rigidity of an elastic body is manually adjusted, it is possible to perform an assists operation with high efficiency. Further, since the apparent rigidity k.sub.R of the variable rigidity mechanism 20 is controlled so as to control the assist torque applied to the output link 30, it is possible to reduce power consumption in comparison with a conventional assist device that applies a rotating torque of a motor in a rotation direction of an output link.
[0187] Further, the torque radius L is calculated with the use of the first acceleration sensor 744 and the second acceleration sensor 46, and thus, it is possible to measure the torque radius L continuously during the assist operation. Further, since the apparent rigidity of the variable rigidity mechanism 20 seen from the output link 30 is changed by changing the rotation angle of the outer-peripheral-side spring end portion 24e of the spiral spring 24, it is possible to relatively easily perform a control that changes the rigidity of the variable rigidity mechanism 20.
[0188] Next will be described an assist device 60 according to Embodiment 4 based on
[0189] Similarly to the case of the assist device 10 according to Embodiment 3, the assist device 60 according to Embodiment 4 calculates a torque radius L from x-components of detection values of the first acceleration sensor 744 and the second acceleration sensor 46. Further, a mass me intensively applied to a position of a wrist, that is, m.sub.B=(virtual mass m.sub.h+mass m.sub.W of burden W) is obtained, and an inertia moment J.sub.B around the hip joint is calculated.
[0190] First described is a procedure for obtaining a virtual mass m.sub.h. As illustrated in
L.sub.4=({umlaut over (x)}.sub.1dt{umlaut over (x)}.sub.2dt).sup.2+(.sub.1dt.sub.2dt).sup.2Expression 22
[0191] Further, .sub.1 is obtained from a value of the angle detector 43 at the hip joint. Further, .sub.2 is a rotation angle of the hip joint with respect to an xy coordinate system, and is obtained according to Expression 23 with the use of an angular acceleration component of the second acceleration sensor 46 around a z-axis.
.sub.2={umlaut over ()}.sub.2.sup.dtExpression 23
Further, .sub.3 is obtained according to Expression 24 with the use of the x-component and the y-component of the first acceleration sensor 744, and the x-component and the y-component of the second acceleration sensor 46.
[0192] Further, .sub.1 is obtained according to Expression 25 with the use of .sub.1, .sub.2, and .sub.3.
[0193] When the theorem of cosines is applied to a triangle ABD, a length a of a line segment BD is obtained according to Expression 26.
a=L.sub.3.sup.2+L.sub.4.sup.22L.sub.3L.sub.4 cos .sub.1Expression 26
Further, when the theorem of cosines is applied to a triangle BCD, .sub.2 and .sub.3 are obtained according to Expression 27.
[0194] Then, when the theorem of sine is applied to the triangle ABD, .sub.1 and .sub.3 are obtained according to Expression 28.
When a distance from the hip joint to a gravity center is assumed L.sub.3g, a torque .sub.3 generated in the hip joint due to a mass m.sub.3 of an upper body including a head is obtained according to Expression 29.
.sub.3=m.sub.3gL.sub.3g cos(.sub.1+.sub.3)=m.sub.3gL.sub.3L.sub.3=L.sub.3g cos(.sub.1+.sub.3)Expression 29
[0195] A torque generated in the hip joint due to a mass of an upper arm is obtained according to Expression 30.
.sub.1=m.sub.1gL.sub.3 cos(.sub.1+.sub.3)+L.sub.1g cos {.sub.1+.sub.3(.sub.2)}=m.sub.1gL.sub.1L.sub.1=L.sub.3 cos(.sub.1+.sub.3)+L.sub.1g cos {.sub.1+.sub.3(.sub.2)}Expression 30
Further, a torque .sub.2 generated in the hip joint due to a mass of a forearm is obtained according to Expression 31.
.sub.2=m.sub.2gL.sub.3 cos(.sub.1+.sub.3)+L.sub.1 cos {.sub.1+.sub.3(.sub.2)}+L.sub.2g cos {.sub.1+.sub.3(.sub.2)+((.sub.1+.sub.2+.sub.3))}=m.sub.2gL.sub.2L.sub.2=L.sub.3 cos(.sub.1+.sub.3)+L.sub.1 cos {.sub.1+.sub.3(.sub.2)}+L.sub.2g cos {.sub.1+.sub.3(.sub.2)+((.sub.1+.sub.2+.sub.3))}Expression 31
[0196] Thus, when the torques generated by the upper body, the upper arm, and the forearm are assumed to be equal to a torque generated by a virtual mass m.sub.h at the time when it is assumed that a mass concentrates on a wrist portion, the virtual mass m.sub.h is obtained according to Expression 32.
[0197] Next will be described a procedure for obtaining an inertia moment J.sub.B around the hip joint. When rotation angles of the hip joint, the shoulder joint, and the elbow joint relative to the x-axis are .sub.3, .sub.4, and .sub.5, .sub.3, .sub.4, and .sub.5 are obtained according to Expression 33.
.sub.3=.sub.1+.sub.3
.sub.4=.sub.1+.sub.3(.sub.2)
.sub.5=.sub.1+.sub.3(.sub.2)+{(.sub.1+.sub.2+.sub.3)}Expression 33
When a distance from the hip joint of the upper body to a gravity center is assumed to be L.sub.3, coordinates of gravity centers of the upper body, the upper arm, and the forearm with a center of the hip joint serving as an origin are expressed as Expression 34.
L.sub.3g=(L.sub.3gx,L.sub.3gy)=(L.sub.3 cos .sub.3,L.sub.3 sin .sub.3)
L.sub.1g=(L.sub.1gx,L.sub.1gy)=(L.sub.3 cos .sub.3+L.sub.1 cos .sub.4,L.sub.3 sin .sub.3+L.sub.1 sin .sub.4)
L.sub.2g=(L.sub.2gx,L.sub.2gy)=(L.sub.3 cos .sub.3+L.sub.1 cos .sub.4+L.sub.2 cos .sub.5,L.sub.3 sin .sub.3+L.sub.1 sin .sub.4+L.sub.2 sin .sub.5)Expression 34
[0198] Accordingly, gravity center coordinates of an entire part including the upper body, the upper arm, and the forearm, i.e., L.sub.ga=(L.sub.gax, L.sub.gay), are expressed as Expression 35.
[0199] Here, a distance from the center of the hip joint to the gravity center of the entire part including the upper body, the upper arm, and the forearm is obtained by Expression 36.
|L.sub.ga|={square root over (L.sub.gax.sup.2+L.sub.gay.sup.2)}Expression 36
Accordingly, when it is assumed that a uniform rod of a mass (m.sub.1+m.sub.2+m.sub.3) is rotated, the inertia moment J.sub.B around the hip joint is calculated according to the parallel axis theorem by Expression 37.
[0200] When the mass m.sub.B (virtual mass m.sub.h+mass mw of burden), the inertia moment J.sub.B, and the like are obtained as described above, a torque necessary to rotate the upper body upward around the hip joint is calculated based on the angle of the output link 30 and the torque radius L. As described in Embodiment 3, the torque is obtained according to Expression 38.
T=J.sub.B{umlaut over ()}+d{dot over ()}+k.sub.R(.sub.0)+mBgL.sub.0 sin Expression 38
[0201] Further, a sum total of energy E of a system is obtained. The sum total of the energy E is expressed as Expression 39 as described in Embodiment 3.
E=J.sub.B{dot over ()}.sup.2+k.sub.R(.sub.0).sup.2+m.sub.BgL.sub.0(1cos )Expression 39
Subsequently, in order to obtain a condition for minimizing the sum total of the energy E of the system, a differential calculation is performed on the energy E with respect to time as shown in Expression 40, so as to obtain a condition under which a differential value is zero.
[0202] Then, similarly to Embodiment 3, a rotation angle .sub.1 of the motor 40 is calculated from the condition under which the sum total of the energy E of the system is minimized. The rotation angle .sub.1 is expressed as Expression 41.
[0203] The controller unit 52 of the assist device 60 performs a control such that the rotation angle of the motor 40 is .sub.1, that is, the outer-peripheral-side spring end portion 24e of the spiral spring 24 of the variable rigidity mechanism 20 has the angle .sub.1. As a result, the apparent rigidity k.sub.R of the variable rigidity mechanism 20 seen from the output link 30 is adjusted, and thus, the assist torque applied to the output link 30 from the output rotating shaft 26p of the variable rigidity mechanism 20 is controlled. That is, when the user lifts the burden W, the assist torque of the variable rigidity mechanism 20 is applied to the output link 30 in a direction where the femoral region becomes upright. Thus, a work load of the user is reduced.
[0204] Here, the disclosure is not limited to the above embodiments, and various modifications may be made without departing from the scope of the disclosure. For example, the embodiments deal with an example in which the distance L (the torque radius L) from the wrist to the rotation center C of the output link 30 is obtained with the use of the first acceleration sensor 744 and the second acceleration sensor 46. However, for example, an angle detector may be attached to an elbow joint, and the torque radius L may be obtained from the angle detector, the angle detector 43 of the output link 30, and the lengths of the upper arm and the forearm. Further, the embodiments deal with an example in which the spiral spring 24 is used as an elastic body of the variable rigidity mechanism 20. However, instead of the spiral spring 24, a coiled spring can be used or a rubbery elastic body can be used. Further, the embodiments deal with an example in which the speed reducer 26 is used in the variable rigidity mechanism 20, but the speed reducer 26 can be omitted depending on intensity of the spring. Further, the embodiments deal with an example in which the mass mw of the burden W is obtained by calculation from the load current I of the motor 40. However, the mass mw can be measured in advance and input into the controller unit 52. Further, the embodiments deal with an example in which the variable rigidity mechanisms 20 and the output links 30 are provided on right and left sides, but they may be provided only on one side.
[0205] Next will be sequentially described an overall structure of a swinging joint device 301 to carry out the disclosure with reference to the drawings. Note that, when an X-axis, a Y-axis, and a Z-axis are described in each figure, the X-axis, the Y-axis, and the Z-axis are orthogonal to each other, and a Z-axis direction indicates a vertically downward direction, an X-axis direction indicates a rearward direction with respect to a user (the user who wears the swinging joint device), and a Y-axis direction indicates a left direction with respect to the user, unless otherwise specified. Note that, in the present specification, a femoral swinging arm 313 illustrated in
[0206] An overall configuration of the swinging joint device 301 is described with reference to
[0207] The user attachment portion constituted by a base portion 302, a waist attachment portion 3, a shoulder belt 4, a control unit 5, a drive shaft member 6 and the like will be described with reference to
[0208] The waist attachment portion 3 is a member wound around a waist of the user and fixed to the waist of the user, and is configured to be adjustable in accordance with a size around the waist of the user. Further, the base portion 302 is fixed to the waist attachment portion 3 such that one end and the other end of the shoulder belt 4 are connected to the waist attachment portion 3.
[0209] The shoulder belt 4 is configured such that one end thereof is connected to a front-face side of the waist attachment portion 3, the other end thereof is connected to a back-face side of the waist attachment portion 3, and a length thereof is adjustable. The control unit 5 is attached to the shoulder belt 4. The user puts the shoulder belt 4 on his/her shoulder by adjusting the length of the shoulder belt 4, so that the user can carry the control unit 5 on the back like a backpack.
[0210] As illustrated in
[0211] The femoral swinging portion constituted by the femoral swinging arm 313, a femoral attachment portion 19, and the like will be described with reference to
[0212] Further, the femoral attachment portion 19 is attached to the femoral swinging arm 313 such that the femoral attachment portion 19 is disposed to cover a femoral region (i.e., disposed around a thigh) of the user, which makes it easy to attach the femoral swinging arm 313 to the femoral region of the user. Further, the circular plate portion 13G is fixed to an input-output portion 25C (see
[0213] The lower leg swinging portion constituted by the lower leg swinging arm 335, a lower leg attachment portion 39, and the like will be described with reference to
[0214] An operation of the swinging joint device 301 put on the user will be described with reference to
[0215] When the user swings the femoral region UL1 forward, the femoral swinging arm 313 is swung forward from its initial position by an angle .sub.a. Further, a swinging angle of the lower leg swinging arm 335 relative to the femoral swinging arm 313 is an angle .sub.b. At this time, a swing of the femoral region which requires a large torque is decreased appropriately so as to reduce a load of the user, by adjusting a turning angle of a fixed end of the flat spiral spring 324 with the use of the electric motor 21 as will be described later. Further, energy of a forward swing of the femoral region UL1 is accumulated in the flat spiral spring 324 while the turning angle of the fixed end of the flat spiral spring 324 is adjusted with the use of the electric motor 21. Further, while the turning angle of the fixed end of the flat spiral spring 324 is adjusted with the use of the electric motor 21, the energy accumulated in the flat spiral spring 324 is released so as to be used for a rearward swing of the femoral region UL1. Similarly, energy at the time of swinging the femoral region UL1 rearward is accumulated in the flat spiral spring 324 so as to be used for a forward swing of the femoral region UL1.
[0216] Thus, the swinging joint device 301 alternately repeats the following modes: an energy accumulation mode in which energy is accumulated by a swing motion of a moving body (in this case, the femoral swinging arm 313 and the femoral region UL1 of the user, and the lower leg swinging arm 335 and the lower leg UL2 of the user); and an energy release mode in which the energy thus accumulated is released so as to assist the swing motion of the moving body. Next will be described the rigidity adjustment portion including the flat spiral spring 324.
[0217] The rigidity adjustment portion constituted by the electric motor 21, a bracket 322, a rigidity adjustment member 23, the flat spiral spring 324, the transmission 25, and the like will be described with reference to
[0218] As illustrated in
[0219] The flat spiral spring 324 is configured such that an elastic body such as a spring material is wound in a spiral manner around a predetermined shaft. As illustrated in
[0220] The through-hole 23H through which the output shaft 21D in a distal end of the electric motor 21 is passed is formed in the rigidity adjustment member 23 such that the rigidity adjustment member 23 is supported by the output shaft 21D. The rigidity adjustment member 23 is fixed to the base portion 302 via the bracket 322 and the electric motor 21. Further, the spring support 23J that supports the fixed end 24A of the flat spiral spring 324 is provided on a surface of the rigidity adjustment member 23, which faces the flat spiral spring 324, at a position distanced from the drive axis 6J. For example, the spring support 23J is a shaft-shaped member extending along a drive-axis 6J direction, and is passed through a tubular portion formed in the flat spiral spring 324 at a position of the fixed end 24A. The rigidity adjustment member 23 is turned by the electric motor 21 around the drive axis 6J, so as to change the position of the fixed end 24A of the flat spiral spring 324 in a circumferential direction. Thus, the rigidity adjustment member 23 is supported around the drive axis 6J in a turnable manner and is turned around the drive axis 6J by a predetermined turning angle, and thus, a position of the spring support 23J relative to the drive axis 6J is moved around the drive axis 6J in the circumferential direction by the predetermined turning angle.
[0221] The output shaft 21D is provided in a distal end of the electric motor 21. Further, a speed reducer may be provided in the output shaft 21D. The output shaft 21D is passed through the through-hole 22H of the bracket 322 such that the electric motor 21 is fixed to the bracket 322 and the bracket 322 is fixed to the base portion 302. Further, a driving signal and electric power are supplied to the electric motor 21 from the battery and the controlling portion accommodated in the control unit 5. The electric motor 21 turns the rigidity adjustment member 23 around the drive axis 6J relative to the bracket 322 (that is, the base portion 302), and thus, the position of the fixed end 24A of the flat spiral spring 324 can be moved in the circumferential direction. Further, the electric motor 21 is provided with a rotation angle detecting portion 21S such as an encoder. The rotation angle detecting portion 21S outputs, to the controlling portion, a signal in accordance with a rotation angle of the shaft of the electric motor 21. The controlling portion 350 can detect a turning angle of the rigidity adjustment member 23 based on a detection signal from the rotation angle detecting portion 21S. Note that an angle detecting portion (an angle sensor) configured to detect a turning angle of the rigidity adjustment member 23 relative to the bracket 322 may be provided in the bracket 322 or the base portion 302. Further, the electric motor 21 is controlled by the controlling portion 350, and the position of the fixed end 24A is maintained at a predetermined position. Further, a mechanical brake, or the like may be provided so as to maintain the position of the fixed end 24A without sending an electric current to the electric motor 21. Further, the position of the fixed end 24A may be maintained at the predetermined position by the speed reducer provided in the output shaft 21D.
[0222] The position of the fixed end 24A of the flat spiral spring 324 and a rigidity adjustment angle .sub.s will be described with reference to
[0223] Further,
[0224] Further,
[0225] Further,
[0226] With reference to
[0227] As will be described later, the controlling portion 350 obtains a target rigidity adjustment angle, which is a rotation angle of the rigidity adjustment member 23 at which the apparent spring constant of the flat spiral spring 324 seen from the femoral swinging arm 313 becomes an optimum value, and outputs a driving signal to the electric motor 21 through the motor driver 352. The electric motor 21 rotates the rigidity adjustment member 23 via the output shaft 21D based on the driving signal from the controlling portion 350. Further, a rotation speed and a rotational amount of the shaft of the electric motor 21 are detected by the rotation angle detecting portion 21S, and a detection signal thereof is input into the motor driver 352 and is input into the CPU 50A via the motor driver 352. The CPU 50A performs a feedback control so that an actual rotation angle of the rigidity adjustment member 23 based on the detection signal from the rotation angle detecting portion 21S approaches the target rigidity adjustment angle.
[0228] Further, a detection signal from the first angle detecting portion 13S and a detection signal from the second angle detecting portion 35S are input into the controlling portion 350. The controlling portion 350 can detect a first swinging angle of the femoral swinging arm 313 relative to the base portion 302 based on the detection signal from the first angle detecting portion 13S. Further, the controlling portion 350 can detect a second swinging angle of the lower leg swinging arm 335 relative to the femoral swinging arm 313 based on the detection signal from the second angle detecting portion 35S.
[0229] The activation switch 354 is a switch configured to activate the controlling portion 350. Further, the touch panel 55 is a device configured to input a height, a weight, and the like of the user and to display a setting state. Further, the charging connector 61 is a connector to which a charging cable is connected at the time of charging the battery 360.
[0230] Next will be described an example of a procedure for a controlling portion according to Embodiment 5 in consideration of an influence of a gravitational force applied to a moving body (a femoral swinging arm 313+a femoral region UL1+a lower leg UL2 (see
[0231] Subsequently, the following describes a procedure of the controlling portion 350 with the use of a flowchart illustrated in
[0232] The controlling portion waits for input of an initial setting from the user via a touch panel (i.e., the controlling portion waits for the user to input the initial setting via the touch panel) in step S110. When the controlling portion determines that a height and a weight are input from the user, the controlling portion proceeds to step S120. Note that, in a case where the controlling portion does not receive any input from the user even after a predetermined time, the controlling portion, for example, sets a preset standard height and standard weight, and then proceeds to step S120.
[0233] In step S120, the controlling portion measures a walking state (or a running state) of the user during a predetermined period, and stores, in a storage device, a detection signal from a first angle detecting portion 13S as measurement data in association with a measurement time. After the controlling portion collects the measurement data during a predetermined number of steps or a predetermined period of time, the controlling portion proceeds to step S130.
[0234] In step S130, the controlling portion calculates a first swinging angle and the like of the femoral swinging arm from the measurement data based on the detection signal from the first angle detecting portion 13S. Then, the controlling portion estimates an angular frequency and the like from a change of the first swinging angle over time, and then proceeds to step S140.
[0235] In step S140, based on the height and weight of the user, which are input in step S110, and the first swinging angle of the femoral swinging arm, the angular frequency of the femoral swinging arm, and the like, which are calculated in step S130, the controlling portion calculates an apparent spring constant k of a flat spiral spring 324 at which a maximum energy reduction effect is obtained, and then, the controlling portion proceeds to step S150. Note that a detailed calculation procedure for the apparent spring constant k of the flat spiral spring 324 will be described later.
[0236] In step S150, the controlling portion calculates a rotation angle .sub.1 (a rotation angle of the rigidity adjustment member 23) of an electric motor 21 so as to satisfy the apparent spring constant k of the flat spiral spring 324, and proceeds to step S160. Note that a detailed calculation procedure for the rotation angle .sub.1 (a rotation angle of a rigidity adjustment member 23) of the electric motor 21 will be described later.
[0237] In step S160, the controlling portion controls the electric motor 21 so that the rotation angle of the rigidity adjustment member 23 is .sub.1, and then proceeds to step S170.
[0238] In step S170, the controlling portion monitors a walking state (or a running state), and determines whether or not the user wants to stop assistance for the walking motion (or running motion). When it is determined that the user wants to stop the assistance (Yes), the controlling portion stops the control, and when it is determined that the user does not want to stop the assistance (No), the controlling portion returns to step S120.
[0239] Next will be described a calculation method for the apparent rigidity k of the flat spiral spring seen from the moving body and the rotation angle .sub.1 of the electric motor 21. The following description is made with the following definitions. Note that the following l.sub.g, J.sub.1, and m.sub.1 are estimated by the controlling portion 350 based on the input height, weight, and the like of the user. Further, c.sub.1, k.sub.1, n, are set in the controlling portion 350 in advance. Here, indicates a driving torque (Nm) around the drive axis 6J illustrated in
[0240] An equation of motion of the moving body can be expressed as Expression 42. When the 5-order Taylor expansion is used for Expression 42, Expression 43 can be obtained as follows.
[0241] Here, when Expression 44 is satisfied, Expression 45 can be obtained as follows.
[0242] Further, the displacement angle of the femoral swinging arm 313 and the amplitude || of the displacement angle of the moving body can be expressed as Expression 46 and Expression 47 as follows. Further, Expression 48 can be obtained from Expression 44 and Expression 47.
[0243] Further, when Expression 48 is substituted into Expression 45, Expression 49 can be obtained as follows.
[0244] In this case, a torque amplitude can be expressed as Expression 50 as follows. In order to minimize || in Expression 50, A=0 should be satisfied in Expression 50, and when the apparent rigidity at that time is assumed to be k, Expression 51 is established as follows. Expression 52 can be obtained from Expression 51.
[0245] Here, when it is assumed that forces are balanced, t at the time when the flat spiral spring is seen from the moving body can be expressed as Expression 53. Further, at the time when the moving body is seen from the flat spiral spring can be expressed as Expression 54.
=kExpression 53
=n.sub.1Expression 54
[0246] A torque .sub.1 that occurs in the input shaft of the speed reducer can be expressed by Expression 55 as follows. Here, when it is assumed that the electric motor 21 is rotated to rotate the fixed end of the flat spiral spring by .sub.1, Expression 56 can be obtained as follows. Further, when Expression 56 is substituted into Expression 55, Expression 57 can be obtained as follows.
.sub.1=k.sub.1Expression 55
=n.sub.1Expression 56
.sub.1=k.sub.1(n.sub.1)Expression 57
[0247] When Expression 57 is substituted into Expression 54, Expression 58 can be obtained. Consequently, Expression 59 and Expression 60 can be obtained from Expression 58 and Expression 53.
=nk.sub.1(n.sub.1)=n.sup.2k.sub.1[1.sub.1/(n)]Expression 58
k=n.sup.2k.sub.1[1.sub.1/(n)]Expression 59
.sub.1=n[1k/(n.sup.2k.sub.1)]Expression 60
[0248] Accordingly, in step S140 in the flowchart illustrated in
[0249] Note that
[0250] Next will be described an example of a procedure of a controlling portion according to Embodiment 6 in consideration of an influence of a gravitational force applied to a moving body (a femoral swinging arm 313+a femoral region UL1+a lower leg swinging arm 335+a lower leg UL2 (see
[0251] At the time of walking of a user who wears the swinging joint device, a second swinging angle (a swinging angle .sub.un in
[0252] Next will be described a procedure of the controlling portion 350 with reference to a flowchart illustrated in
[0253] The controlling portion waits for input of an initial setting from the user via a touch panel in step S210. Note that step S210 is similar to step S110 illustrated in
[0254] In step S220, the controlling portion measures a walking state (or a running state) of the user during a predetermined period, and stores, in a storage device, a detection signal from a first angle detecting portion 13S and a detection signal from a second angle detection portion 35S as measurement data in association with a measurement time. After the controlling portion collects the measurement data during a predetermined number of steps or a predetermined period of time, for example, the controlling portion proceeds to step S230.
[0255] In step S230, the controlling portion calculates a first swinging angle .sub.up (see
[0256] In step S235, the controlling portion calculates an inertia moment J.sub.1 based on the first swinging angle .sub.up and the second swinging angle .sub.un, and then proceeds to step S240. Note that a detailed calculation procedure for the inertia moment J.sub.1 will be described later.
[0257] In step S240, based on a height and a weight of the user, which are input in step S210, and the first swinging angle .sub.up of the femoral swinging arm, the angular frequency of the femoral swinging arm, and the second swinging angle .sub.un of the lower leg swinging arm, which are calculated in step S230, the inertia moment J.sub.1 calculated in step S235, and the like, the controlling portion calculates an apparent spring constant k of a flat spiral spring 324 at which a maximum energy reduction effect is obtained, and then, the controlling portion proceeds to step S250. Note that a detailed calculation procedure for the apparent spring constant k of the flat spiral spring 324 will be described later.
[0258] In step S250, the controlling portion calculates a rotation angle .sub.1 (a rotation angle of a rigidity adjustment member 23) of an electric motor 21 so as to satisfy the apparent spring constant k of the flat spiral spring 324, and proceeds to step S260. Note that a detailed calculation procedure for the rotation angle .sub.1 (a rotation angle of the rigidity adjustment member 23) of the electric motor 21 will be described later.
[0259] In step S260, the controlling portion controls the electric motor 21 so that the rotation angle of the rigidity adjustment member 23 is .sub.1, and then proceeds to step S270.
[0260] In step S270, the controlling portion monitors a walking state (or a running state), and determines whether or not the user wants to stop assistance for the walking motion (or running motion). When it is determined that the user wants to stop the assistance (Yes), the controlling portion stops the control, and when it is determined that the user does not want to stop the assistance (No), the controlling portion returns to step S220.
[0261] A calculation method for the inertia moment J.sub.1 will be described below with the following definition. Note that the following l.sub.s, l.sub.up, l.sub.un, l.sub.gun, m.sub.1, m.sub.up, m.sub.un, for example, are estimated by the controlling portion 350 based on the input height, weight, and the like of the user. Further, c.sub.1, k.sub.1, n, are set in the controlling portion 350 in advance. Here, indicates a driving torque (Nm) around a swing center illustrated in
[0262] As illustrated in
l.sub.gupx=l.sub.gup sin .sub.upExpression 61
l.sub.gupz=l.sub.gup cos .sub.upExpression 62
[0263] Further, a coordinate l.sub.gunx, in the X-axis direction, of a gravity center of the lower leg+the lower leg swinging arm relative to the swing center and a coordinate l.sub.gunz, in the Z-axis direction, of the gravity center can be expressed as Expression 63 and Expression 64.
l.sub.gunx=l.sub.up sin .sub.up+l.sub.gun sin(.sub.up+.sub.un)Expression 63
l.sub.gunz=l.sub.up cos .sub.upl.sub.gun cos(.sub.up+.sub.un)Expression 64
[0264] Thus, an X-coordinate l.sub.gx of a gravity center of the whole moving body the femoral region+the femoral swinging arm+the lower leg+the lower leg swinging arm relative to the swing center and a Z-coordinate l.sub.gz of the gravity center can be expressed as Expression 65 and Expression 66.
l.sub.gx=(l.sub.gupxm.sub.up+l.sub.gunxm.sub.un)/(m.sub.up+m.sub.un)Expression 65
l.sub.gx=(l.sub.gupzm.sub.up+l.sub.gunzm.sub.un)/(m.sub.up+m.sub.un)Expression 66
[0265] Further, the inertia moment J of the whole moving body around the swing center is obtained on the assumption that an elongated uniform rod with a length l.sub.g and a mass (m.sub.up+m.sub.un) is rotated from an end. At this time, the inertia moment J can be derived from the parallel axis theorem according to Expression 67. Note that Expression 68 is also established.
J=( 1/12)(m.sub.up+m.sub.un)(2l.sub.g).sup.2+(m.sub.up+m.sub.un)(l.sub.g).sup.2Expression 67
l.sub.g={square root over ([(lgx)2+(lgz)2])}Expression 68
[0266] Next will be described a calculation method for the apparent rigidity k of the flat spiral spring seen from the moving body and the rotation angle .sub.1 of the electric motor 21. J in Expression 67 is assumed to be J.sub.1 and is substituted for J.sub.1 in Expression 42 in Embodiment 5. That is, by substituting J of Expression 67 for J.sub.1 in Expression 52 in Embodiment 5, the apparent rigidity k of the flat spiral spring can be obtained. Further, when an obtained value of the apparent rigidity k is substituted into Expression 60 in Embodiment 5, the rotation angle .sub.1 of the electric motor 21 can be obtained.
[0267] Accordingly, in step S240 in the flowchart illustrated in
[0268] Note that
[0269] Next will be described an example of a procedure of a controlling portion according to Embodiment 7 in consideration of an influence of a gravitational force applied to a moving body (a femoral swinging arm 313+a femoral region UL1+a lower leg UL2 (see
[0270] At the time of walking of the user who wears the swinging joint device, generally, a central position Pc (see
[0271] Next will be described a procedure of the controlling portion 350 with reference to a flowchart illustrated in
[0272] The controlling portion waits for input of an initial setting from the user via a touch panel in step S310. Note that step S310 is similar to step S110 illustrated in
[0273] In step S320, the controlling portion measures a walking state (or a running state) of the user during a predetermined period, and stores, in a storage device, a detection signal from a first angle detecting portion 13S as measurement data in association with a measurement time. After the controlling portion collects the measurement data during a predetermined number of steps or a predetermined period of time, the controlling portion proceeds to step S330.
[0274] In step S330, the controlling portion calculates a first swinging angle (see
[0275] In step S340, based on a height and a weight of the user, which are input in step S310, and the first swinging angle of the femoral swinging arm, the angular frequency of the femoral swinging arm, and the like, which are calculated in step S330, the controlling portion calculates an apparent spring constant K of a flat spiral spring 324 at which a maximum energy reduction effect is obtained, and an angle .sub.c of a neutral point of the flat spiral spring 324 (a position where the flat spiral spring generates no torque), and then, the controlling portion proceeds to step S350. Note that a detailed calculation procedure for the apparent spring constant K of the flat spiral spring 324 and the angle .sub.c of the neutral point will be described later.
[0276] In step S350, the controlling portion calculates a rotation angle .sub.1 (a rotation angle of a rigidity adjustment member 23) of an electric motor 21 so as to satisfy the apparent spring constant K of the flat spiral spring 324, and proceeds to step S360. Note that a detailed calculation procedure for the rotation angle .sub.1 (the rotation angle of the rigidity adjustment member 23) of the electric motor 21 will be described later.
[0277] In step S360, the controlling portion controls the electric motor 21 so that the rotation angle of the rigidity adjustment member 23 is .sub.1, and then proceeds to step S370.
[0278] In step S370, the controlling portion monitors a walking state (or a running state), and determines whether or not the user wants to stop assistance for the walking motion (or running motion). When it is determined that the user wants to stop the assistance (Yes), the controlling portion stops the control, and when it is determined that the user does not want to stop the assistance (No), the controlling portion returns to step S320.
[0279] Next will be described a calculation method for the apparent rigidity K of the flat spiral spring seen from the moving body and an angle .sub.C of the neutral point. The description is made with the following definition as illustrated in
[0280] When a driving torque is assumed to be T, a dynamics of an output link (the femoral swinging arm) in consideration of the angle .sub.e of the neutral point of the flat spiral spring is given by Expression 69 as follows. Here, for simplification, when sin approximates to such that sin , Expression 69 is rewritten to Expression 70 as follows.
T=J{umlaut over ()}+c{dot over ()}+K(c)+mgl sin Expression 69
T=J{umlaut over ()}+c{dot over ()}+K(c)+mglExpression 70
[0281] In order to minimize energy of a system in Expression 70, Expression 71 should be established as follows.
J{umlaut over ()}+K(.sub.e)+mgl=Expression 71
[0282] Here, when =(K+mgl)/J and =K.sub.e/J are satisfied, Expression 71 can be rewritten to Expression 72 as follows. Further, when a homogeneous equation is established such that the right side of Expression 72 is set to 0, Expression 73 is obtained as follows.
{umlaut over ()}+=Expression 72
{umlaut over ()}+=0Expression 73
[0283] When 0=et is substituted into Expression 73 to obtain a solution of a characteristic equation, a solution shown in Expression 74 can be obtained as follows. Accordingly, a fundamental solution of the homogeneous equation is Expression 75 as follows.
={square root over ((i))}Expression 74
=e.sup.{square root over ()}it,e.sup.{square root over ()}itExpression 75
[0284] Then, when a solution is obtained at the time when the right side is not 0, Expression 76 is obtained from the Wronski determinant. When this is solved to obtain a particular solution, Expression 77 is derived as follows.
[0285] Accordingly, a general solution of a inhomogeneous equation is given according to Expression 78 as follows.
[0286] Here, when A.sub.1=A.sub.2=A/2 is satisfied, Expression 78 can be rewritten to Expression 79 as follows.
[0287] A reciprocating swing motion can be expressed as Expression 80 as follows. Further, Expression 79 and Expression 80 indicate the same motion. In view of this, from these expressions, the apparent rigidity K of the flat spiral spring seen from the moving body and the angle .sub.c of the position of the neutral point of the flat spiral spring are expressed as Expression 81 and Expression 82. Note that Expression 81 can be obtained from [(K+mgl)/J]= according to Expression 79. Further, Expression 82 can be obtained from [K/(K+mgl)].sub.c= according to Expression 79.
=|| cos t+Expression 80
K=J.sup.2mglExpression 81
.sub.c=[1+mgl/K]Expression 82
[0288] A calculation method for the rotation angle .sub.1 of the electric motor 21 will be described. When a speed reducing ratio of a transmission is n, an efficiency of the transmission is , and an original spring constant of the flat spiral spring is k.sub.1, and when it is assumed that forces are balanced, a driving torque of the output link (the femoral swinging arm) can be expressed as Expression 83 and Expression 84 as follows. Note that Expression 53 of Embodiment 5 shows .sub.c=0.
=K(.sub.c)Expression 83
=n.sub.1Expression 84
[0289] Here, .sub.1 is a torque that occurs on an input side (an electric motor 21-side) of the transmission and can be expressed as Expression 85 with a rotation angle of the output link (the femoral swinging arm) and the rotation angle .sub.1 of the rigidity adjustment member 23 (the rotation angle of the electric motor 21) as follows.
.sub.1=k.sub.1(n.sub.1)Expression 85
[0290] When Expression 85 is substituted into Expression 84, Expression 86 can be obtained.
=nk.sub.1(n.sub.1)Expression 86
[0291] From Expression 86 and Expression 83, 0.sub.1 can be expressed as shown in Expression 87 as follows.
.sub.1=n(.sub.c)[1K/(n.sup.2k.sub.1)]+n.sub.c=n[1K/(n.sup.2k.sub.1)]+(K.sub.e)/(n.sup.2k.sub.1)Expression 87
[0292] From Expression 82 and Expression 87, Expression 88 can be obtained as follows.
.sub.1=n[1K/(n.sup.2k.sub.1)]+[/(nk.sub.1)](K+mgl)Expression 88
[0293] Accordingly, in step S340 in the flowchart illustrated in
[0294] Embodiment 5 describes a method in consideration of an influence of a gravitational force (i.e., a gravitational influence). Further, Embodiment 7 considers the gravitational influence and the influence of the central position of the reciprocating swing motion locus (the neutral point of the flat spiral spring). However, in a case where only the central position of the reciprocating swing motion locus is taken into consideration, the rotation angle .sub.1 should be calculated by assuming that mgl sin of the right side in Expression 69 is zero and eliminating a term related to the gravitational influence. Further, Embodiment 6 considers the gravitational influence and the influence of the change of inertia moment. However, in a case where only the influence of the change of inertia moment is taken into consideration, the rotation angle .sub.1 should be calculated by assuming that a second term in the right side in Expression 52 is zero and eliminating a term related to the gravitational influence. Further, when the method in consideration of only the central position is applied to Embodiment 6, the gravitational influence, the influence of the change of inertia moment, and the influence of the central position can be taken into consideration, and accordingly, an even larger energy reduction effect can be obtained. Further, when the term related to the gravitational influence is eliminated from the method in consideration of the gravitational influence, the influence of the change of inertia moment, and the influence of the central position, it is possible to obtain a method in consideration of the influence of the change of inertia moment and the influence of the central position. Thus, it is possible to obtain a larger energy reduction effect as compared to a conventional technique, when the apparent rigidity (spring constant) of the flat spiral spring seen from the femoral swinging arm is adjusted based on the first swinging angle and at least one of a gravitational force that acts on the moving body in accordance with the first swinging angle (the gravitational influence), an inertia force that acts on the moving body in accordance with the first swinging angle and a motion state of the moving body state (the influence of the change of inertia moment), and the central position of the reciprocating swing motion locus of the femoral swinging arm (the influence of the central position).
[0295] Various modifications, additions, and deletions may be made to the structure, the configuration, the shape, the appearance, the procedure, the computing equation, and the like of the swinging joint device of the disclosure without departing from the scope of the disclosure.
[0296] The purpose of the swinging joint device described in each embodiment is not limited to assisting a swing motion (walking or running) of the lower limb of the user. The swinging joint device in each embodiment is applicable to various objects such as various instruments or devices that perform a periodic swing motion with the use of an electric motor or the like.
[0297] Further, in the embodiments, the transmission 25 is provided between the femoral swinging arm 313 and the flat spiral spring 324, so as to indirectly connect the flat spiral spring 324 to the femoral swinging arm 313. However, the transmission 25 may be omitted and the femoral swinging arm 313 and the flat spiral spring 324 may be connected directly.
[0298] Further, the embodiments deal with an example in which the flat spiral spring 324 is used as an elastic body, but various elastic bodies can be used instead of the flat spiral spring 324. For example, another elastic body such as a helically wound extensible spring, leaf spring, or wave spring may be usable. Further, rubber, elastomer such as resin, an elastic body using liquid such as oil or gas may be used. The elastic body may be changed in accordance with a momentum of an object (motion) for which energy should be stored or an amount of energy to be stored. In a case where the amount of energy to be stored is relatively small, it is effective to use elastomer. Further, with regard to a motion such as walking or running of the user, it is effective to use a flat spiral spring in view of its relatively large storage amount of energy, a magnitude of a spring constant (rigidity) or the like, easiness in adjustment, and the like. Further, the flat spiral spring is also advantageous in terms of cost.
[0299] The swinging joint device has been described as a device for a left leg of a user. However, the swinging joint device may additionally include a base portion for a right leg (symmetric to the base portion 302), a femoral swinging portion for the right leg (symmetric to members indicated by reference signs 313, 19, and the like), a rigidity adjustment portion for the right leg (symmetric to members indicated by reference signs 21, 322, 23, 324, 25, and the like), and a lower leg swinging portion for the right leg (symmetric to members indicated by reference signs 335, 39, and the like) such that the control unit 5 assists the walking motion (or running motion) of both legs of the user.
[0300] Further, according to the above embodiments, in walking or running of the user, the apparent rigidity varying unit is controlled in consideration of the influences of a gravitational force, an inclination posture of the user, and an inertia force, from a time when a frequency of a periodic swing motion is low at a low speed immediately after the walking or running starts to a time when the frequency of the periodic swing motion is high at a high speed after the speed of the walking or running is increased. This makes it possible to perform an optimum control on the frequency of the swing motion (a frequency of the moving body). When the frequency of the swing motion is low, the gravitational influence increases. In this regard, it is possible to perform a control in consideration of the gravitational influence. Meanwhile, as the frequency of the swing portion increases, the gravitational influence decreases, and the influence of the inertia force increases. In this regard, it is possible to perform a control in consideration of the influence of the inertia force. Further, it is also possible to perform a control in accordance with a degree of the inclination posture of the user, and thus, an effective energy reduction effect can be obtained.
[0301] Embodiment 8 for carrying out the disclosure will be described below with reference to the drawings. The present embodiment describes a linear motion variable rigidity unit included in a grinding machine, by taking the grinding machine as an example of a machine tool. Note that when an X-axis, a Y-axis, and Z-axis are described in the figures, the X-axis, the Y-axis, and the Z-axis are orthogonal to each other.
[0302] A grinding machine 100 illustrated in
[0303] The reciprocation table 130 is disposed on the table support base 120. The reciprocation table 130 linearly reciprocates along rails Ra extending in the Z-axis direction. By the linear reciprocating motion, the reciprocation table 130 moves closer to or moves away from the object support base 110. The reciprocation table 130 includes a grindstone 134. The grindstone 134 is supported by a grindstone support shaft 132 extending in the X-axis direction from the reciprocation table 130, so as to be rotatable around the grindstone support shaft 132. The grindstone 134 grinds the grinding object 114 when the reciprocation table 130 moves close to the object support base 110. Note that sliders AT facing the rails Ra are attached to a bottom face of the reciprocation table 130.
[0304] The table drive device 140 is a linear motor, for example, and is configured by applying a magnetic field to the rails Ra and the sliders AT. The table drive device 140 causes the reciprocation table 130 to linearly reciprocate at a predetermined frequency (a predetermined period T). Drive energy of the table drive device 140 for causing the reciprocation table 130 to linearly reciprocate is minimized by assistance provided by the after-mentioned linear motion variable rigidity unit 1.
[0305] The linear motion variable rigidity unit 1 is attached to the reciprocation table 130, and more specifically, attached to the reciprocation table 130 at a position on a side opposite to the object support base 110 in the Z-axis direction. Note that the linear motion variable rigidity unit 1 is covered with a cover in
[0306] The screw shaft member 512 (see
[0307] The nut 13 (see
[0308] The screw shaft member 512 and the nut 13 perform an energy accumulation operation in which energy is accumulated in the spiral spring 530, and an energy release operation in which the energy is released from the spiral spring 530. In the energy accumulation operation, a linear reciprocating motion input into the screw shaft member 512 from the reciprocation table 130 is converted to a rotational reciprocating motion by the nut 13, and the nut 13 outputs the rotational reciprocating motion to the spiral spring 530. In the energy release operation, a rotational reciprocating motion of the nut 13 in accordance with a torque of the spiral spring 530 is converted to a linear reciprocating motion by the screw shaft member 512, and the screw shaft member 512 outputs the linear reciprocating motion to the reciprocation table 130. The energy accumulation operation and the energy release operation will be described later more specifically in connection with the spiral spring 530.
[0309] The speed reducer 520 (see
[0310] The inner end 532 (an end portion on a side of the central axis W, i.e., an end portion close to the central axis W) of the spiral spring 530 (see
[0311] As will be described later more specifically with reference to
[0312] The turning member 540 (see
[0313] The rigidity variable actuator 550 (see
[0314] The control device 560 (see
[0315] Subsequently, a turning state of the spiral spring 530 at the time when the screw shaft member 512 and the nut 13 perform the energy accumulation operation and the energy release operation will be described mainly with the use of
[0316]
[0317]
[0318] Next will be described a method of calculating an apparent spring constant to minimize the drive energy for causing the reciprocation table 130 to linearly reciprocate. The Z-axis direction is referred to as a linear motion direction. Note that, in Expression 89 to Expression 97 described below, the motor output shaft 552 is not driven, and the outer end 34 of the spiral spring 530 is disposed at the outer-end reference position (see
[0319] A current position z of the reciprocation table 130 can be expressed with the use of a current rotation angle of the nut 13 and a pitch p of a spiral groove of the screw shaft member 512 as follows.
z=(p.Math.)/2Expression 89
[0320] A reciprocation central position z.sub.0 of the reciprocation table 130 is given by Expression 90 with the use of a reference angle .sub.0 of the nut 13.
z.sub.0=(p.Math..sub.0)/2Expression 90
[0321] An output from the spiral spring 530 to the nut 13 is converted to a thrust f in the linear motion direction by the nut 13 and the screw shaft member 512. When an apparent spring constant in the linear motion direction is assumed to be k.sub.L, the thrust f is given by Expression 91.
f=k.sub.L.Math.(zz.sub.0)Expression 91
[0322] Here, when Expression 89 and Expression 90 are applied to z and z.sub.0, respectively, Expression 92 is obtained.
f=k.sub.L.Math.p.Math.(.sub.0)/2Expression 92
[0323] The following discusses a torque that occurs in the nut 13 due to the spiral spring 530. When an apparent spring constant in a rotation direction is k.sub.R, a torque input from the spiral spring 530 into the input-output shaft 524 of the speed reducer 520 is .sub.A, a speed reducing ratio of the speed reducer 520 is n, and an efficiency of the speed reducer 520 is .sub.R, the torque is given by Expression 93 and Expression 94.
=k.sub.R.Math.(.sub.0)Expression 93
=.sub.R.Math.n.Math..sub.AExpression 94
[0324] Further, when an actual spring constant of the spiral spring 530 is k, the torque .sub.A input from the spiral spring 530 into the input-output shaft 524 of the speed reducer 520 is given by Expression 95. Note that, as has been already described, when the rotation angle of the nut 13 is .sub.0, the inner end 532 of the spiral spring 530 is turned from the inner-end reference position by a turning angle n.Math.(.sub.0) (see
.sub.A=k.Math.n.Math.(.sub.0)Expression 95
[0325] Subsequently, when Expression 95 is substituted into Expression 94, the torque is given by Expression 96.
=.sub.R.Math.n.Math.k.Math.n.Math.(.sub.0)=.sub.R.Math.n.sup.2.Math.k.Math.(.sub.0)Expression 96
[0326] Subsequently, when Expression 96 and Expression 93 are combined to obtain a solution about the apparent spring constant k.sub.R in the rotation direction, k.sub.R is given by Expression 97.
k.sub.R=.sub.R.Math.n.sup.2.Math.kExpression 97
[0327] Here, it is assumed that the motor output shaft 552 is driven so as to turn the outer end 34 of the spiral spring 530 from the outer-end initial position by the turning angle .sub.1 (see
.sub.A=k.Math.{n(.sub.0).sub.1}Expression 98
[0328] Then, when Expression 98 is substituted into Expression 94, the torque is given by Expression 99.
=R.Math.n.Math.k.Math.{n(.sub.0).sub.1}=.sub.Rn.sup.2.Math.k[1.sub.1/{n.Math.(.sub.0))}].Math.(.sub.0)Expression 99
[0329] Then, Expression 99 and Expression 93 are used to obtain a solution about the apparent spring constant k.sub.R in the rotation direction, k.sub.R is given by Expression 100.
k.sub.R=R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0)}]Expression 100
[0330] Then, when it is assumed that the work of the screw shaft member 512 in the linear motion direction is equal to the work of the nut 13 in the rotation direction, Expression 101 is given as follows. Note that .sub.L indicates a rotation-linear motion conversion efficiency.
f.Math.(zz.sub.0)=.sub.L.Math..Math.(.sub.0)Expression 101
Here, when Expression 89 and Expression 90 are applied to z and z.sub.0 in Expression 101, respectively, Expression 102 is obtained.
f.Math.p.Math.(.sub.0)/2=.sub.L.Math..Math.(.sub.0)Expression 102
[0331] Then, when Expression 92 is applied to the thrust f in Expression 102, Expression 103 is obtained.
k.sub.L.Math.{p.Math.(.sub.0)/2}.sup.2=.sub.L.Math..Math.(.sub.0)Expression 103
[0332] Then, when Expression 99 is applied to the torque of Expression 103, Expression 104 is obtained.
k.sub.L{p.Math.(.sub.0)/2}.sup.2=.sub.L.Math..sub.R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0)}].Math.(.sub.0).sup.2Expression 104
[0333] Then, Expression 104 is solved for the apparent spring constant k.sub.L in the linear motion direction, Expression 105 is obtained.
k.sub.L=n.sub.L.Math.n.sub.R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0)}].Math.(2/p).sup.2Expression 105
[0334] Now, when drive energy for causing the reciprocation table 130 to linearly reciprocate is F, a mass of the reciprocation table 130 is m, and a viscosity relating to the linear reciprocating motion of the reciprocation table 130 is v, an equation of motion relating to the reciprocation table 130 is given by Expression 106. Note that m may be also a sum of the mass of the reciprocation table 130 and a mass of the screw shaft member 512.
F=m.Math.(d.sup.2z/dt.sup.2)+v.Math.(dz/dt)+k.sub.L.Math.zExpression 106
[0335] When it is assumed that the linear reciprocating motion of the reciprocation table 130 is a sine wave, a current position z of the reciprocation table 130 is given by Expression 107.
z=A.Math.sin(.Math.t)Expression 107
Note that A indicates an amplitude of z, indicates an angular frequency (angular velocity) at which the reciprocation table 130 linearly reciprocates, and t indicates a time. When a period of the linear reciprocating motion of the reciprocation table 130 is T, is given by =2/T.
[0336] When Expression 107 is applied to Expression 106, Expression 108 is obtained.
F=A.Math.m.Math..sup.2.Math.sin(.Math.t)+A.Math.v.Math. cos(.Math.t)+A.Math.k.sub.L.Math.sin(.Math.t)=A.Math.(k.sub.Lm.Math..sup.2).Math.sin(.Math.t)+A.Math.v.Math..Math.cos (.Math.t)Expression 108
[0337] In Expression 108, when the first term is 0, the drive energy F is minimized. That is, F is minimized by controlling the apparent spring constant k.sub.L in the linear motion direction so as to satisfy Expression 109.
k.sub.L=m.Math..sup.2Expression 109
[0338] Here, when Expression 105 and Expression 109 are combined, Expression 110 is obtained as follows.
.sub.L.Math..sub.R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0)}].Math.(2/p).sup.2=m.Math..sup.2Expression 110
[0339] When Expression 110 is solved for .sub.1, Expression 111 is obtained.
[0340] By using .sub.1 in Expression 111, the drive energy F for causing the reciprocation table 130 to linearly reciprocate is minimized. In the Expression 111, only a current rotation angle of the nut 13 is a variable. The current rotation angle of the nut 13 is changed in real time in accordance with the linear reciprocating motion of the reciprocation table 130. Accordingly, the abovementioned drive energy F can be minimized by changing the turning angle .sub.1 of the outer end 34 of the spiral spring 530 in real time in accordance with the current rotation angle of the nut 13. Note that, as can be understood from Expression 105, when the turning angle .sub.1 of the outer end 34 of the spiral spring 530 is changed, the apparent spring constant k.sub.L in the linear motion direction is changed.
[0341] The control device 560 changes the turning angle 81 of the outer end 34 of the spiral spring 530 in real time so as to satisfy Expression 111. As a result, in a relationship shown in Expression 105, the apparent spring constant k.sub.L in the linear motion direction is changed in real time. Thus, the drive energy F for causing the reciprocation table 130 to linearly reciprocate is constantly minimized.
[0342] Note that, as shown in Expression 111, the turning angle .sub.1 of the outer end 34 of the spiral spring 530 is a function of the angular frequency of the reciprocation table 130. Accordingly, even when the angular frequency of the reciprocation table 130 is changed in accordance with the number of rotations of the grinding object 114 around the object support shaft 112 and a shape of the grinding object 114, the turning angle .sub.1 corresponding to the angular frequency thus changed is calculated in Expression 111. Accordingly, by setting the turning angle .sub.1 based on Expression 111, it is possible to minimize the drive energy F for causing the reciprocation table 130 to linearly reciprocate in accordance with any of various processing periods.
[0343] The linear motion variable rigidity unit 1 is configured as described above. In the linear motion variable rigidity unit 1, kinetic energy at the time when the reciprocation table 130 linearly reciprocates is released again to the reciprocation table 130 itself, and thus, the linear reciprocating motion of the reciprocation table 130 is assisted efficiently. Accordingly, the drive energy of the table drive device 140, which is required to cause the reciprocation table 130 to linearly reciprocate, is reduced, and thus, an output of the table drive device 140 is reduced.
[0344] In the linear motion variable rigidity unit 1, the control device 560 changes the apparent spring constant of the spiral spring 530 in real time, and thus, the drive energy for causing the reciprocation table 130 to linearly reciprocate is constantly minimized. Accordingly, the output of the table drive device 140 is reduced to the minimum. Note that the apparent spring constant of the spiral spring 530 is easily changed by driving the rigidity variable actuator 550 so as to change the turning angle .sub.1 of the outer end 34 of the spiral spring 530.
[0345] In the linear motion variable rigidity unit 1, the linear motion-rotation conversion mechanism 510 is constituted by the screw shaft member 512 and the nut 13, that is, the linear motion-rotation conversion mechanism 510 has a simple configuration.
[0346] A linear motion variable rigidity unit 1a according to Embodiment 9 will be described mainly with reference to
[0347] The linear motion-rotation conversion mechanism 10a is constituted by two link members 514, 515 as illustrated in
[0348] As illustrated in
[0349] An end portion of the first link member 514, which is opposite to the first link connection end 14a, is a first link connection end 14b. The first link connection end 14b is connected to a second link connection end 15a, which is one end of the second link member 515, via a rotary joint B2. The link connection ends 14b, 15a can rotate relative to each other with the rotary joint B2 serving as a supporting point. Along with this rotation, an angle .sub.L increases and decreases with the rotary joint B2 serving as a vertex of the angle .sub.L.
[0350] An end portion of the second link member 515, which is opposite to the second link connection end 15a, is a second link connection end 15b (a rotational motion input-output portion). The second link connection end 15b is connected to the input-output cylinder 522 of the speed reducer 520 via a bolt B3, for example. The bolt B3 is fitted into the input-output cylinder 522 so as to be prevented from falling off from the input-output cylinder 522. Accordingly, the bolt B3 rotates together with the input-output cylinder 522. The second link connection end 15b is fixed to the bolt B3 and rotates together with the bolt B3. Note that the bolt B3 and the rotary joint B1 are provided such that their central axes are positioned at the same height. Further, the central axis of the bolt B3 coincides with central axes of the speed reducer 520, the spiral spring 530, the turning member 540, and the rigidity variable actuator 550, and a reference sign W in the figure indicates the central axes of all of these members.
[0351] The link members 514, 515 perform an energy accumulation operation in which energy is accumulated in the spiral spring 530, and an energy release operation in which the energy is released from the spiral spring 530. In the energy accumulation operation, the link members 514, 515 convert a linear reciprocating motion of the reciprocation table 130 to a rotational reciprocating motion, and output the rotational reciprocating motion thus converted to the spiral spring 530. More specifically, when the reciprocation table 130 linearly reciprocates, the first link connection end 14a linearly reciprocates while rotating with the rotary joint B1 serving as a supporting point. Accordingly, the second link connection end 15b also rotationally reciprocates together with the bolt B3 with the bolt B3 serving as a supporting point. This rotational reciprocating motion is input into the spiral spring 530 via the speed reducer 520. Note that the link connection ends 14b, 15a rotate such that the angle .sub.L decreases when the first link connection end 14a moves closer to the second link connection end 15b, and the link connection ends 14b, 15a also rotate such that the angle .sub.L increases when the first link connection end 14a moves away from the second link connection end 15b.
[0352] In the energy release operation, the link members 514, 515 convert a rotational reciprocating motion of the second link connection end 15b in accordance with a torque of the spiral spring 530 to a linear reciprocating motion, and outputs the linear reciprocating motion thus converted to the reciprocation table 130. More specifically, when the second link connection end 15b rotationally reciprocates together with the bolt B3 in accordance with the torque of the spiral spring 530 with the bolt B3 serving as a supporting point, the link connection ends 14b, 15a rotate relative to each other with the rotary joint B2 serving as a supporting point, and the first link connection end 14a linearly reciprocates while rotating with the rotary joint B1 serving as a supporting point. The link connection ends 14b, 15a rotate such that the angle .sub.L increases when the first link connection end 14a moves away from the second link connection end 15b, and the link connection ends 14b, 15a also rotate such that the angle .sub.L decreases when the first link connection end 14a moves closer to the second link connection end 15b.
[0353] A turning state of the spiral spring 530 at the time when the link members 514, 515 perform the energy accumulation operation and the energy release operation is similar to that described with reference to
[0354] Similarly to Embodiment 8, the control device 560 updates the apparent spring constant so as to decrease the drive energy F of the table drive device 140, which is required to cause the reciprocation table 130 to linearly reciprocate. A calculation method for the apparent spring constant is described below. Note that, in Expression 112 to Expression 120, the motor output shaft 552 is not driven, and thus, the outer end 34 of the spiral spring 530 is disposed at the outer-end reference position (see
[0355] A current position z of the reciprocation table 130 is given by Expression 112 with the use of the current rotation angle of the second link connection end 15b and the length S of the second link member 515. Since two link members are provided, a component, in the Z-axis direction, of the length S of the second link member 515 is doubled in Expression 112.
z=2S.Math.cos Expression 112
[0356] When the reference angle .sub.0 of the second link connection end 14b is used, a reciprocation center z.sub.0 of the reciprocation table 130 is given by Expression 113 as follows.
z.sub.0=2S*cos .sub.0Expression 113
[0357] The output from the spiral spring 530 to the second link connection end 14b is converted to a thrust f in the linear motion direction by the link members 514, 515. When the apparent spring constant in the linear motion direction is k.sub.L, the thrust f is given by Expression 114. The linear motion direction indicates the Z-axis direction.
f=k.sub.L.Math.(zz.sub.0)Expression 114
[0358] Here, when Expression 112 and Expression 113 are applied to z and z.sub.0, respectively, Expression 115 is obtained.
f=k.sub.L.Math.2S.Math.(cos cos .sub.0)Expression 115
[0359] The following discusses a torque that occurs in the second link connection end 14b due to the spiral spring 530. When an apparent spring constant in the rotation direction is k.sub.R, a torque input from the spiral spring 530 into the input-output shaft 524 of the speed reducer 520 is .sub.A, a speed reducing ratio of the speed reducer 520 is n, and an efficiency of the speed reducer 520 is .sub.R, the torque is given by both Expression 116 and Expression 117.
=k.sub.R.Math.(.sub.0)Expression 116
=.sub.R.Math.n.Math..sub.AExpression 117
[0360] Further, when an actual spring constant of the spiral spring 530 is k, the torque .sub.A input from the spiral spring 530 into the input-output shaft 524 of the speed reducer 520 is given by Expression 118. Note that, when the rotation angle of the second link connection end 15b is .sub.0 due to a function of the speed reducer 520, the inner end 532 of the spiral spring 530 is turned from the inner-end reference position by a turning angle n.Math.(.sub.0) (see
.sub.A=k.Math.n.Math.(.sub.0)Expression 118
[0361] Then, when Expression 118 is substituted into Expression 117, the torque is given by Expression 119.
=.sub.R.Math.n.Math.k.Math.n.Math.(.sub.0)=.sub.Rn.sup.2.Math.k(.sub.0)Expression 119
[0362] Then, Expression 119 and Expression 116 are combined so as to obtain a solution about the apparent spring constant k.sub.R in the rotation direction, k.sub.R is given by Expression 120.
k.sub.R=n.sub.R.Math.n.sup.2.Math.kExpression 120
[0363] Here, it is assumed that the motor output shaft 552 is driven so as to turn the outer end 34 of the spiral spring 530 from the outer-end initial position by a turning angle .sub.1 (see
.sub.A=k.Math.{n.Math.(.sub.0).sub.1}Expression 121
[0364] Then, when Expression 121 is substituted into Expression 117, the torque is given by Expression 122.
=.sub.R.Math.n.Math.k.Math.{n.Math.(.sub.0).sub.1}=.sub.R.Math.n.sup.2.Math.k[1.sub.1/{n.Math.(.sub.0)}].Math.(.sub.0)Expression 122
[0365] Then, Expression 122 and Expression 116 are used so as to obtain a solution about the apparent spring constant k.sub.R in the rotation direction, k.sub.R is given by Expression 123.
k.sub.R=.sub.R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0)}]Expression 123
[0366] Subsequently, when it is assumed that the work of the first link connection end 14a in the linear motion direction is equal to the work of the second link connection end 15b in the rotation direction, Expression 124 is given as follows. Note that .sub.L indicates a rotation-linear motion conversion efficiency.
f.Math.(zz.sub.0)=.sub.L.Math..Math.(.sub.0)Expression 124
[0367] Here, when Expression 112 and Expression 113 are applied to z and z.sub.0 of Expression 124, respectively, and when Expression 122 is applied to of Expression 124, Expression 125 is obtained.
f.Math.2S.Math.(cos cos .sub.0)=.sub.L.Math..sub.R.Math.n.sup.2.Math.k[1.sub.1/{n.Math.(.sub.0)}].Math.(.sub.0).sup.2Expression 125
[0368] Then, when Expression 115 is applied to the thrust f of Expression 125, Expression 126 is obtained.
k.sub.L*4S.sup.2.Math.(cos cos .sub.0).sup.2=.sub.L.Math..sub.R.Math.n.sup.2.Math.k.Math.[1.sub.1/{n.Math.(.sub.0))}].Math.(.sub.0).sup.2Expression 126
[0369] Then, Expression 126 is solved for the apparent spring constant k.sub.L in the linear motion direction, Expression 127 is obtained.
[0370] Now, when drive energy for causing the reciprocation table 130 to linearly reciprocate is F, a mass of the reciprocation table 130 is m, and a viscosity relating to the linear reciprocating motion of the reciprocation table 130 is v, an equation of motion relating to the reciprocation table 130 is given by Expression 128. Note that m may be also a sum of a mass of the reciprocation table and a mass of both link members.
F=m.Math.(d.sup.2z/dt.sup.2)+v.Math.(dz/dt)+k.sub.L.Math.zExpression 128
[0371] When the linear reciprocating motion of the reciprocation table 130 is assumed to be a sine wave, a current position z of the reciprocation table 130 is given by Expression 129.
z=A.Math.sin(.Math.t)Expression 129
Note that A indicates an amplitude of z, indicates an angular frequency (angular velocity) at which the reciprocation table linearly reciprocates, and t indicates a time. As has been already described, is given by =2/T.
[0372] When Expression 129 is applied to Expression 128, Expression 130 is obtained.
F=A.Math.m.Math..sup.2 sin(.Math.t)+A.Math.v.Math..Math.cos(.Math.t)+A.Math.k.sub.L.Math.cos(.Math.t)=A.Math.(k.sub.Lm.Math..sup.2).Math.sin(.Math.t)+A.Math.v.Math..Math.cos(.Math.t)Expression 130
[0373] In Expression 130, when the first term is 0, the drive energy F is minimized. That is, by controlling the apparent spring constant k.sub.L in the linear motion direction so as to satisfy Expression 131, F is minimized.
k.sub.L=m.Math..sup.2Expression 131
[0374] Here, when Expression 127 and Expression 131 are combined, Expression 132 is obtained as follows.
[0375] Then, when Expression 132 is solved for .sub.1, Expression 133 is obtained as follows.
[0376] When Expression 133 is transformed, Expression 134 is obtained as follows.
[0377] By using .sub.1 of Expression 134, the drive energy F for causing the reciprocation table 130 to linearly reciprocate is minimized. In Expression 134, only a current rotation angle of the second link connection end 14b is a variable. The current rotation angle of the second link connection end 14b is changed in real time in accordance with the linear reciprocating motion of the reciprocation table 130. Accordingly, the abovementioned drive energy F can be minimized by changing the turning angle of the outer end 34 of the spiral spring 530 in real time in accordance with the current rotation angle of the second link connection end 14b. Note that, as can be understood from Expression 127, when the turning angle .sub.1 of the outer end 34 of the spiral spring 530 is changed, the apparent spring constant k.sub.L in the linear motion direction is changed.
[0378] The control device 560 changes the turning angle .sub.1 of the outer end 34 of the spiral spring 530 in real time so as to satisfy Expression 134. As a result, in a relationship shown in Expression 127, the apparent spring constant k.sub.L in the linear motion direction is changed in real time. Thus, the drive energy F for causing the reciprocation table 130 to linearly reciprocate is constantly minimized.
[0379] Note that, in the linear motion variable rigidity unit 1a, the first link member 514 and the second member 515 may be connected by a plurality of link members. However, in this case, the first link connection end 14a and the second link connection end 15b function in a manner similar to the manner in which the first link connection end 14a and the second link connection end 15b function in the present embodiment.
[0380] A linear motion variable rigidity unit 1b according to Embodiment 10 will be described mainly with reference to
[0381] The linear motion variable rigidity unit 1b includes: a linear motion-rotation conversion mechanism 10b; a speed reducer 520; a variable rigidity mechanism 36 including a spiral spring 530; a turning member 540; a rigidity variable actuator 550; a control device 560; and a support member constituted by a table support base 120. Similarly to Embodiment 9, the speed reducer 520, the spiral spring 530, the turning member 540, and the rigidity variable actuator 550 are disposed along the X-axis direction.
[0382] The linear motion-rotation conversion mechanism 10b is constituted by a rack 16, and a pinion 17 that is a gear wheel fitted to grooves 16b of the rack 16. A connection end 16a, which is one end of the rack 16, is connected to the reciprocation table 130. A longitudinal direction of the rack 16 is set to the Z-axis direction. The rack 16 is supported by a rack support portion 129 of the table support base 120 so as to linearly reciprocate along the Z-axis direction. The rack 16 linearly reciprocates together with the reciprocation table 130 along the Z-axis direction.
[0383] The pinion 17 is provided so as to rotate around its rotating shaft C at a predetermined position without moving in the Z-axis direction. One end of the rotating shaft C is supported by a pinion support portion 128 of the table support base 120. The other end of the rotating shaft C is fitted into an input-output cylinder 522 of the speed reducer 520 so as to be prevented from falling off from the input-output cylinder 522. The rotating shaft C rotates together with the input-output cylinder 522. The pinion 17 rotates together with the rotating shaft C. Note that a central axis of the rotating shaft C coincides with central axes of the speed reducer 520, the spiral spring 530, the turning member 540, and the rigidity variable actuator 550, and a reference sign W in the figure indicates the central axes of all of these members.
[0384] A linear reciprocating motion of the rack 16 is converted to a rotational reciprocating motion of the pinion 17 and the rotational reciprocating motion is output to the spiral spring 530. A rotational reciprocating motion of the pinion 17 is converted to a linear reciprocating motion of the rack 16 so as to cause the reciprocation table 130 to linearly reciprocate.
[0385] A method of calculating an apparent spring constant in the case of employing the linear motion variable rigidity unit 1b is the method described using Expression 89 to Expression 111. Note that, in the case of the present embodiment, indicates a current rotation angle of the pinion 17. .sub.0 indicates a reference angle that is a rotation angle of the pinion 17 at the time when the reciprocation table 130 is disposed at a reciprocation central position z.sub.0. Further, p indicates a moving amount of the rack 16 in the Z-axis direction at the time when the pinion 17 rotates once.
[0386] The control device 560 changes a turning angle .sub.1 of an outer end 34 of the spiral spring 530 in real time so as to satisfy Expression 111. As a result, in the relationship shown in Expression 105, an apparent spring constant k.sub.L in the linear motion direction is changed in real time. Thus, drive energy F for causing the reciprocation table 130 to linearly reciprocate is constantly minimized. Note that the linear motion-rotation conversion mechanism 10b is constituted by the rack 16 and the pinion 17, that is, the linear motion-rotation conversion mechanism 10b has a simple configuration.
[0387] Subsequently described is Embodiment 11 with reference to
[0388] In the present embodiment, a linear motion variable rigidity unit is attached to a machining center, which is a machine tool. In the present embodiment, the linear motion variable rigidity unit described in Embodiment 8 is attached to the machining center. Note that the linear motion variable rigidity unit described in Embodiment 9 or Embodiment 10 may be attached to the machining center.
[0389] A machining center 200 illustrated in
[0390] The cutting object reciprocation table 220 is disposed at a position distanced from the cutting member support table 230 in the Z-axis direction by a predetermined distance. The cutting object reciprocation table 220 can linearly reciprocate along the Z-axis direction on rails Ra provided on the base 210, so as to move closer to or move away from the cutting member support table 230. The linear reciprocating motion of the cutting object reciprocation table 220 is driven by a table drive device 141, which is a linear motor, for example. Drive energy required for the linear reciprocating motion is minimized by assistance provided by the first linear motion variable rigidity unit 502. The table drive device 141 is constituted by, for example, the rails Ra and the sliders AT, which have been described in Embodiment 8.
[0391] An object support base 222 is provided on the cutting object reciprocation table 220. The object support base 222 supports the cutting object 224. The cutting object 224 is columnar, for example, and extends in the Y-axis direction. The cutting object 224 rotates together with the object support base 222 around a central axis of the cutting object 224.
[0392] The cutting member reciprocation table 250 can linearly reciprocate on the rails Ra provided on the cutting member support tables 230, along the Y-axis direction. The linear reciprocating motion of the cutting member reciprocation table 250 is driven by a table drive device 143, which is a linear motor, for example. Drive energy required for the linear reciprocating motion is minimized by assistance provided by the second linear motion variable rigidity unit 503. The table drive device 143 is constituted by, for example, the rails Ra and the sliders AT, which have been described in Embodiment 8.
[0393] The cutting member 258 is attached to a distal end of the cutting member reciprocation table 250 via a rotational member 256. The cutting member 258 extends in the Z-axis direction toward the cutting object 224 and makes contact with an outer peripheral surface of the cutting object 224. Note that a position of the cutting member 258 in the X-axis direction is adjusted by the cutting member support table 230. The cutting member 258 rotates together with the rotational member 256 around a central axis of the cutting member 258 so as to grind the outer peripheral surface of the cutting object 224. The cutting member reciprocation table 250 causes the cutting member 258 to linearly reciprocate along the Y-axis direction. Accordingly, the cutting member 258 grinds the cutting object 224 along the Y-axis direction. As described above, the cutting object 224 rotates together with the object support base 222 in a circumferential direction. Accordingly, the cutting member 258 grinds the cutting object 224 over the circumferential direction.
[0394] Note that the second linear motion variable rigidity unit 503 minimizes drive energy at the time when the cutting member reciprocation table 250 linearly reciprocates along the Y-axis direction (a vertical direction), and thus, an effect of a gravitational force g is considered in calculation of the apparent spring constant for minimizing the drive energy. That is, Expression 106 and Expression 108 to Expression 111 can be replaced with Expression 135 and Expression 136 to Expression 139 as follows.
[0395] An equation of motion relating to the reciprocation table 250 is given by Expression 135.
F=m.Math.(d.sup.2z/dt.sup.2)+v.Math.(dz/dt)+k.sub.L.Math.z+m.Math.gExpression 135
[0396] When Expression 107 is substituted into Expression 135, Expression 136 is obtained.
F=A.Math.(k.sub.Lm.Math..sup.2).Math.sin(.Math.t)+A.Math.v.Math.cos(.Math.t)+m.Math.gExpression 136
[0397] When A.Math.(k.sub.Lm.Math..sup.2).Math.sin(.Math.t)+m.Math.g=0 is satisfied in Expression 136, the drive energy F is minimized. At this time, the apparent spring constant k.sub.L is as follows.
[0398] When Expression 105 and Expression 137 are combined, Expression 138 is obtained as follows.
[0399] When Expression 138 is solved for .sub.1, Expression 139 is obtained as follows.
When .sub.1 is substituted into Expression 105, the apparent spring constant k.sub.L in the Y-axis direction, which is the linear motion direction, is changed.
[0400] Embodiments for carrying out the disclosure have been described with reference to the drawings. However, the disclosure is not limited to the structures, the configuration, the appearances, the shapes, and the like described in the above embodiments, and various modifications, additions, and deletes may be made without departing from the scope of the disclosure. For example, in each of the linear motion variable rigidity units 1, 1a, 1b, the speed reducer 520 may not be provided. That is, the spiral spring 530 may be directly connected to the nut 13 (see
[0401] An object to which the linear motion variable rigidity unit is attached is not limited to the grinding machine 100 and the machining center 200, and may be any other machine tool. Further, the object to which the linear motion variable rigidity unit is attached is not limited to a machine tool, and may be any linear reciprocating body that linearly reciprocates.
[0402] In all of the above-described embodiments, consumed energy is reduced, i.e., energy is efficiently used. The above-described embodiments may be combined with each other. That is, energy of the rotational motion or the linear motion of the user, the device, or the like can be efficiently accumulated by adding a load or reducing a load during the rotational motion or the linear motion, considering the influence of the gravitational force on the rotational motion or the linear motion, the influence of the inertia force on the rotational motion or the linear motion, and/or the influence of the central position of the reciprocating swing motion locus on the rotational motion or the linear motion, or converting the linear motion to the rotational motion or converting the rotational motion to the linear motion with the use of the linear motion-rotation conversion mechanism. Thus, the rotational motion or the linear motion can be efficiently assisted with the use of the accumulated energy, for example, by adding a load or reducing a load during the rotational motion or the linear motion, considering the influence of the gravitational force on the rotational motion or the linear motion, the influence of the inertia force on the rotational motion or the linear motion, and/or the influence of the central position of the reciprocating swing motion locus on the rotational motion or the linear motion.