The present invention relates to a joint device.
In the related art, as a joint device used for a coupling portion coupling two members, there is a joint device including an expansion and contraction device capable of changing an angle formed by the two members. Such a joint device includes, for example, a prosthetic leg used for a knee joint. Patent Literature 1 discloses that a sensor for detecting contraction motion of a muscle at a cut-off end portion of an amputated leg is provided in a thigh socket of a prosthetic leg attached to the cut-off end portion of the amputated leg, and a throttling condition of a variable valve of a hydraulic cylinder for adjusting resistance of bending and stretching of a knee joint portion is controlled based on detection information from the sensor.
However, in the prosthetic leg disclosed in Patent Literature 1, although resistance of bending and stretching can be generated, power of bending and stretching cannot be generated. In particular, in order to smoothly ascend steps, it is necessary to stretch the knee joint in a state where a load is applied.
The present invention provides a joint device capable of stretching and bending a coupling portion by power of a power source.
A first invention provides a joint device including:
A second invention provides a joint device including;
A third invention provides a joint device including:
According to the present invention, the coupling portion can be stretched and bent via the power transmission portion which transmits power of the power source.
Hereinafter, each embodiment of an electric prosthetic leg as an example of a joint device of the present invention and step ascending control when ascending steps by using this electric prosthetic leg will be described with reference to the drawings. In the following description, a front-rear direction, a left-right direction, and an upper-lower direction are defined with reference to a user of the electric prosthetic leg. In the drawings, a front side of the electric prosthetic leg is denoted by Fr, a rear side is denoted by Rr, a left side is denoted by L, a right side is denoted by R, an upper side is denoted by U, and a lower side is denoted by D.
An electric prosthetic leg 1 of the present embodiment is a prosthetic leg for a person without a knee. As illustrated in
The upper-knee member 20 includes an upper wall portion 22 provided with an adapter 21 connected to a socket (not illustrated), and a pair of upper side wall portions 23 extending downward from both left and right ends of the upper wall portion 22, and the upper-knee member 20 has a substantially U-shape with a lower opening when viewed from the front-rear direction.
The lower-knee member 10 includes a lower wall portion 12 provided with a leg portion 11, and a pair of lower side wall portions 13 extending upward from both left and right ends of the lower wall portion 12, and has a substantially U-shape with an upper opening when viewed in the front-rear direction.
The pair of lower side wall portions 13 of the lower-knee member 10 are connected between the pair of upper side wall portions 23 of the upper-knee member 20 so as to be rotatable about a pivoting portion 35. By this mechanism, the knee joint mechanism 30 is configured to couple the lower-knee member 10 and the upper-knee member 20 so that the angle formed by the lower-knee member 10 and the upper-knee member 20 can be changed.
The expansion and contraction device 40 capable of changing the angle formed by the lower-knee member 10 and the upper-knee member 20 is provided in a space formed between the upper-knee member 20 and the lower-knee member 10.
Referring also to
The transmission T includes a transmission case 60 having a rectangular shape when viewed from the front-rear direction and having a top plate portion 61, a bottom plate portion 62, and a pair of side plate portions 63 connecting left and right ends of the top plate portion 61 and the bottom plate portion 62. On the transmission case 60, a pair of pivoting blades 64 extending downward from the bottom plate portion 62 is supported by a pivoting support wall 14 extending upward from a bottom wall portion 12 of the lower-knee member 10 so as to be swingable and immovable about a lower swing portion 70.
The motor M is disposed forward and upward of the top plate portion 61 of the transmission case 60 such that an output shaft 71 protrudes into the transmission case 60 through the top plate portion 61. The first spindle unit SP1 is disposed on an opposite side of the motor M across the connection and disconnection mechanism 50 in the front-rear direction. In other words, the motor M is disposed forward of the connection and disconnection mechanism 50 in the front-rear direction, and the first spindle unit SP1 is disposed rearward of the connection and disconnection mechanism 50 in the front-rear direction. Accordingly, even when the motor M is mounted on the electric prosthetic leg 1, it is possible to prevent an increase in a size of the electric prosthetic leg 1 in a width direction while maintaining a balance in the front-rear direction.
The second spindle unit SP2 which converts the rotational power output from the motor M into translational motion of the operator 55 of the connection and disconnection mechanism 50 is disposed between the motor M and the first spindle unit SP1 in the front-rear direction. The output shaft 71 of the motor M, a first spindle 73 of the first spindle unit SP1, and a second spindle 75 of the second spindle unit SP2 are disposed parallel to each other, and disposed to face the upper-lower direction in a state where the knee joint mechanism 30 is completely stretched.
The first spindle unit SP1 includes the first spindle 73 formed with a male thread 73a and a sleeve 74 formed with a female thread 74a. The sleeve 74 performs translational motion along an axis of the first spindle 73 by rotation of the first spindle 73. In the present embodiment, the first spindle 73 performs rotational motion by receiving rotational power of the motor M transmitted by the transmission T. On the other hand, the sleeve 74 is attached to a pair of inner side wall portions 24 extending downward from the upper wall portion 22 of the upper-knee member 20 so as to be swingable and immovable about an upper swing portion 25. Therefore, when the first spindle 73 rotates to one side (in direction of arrow D1 in
That is, a distance between the sleeve 74 and the transmission T increases and decreases in accordance with a rotation direction of the first spindle 73. Since the sleeve 74 is immovably attached to the upper-knee member 20 as described above, the distance between the sleeve 74 and the transmission T increases and decreases in accordance with the rotation direction of the first spindle 73. Therefore, the lower-knee member 10 to which the transmission T is attached and the upper-knee member 20 to which the sleeve 74 is attached rotate about the pivoting portion 35. Accordingly, the angle formed by the upper-knee member 20 and the lower-knee member 10 changes.
As illustrated in
The first transmission mechanism T1 includes a first drive gear 78 immovably disposed on an upper side of the second spindle 75 of the second spindle unit SP2, and a first driven gear 79 disposed on the first spindle 73 of the first spindle unit SP1 so as to rotate integrally with the first spindle 73 and meshing with the first drive gear 78.
The second transmission mechanism T2 includes a second drive gear 80 immovably disposed on a lower side of the second spindle 75 of the second spindle unit SP2, and a second driven gear 81 disposed on the first spindle 73 of the first spindle unit SP1 so as to rotate integrally with the first spindle 73 and meshing with the second drive gear 80.
The first transmission mechanism T1 serves as a first power transmission path and transmits power of the motor M at a first transmission gear ratio. The second transmission mechanism T2 serves as a second power transmission path and transmits the power of the motor M at a second transmission gear ratio different from the first transmission gear ratio. By providing the two power transmission paths having different transmission gear ratios, it is possible to switch an operation speed and generated power of stretching and bending of the knee joint mechanism 30. As long as the first transmission gear ratio and the second transmission gear ratio are different from each other, one of the first transmission mechanism T1 and the second transmission mechanism T2 may be a speed reduction mechanism and the other may be a speed acceleration mechanism, one of the first transmission mechanism T1 and the second transmission mechanism T2 may be a constant speed mechanism and the other may be a speed reduction mechanism or a speed acceleration mechanism, both of the first transmission mechanism T1 and the second transmission mechanism T2 may be speed reduction mechanisms, and both of the first transmission mechanism T1 and the second transmission mechanism T2 may be speed acceleration mechanisms.
It is preferable that, when the first transmission gear ratio is a ratio of a post-shift rotation speed, which is a rotation speed on an opposite side of the motor M (first spindle unit SP1 side) in the first transmission mechanism T1, to a pre-shift rotation speed, which is a rotation speed on a motor M side in the first transmission mechanism T1, and the second transmission gear ratio is a ratio of a post-shift rotation speed, which is a rotation speed on the opposite side of the motor M (first spindle unit SP1 side) in the second transmission mechanism T2, to a pre-shift rotation speed, which is a rotation speed on the motor M side in the second transmission mechanism T2, the first transmission gear ratio is smaller than the second transmission gear ratio.
For example, when the first transmission gear ratio of the first transmission mechanism T1 is smaller than 1, the rotation speed on the opposite side of the motor M (first spindle unit SP1 side) become lower than the rotation speed on the motor M side, and a torque increases. When the second transmission gear ratio of the second transmission mechanism T2 is larger than 1, the rotation speed on the opposite side of the motor M (first spindle unit SP1 side) become higher than the rotation speed on the motor M side, and a torque decreases. In this case, the first drive gear 78 has a smaller diameter than the second drive gear 80, and the first drive gear 78 and the motor M can be disposed close to each other. In the present embodiment, the first transmission mechanism T1 is disposed closer to the motor M than the second transmission mechanism T2. More specifically, the motor M is disposed in front of the first drive gear 78 so as to overlap the first drive gear 78 in the upper-lower direction.
The first transmission mechanism T1 and the second transmission mechanism T2 are switched by the connection and disconnection mechanism 50. The connection and disconnection mechanism 50 includes an upper clutch 50U which switches disconnection and connection of power in the first transmission mechanism T1, a lower clutch 50D which switches disconnection and connection of power in the second transmission mechanism T2, and the operator 55 which rotates integrally with the input gear 77.
The upper clutch 50U is a dog clutch including a first engagement element 51 which is an engagement element on the motor M side and a second engagement element 52 which is an engagement element on a first transmission mechanism T1 side. More specifically, the first engagement element 51 is provided above the operator 55 and the input gear 77 so as to rotate integrally with the input gear 77. The second engagement element 52 is provided at a lower part of the first drive gear 78 so as to be engageable with the first engagement element 51 and rotate integrally with the first drive gear 78. The second engagement element 52 and the first drive gear 78 are attached at an upper part of the second spindle 75 of the second spindle unit SP2 so as to be rotatable and immovable relative to the second spindle 75.
The lower clutch 50D is a dog clutch including a third engagement element 53 which is an engagement element on the motor M side and a fourth engagement element 54 which is an engagement element on a second transmission mechanism T2 side. More specifically, the third engagement element 53 is provided below the operator 55 and the input gear 77 so as to rotate integrally with the input gear 77. The fourth engagement element 54 is provided at an upper part of the second drive gear 80 so as to be engageable with the third engagement member 53 and rotate integrally with the second drive gear 80. The fourth engagement element 54 and the second drive gear 80 are attached at a lower part of the second spindle 75 of the second spindle unit SP2 so as to be rotatable and immovable relative to the second spindle 75.
The operator 55 is attached to the input gear 77 so as to rotate integrally with the input gear 77 as described above, and the first engagement member 51 and the third engagement element 53 are attached to an upper portion and a lower portion thereof so as to integrally rotate. The operator 55 is interposed substantially at a center of the second spindle 75, that is, between the first drive gear 78 and the second drive gear 80 in the upper-lower direction. Here, the operator 55 is a screw nut 76 of the second spindle unit SP2. The second spindle unit SP2 includes the second spindle 75 formed with a male thread, and the screw nut 76 (operator 55) formed with a female thread. In accordance with rotation of the input gear 77, the screw nut 76 (operator 55) performs translational motion while rotating along an axis of the second spindle 75.
The screw nut 76 (operator 55) moves upward in the upper-lower direction, which is a moving direction of the translational motion, when the motor M rotates in a first direction (direction of arrow D1 in
The connection and disconnection mechanism 50 can take three states of a first gear shift state, a second gear shift state, and a free state by translational motion of the operator 55 along the axis of the second spindle 75.
In the first gear shift state, as illustrated in
In the second gear shift state, as illustrated in
In the free state, as illustrated in
In
In the electric prosthetic leg 1 configured in this way, it is possible to smoothly perform an ascending operation of steps, which has been required to be done one by one by a leg (healthy leg) on a non-prosthetic-leg side, with a passive prosthesis leg including a passive damper in the related art.
Specifically, as illustrated in
At this time, as illustrated in
When the connection and disconnection mechanism 50 is in the first gear shift state, the power of the motor M is transmitted to the output gear 72, the input gear 77, the operator 55, the first engagement element 51, the second engagement element 52, the first drive gear 78, the first driven gear 79, and the first spindle unit SP1. When the first drive gear 78 rotates together with the input gear 77 in the second direction (direction of arrow D2 in
On the other hand, in order to smoothly perform an ascending operation of the steps, as illustrated in
At this time, as illustrated in
When the connection and disconnection mechanism 50 is in the second gear shift state, the power of the motor M is transmitted to the output gear 72, the input gear 77, the operator 55, the third engagement element 53, the fourth engagement element 54, the second drive gear 80, the second driven gear 81, and the first spindle unit SP1. When the second drive gear 80 rotates together with the input gear 77 in the first direction (direction of arrow D1 in
By bringing the connection and disconnection mechanism 50 into the free state during normal walking, power transmission between the motor M and the transmission T can be interrupted, thereby preventing interference with the walking.
In the electric prosthetic leg 1 configured in this way, the knee joint mechanism 30 can be stretched and bent via the transmission T which transmits the power of the motor M. The motor M is controlled by a control system 100 to be described later. A pivoting range of the knee joint mechanism 30 is limited to 180° or less. In a state where the knee joint mechanism 30 is stretched, the angle formed by the lower-knee member 10 and the upper-knee member 20 is about 180°, and in a state where the knee joint mechanism 30 is bent, the formed angle is less than 180°.
Since the transmission T includes two power transmission paths having different transmission gear ratios, the operation speed and generated power of stretching and bending of the knee joint mechanism 30 can be switched. In particular, a required operation speed and generated power are different between a time of bending and a time of stretching the knee joint mechanism 30 when ascending steps, and the power transmission path can be changed between the time of bending and the time of stretching the knee joint mechanism 30.
Since the connection and disconnection mechanism 50 interposed between the motor M and the transmission T includes the upper clutch 50U interposed between the motor M and the first transmission mechanism T1 and the lower clutch 50D interposed between the motor M and the second transmission mechanism T2, the two power transmission paths can be appropriately switched.
In particular, since the expansion and contraction device 40 includes the second spindle unit SP2 which converts the rotational power output from the motor M into the translational motion of the operator 55, the operator 55 can be controlled by one motor M and the stretching and bending of the knee joint mechanism 30 can be controlled. Further, since the transmission T is configured to be switched to the first gear shift state, the second gear shift state, and the free state by one operator 55, it is possible to avoid the two power transmission paths from being connected at the same time.
In a state where the knee joint mechanism 30 is stretched, when a region in which the angle formed by the lower-knee member 10 and the upper-knee member 20 is less than 180° (region on rear (calf) side of line connecting pivoting portion 35 and lower swing portion 70 in
The electric prosthetic leg 1 according to a second embodiment is different from the electric prosthetic leg 1 according to the first embodiment in a configuration of the expansion and contraction device 40. More specifically, in the expansion and contraction device 40 according to the first embodiment, the translational motion of the operator 55 is implemented by converting the rotational power output from the motor M by the second spindle unit SP2. On the other hand, in the expansion and contraction device 40 according to the second embodiment, the translational motion of the operator 55 is implemented by a clutch actuator ACT which is a drive source different from the motor M and a clutch fork 90 which transmits power of the clutch actuator ACT to the operator 55. In the following description, the expansion and contraction device 40 of the electric prosthetic leg 1 according to the second embodiment will be described with reference to
As illustrated in
The clutch actuator ACT is a power source different from the motor M, and performs translational motion along an axial direction (upper-lower direction) of the support shaft 95 as indicated by an arrow Y1 in
The clutch fork 90 is configured to be swingable around a swing shaft 65 as indicated by an arrow Y2 in
The transmission T includes the output gear 72 provided on the output shaft 71 of the motor M, a first input gear 77A and a second input gear 77B provided substantially in a central portion of the support shaft 95 and meshing with the output gear 72, the first transmission mechanism T1, and the second transmission mechanism T2. The first input gear 77A and the second input gear 77B constitute the input gear 77.
The first transmission mechanism T1 includes the first drive gear 78 immovably provided on an upper side of the support shaft 95, and the first driven gear 79 provided on the first spindle 73 of the first spindle unit SP1 so as to rotate integrally with the first spindle 73 and meshing with the first drive gear 78.
The second transmission mechanism T2 includes the second drive gear 80 immovably provided on a lower side of the support shaft 95, and the second driven gear 81 provided on the first spindle 73 of the first spindle unit SP1 so as to rotate integrally with the first spindle 73 and meshing with the second drive gear 80.
The transmission gear ratios of the first transmission mechanism T1 and the second transmission mechanism T2 are the same as those in the first embodiment, and therefore the description thereof is omitted here. The first transmission mechanism T1 and the second transmission mechanism T2 are switched by the connection and disconnection mechanism 50. The connection and disconnection mechanism 50 includes the upper clutch 50U interposed between the motor M and the first transmission mechanism T1, the lower clutch 50D interposed between the motor M and the second transmission mechanism T2, and the operator 55.
The upper clutch 50U is a dog clutch including a first engagement element 51 which is an engagement element on the motor M side and a second engagement element 52 which is an engagement element on a first transmission mechanism T1 side. More specifically, the first engagement element 51 is provided at an upper part of the first input gear 77A so as to rotate integrally with the first input gear 77A. The second engagement element 52 is provided at a lower part of the first drive gear 78 so as to be engageable with the first engagement element 51 and rotate integrally with the first drive gear 78. The second engagement element 52 and the first drive gear 78 are attached at an upper part of the support shaft 95 so as to be rotatable and immovable relative to the support shaft 95.
The lower clutch 50D is a dog clutch including a third engagement element 53 which is an engagement element on the motor M side and a fourth engagement element 54 which is an engagement element on a second transmission mechanism T2 side. More specifically, the third engagement element 53 is provided at a lower part of the second input gear 77B so as to rotate integrally with the second input gear 77B. The fourth engagement element 54 is provided at an upper part of the second drive gear 80 so as to be engageable with the third engagement member 53 and rotate integrally with the second drive gear 80. The fourth engagement element 54 and the second drive gear 80 are attached to a lower part of the support shaft 95 so as to be rotatable and immovable relative to the support shaft 95.
The operator 55 includes annular slide clutches 56 which are constantly engaged with the coupling pins 93 of the clutch fork 90, and a bearing 57 which performs translational motion together with the slide clutches 56, and is disposed between the first input gear 77A and the second input gear 77B in the upper-lower direction.
The slide clutch 56 is provided with a coupling hole with which the coupling pin 93 of the clutch fork 90 is engaged. The coupling hole absorbs swing of the clutch fork 90 and converts the swing into translational motion of the slide clutch 56 in the upper-lower direction.
The bearing 57 includes an outer ring 57a non-rotatably supported by the slide clutch 56, an inner ring 57b configured to rotate integrally with the first input gear 77A provided with the first engagement element 51 and the second input gear 77B provided with the third engagement element 53, and a rolling body 57c disposed between the outer ring 57a and the inner ring 57b and allowing relative rotation between the outer rng 57a and the inner ring 57b.
The inner ring 57b is supported by an outer peripheral portion of a support flange 96 which is key-coupled to the support shaft 95 together with the first input gear 77A and the second input gear 77B so as to be able to be translated in the upper-lower direction.
The slide clutch 56 and the bearing 57 (operator 55) move upward along the support shaft 95 when one end of the clutch fork 90 moves downward by the clutch actuator ACT, and move downward along the support shaft 95 when the one end of the clutch fork 90 moves upward by the clutch actuator ACT. A predetermined gap is provided between the first input gear 77A and each of the slide clutch 56 and the outer ring 57a and in the upper-lower direction, so that the first input gear 77A does not interfere with the slide clutch 56 and the outer ring 57a which are non-rotating members. Similarly, a predetermined gap is provided between the second input gear 77B and each of the slide clutch 56 and the outer ring 57a in the upper-lower direction, so that the second input gear 77B does not interfere with the slide clutch 56 and the outer ring 57a which are non-rotating members.
The connection and disconnection mechanism 50 can take three states of the first gear shift state, the second gear shift state, and the free state by the slide clutch 56 and the bearing 57 (operator 55) performing translational motion in the upper-lower direction along an axis of the support shaft 95.
In the first gear shift state, the slide clutch 56 and the bearing 57 (operator 55) move upward, so that the first engagement element 51 and the second engagement element 52 are in a connected state and the third engagement element 53 and the fourth engagement element 54 are in a disconnected state as in
In the second gear shift state, the slide clutch 56 and the bearing 57 (operator 55) move downward, so that the first engagement element 51 and the second engagement element 52 are in a disconnected state and the third engagement element 53 and the fourth engagement element 54 are in a connected state as in
In the free state, similarly to
In the electric prosthetic leg 1 configured as described above, as in the first embodiment, the knee joint mechanism 30 can be stretched and bent via the transmission T which transmits the power of the motor M, and an operation and effect described in the electric prosthetic leg 1 according to the first embodiment can be obtained. In the electric prosthetic leg 1 according to the second embodiment, the operator 55 can be switched more stably by switching the operator 55 using the clutch actuator ACT which is a power source different from the motor M for stretching and bending the knee joint mechanism 30.
<Step Ascending Control>
Next, step ascending control using the electric prosthetic leg 1 according to the first embodiment and the second embodiment described above will be described by taking the electric prosthetic leg 1 according to the second embodiment as an example. In the following description, a leg to which no applied weight is applied from an outside, in other words, a leg which does not support a body weight is referred to as an idling leg, and a leg to which an applied weight is applied from the outside, in other words, a leg which supports the body weight is referred to as a standing leg. Although a weight (own weight) due to gravity of the electric prosthetic leg 1 normally acts on the electric prosthetic leg 1, it is noted that the own weight is not included in the applied weight from an outside.
As illustrated in
The control system 100 of the electric prosthetic leg 1 includes an applied and extracted weight acquisition unit 102 which acquires an applied weight FZ applied to the lower-knee member 10, a knee angle calculation unit 103 which acquires a knee angle θ which is an angle between a center line CL5 of the lower leg 5 and a center line CL4 of the thigh 4, a hip joint torque calculation unit 104 which calculates a hip joint torque MYh which acts on a hip joint 7 due to the applied weight FZ applied to the lower-knee member 10, a thigh angle calculation unit 106 which calculates a thigh angle 1 which is an angle of the thigh 4 with respect to a virtual line LN extending in a vertical direction through the hip joint 7, a motor control unit 108 which controls the motor M. and an connection and disconnection mechanism control unit 110 which controls a state of the connection and disconnection mechanism 50. In the first embodiment, it is noted that the motor control unit 108 also serves as the connection and disconnection mechanism control unit 110.
The applied and extracted weight acquisition unit 102 acquires the applied weight FZ, which is an axial force applied to the lower-knee member 10, from the applied and extracted weight sensor 201. The applied weight FZ applied to the lower-knee member 10 may be a detection value of the applied and extracted weight sensor 201 or a predicted value. In the present embodiment, a positive direction is a direction in which the applied weight FZ applied to the lower-knee member 10 is in a tensile direction.
The knee angle calculation unit 103 obtains the knee angle θ by subtracting an angle detected by the knee angle sensor 205 from 180°. The knee angle θ is 0° when the center line CL5 of the lower leg 5 and the center line CL4 of the thigh 4 coincide with each other, and becomes larger in the positive direction as the knee joint mechanism 30 bends.
The hip joint torque calculation unit 104 multiplies the applied weight FZ applied to the lower-knee member 10 by a distance from the center line CL5 of the lower leg 5 to the hip joint 7 (length of thigh 4) to obtain the hip joint torque MYh. When the length of the thigh 4 of a user is L and the knee angle is 0, the hip joint torque MYh is expressed by the following Formula (1). The positive direction is a direction in which the hip joint 7 is pivoted forward (clockwise in
MYh=FZ×L×sin θ (1)
The thigh angle calculation unit 106 calculates the thigh angle R based on output values of the shin IMU 203 and the knee angle sensor 205. The thigh angle 1 is a positive value when the thigh 4 is behind the virtual line LN extending in the vertical direction through the hip joint 7, and is a negative value when the thigh 4 is ahead of the virtual line LN.
The motor control unit 108 controls drive and stop of the motor M and an output when the motor M is driven. The step ascending control will be described later.
The connection and disconnection mechanism control unit 110 switches the connection and disconnection mechanism 50 to the first gear shift state, the second gear shift state, and the free state described above by switching the operator 55 based on the applied weight FZ acquired by the applied and extracted weight acquisition unit 102.
Specifically, when the applied and extracted weight acquisition unit 102 acquires or predicts a transition from a state in which no applied weight is applied to a state in which an applied weight is applied, in other words, when the electric prosthetic leg 1 transitions from an idling leg to a standing leg or the transition is predicted, the connection and disconnection mechanism control unit 110 switches the upper clutch 50U out of the upper clutch 50U and the lower clutch 50D of the connection and disconnection mechanism 50 to an engaged state and sets the state to the first gear shift state. Accordingly, in a case of the standing leg where the knee joint mechanism 30 is stretched from the bent state, power can be transmitted via the first transmission mechanism T1 having a small transmission gear ratio, and large power can be transmitted to the electric prosthetic leg 1 in a state of being applied an applied weight from the outside.
On the other hand, when the applied and extracted weight acquisition unit 102 acquires or predicts a transition from a state in which an applied weight is applied to a state in which no applied weight is applied, in other words, when the electric prosthetic leg 1 transitions from the standing leg to the idling leg or the transition is predicted, the connection and disconnection mechanism control unit 110 switches the lower clutch 50D out of the upper clutch 50U and the lower clutch 50D of the connection and disconnection mechanism 50 to an engaged state and sets the state to the second gear shift state. Accordingly, in a case of the idling leg where the knee joint mechanism 30 is bent from the stretched state, power can be transmitted via the second transmission mechanism T2 having a large transmission gear ratio, and the knee joint mechanism 30 can be quickly bent in a state where an applied weight is not applied to the electric prosthetic leg 1 from the outside.
The control system 100 may include a traveling direction acquisition unit which acquires a traveling direction of the user of the electric prosthetic leg 1. When the traveling direction acquisition unit detects an angular velocity toward an upper side in the vertical direction, such as when ascending steps or ascending a slope, based on a detection value of the shin IMU 203, the step ascending control may be executed, or the step ascending control may be executed based on an input of the user.
Hereinafter, a control flow of a first example of the step ascending control will be described.
As illustrated in
Then, when the electric prosthetic leg 1 lands and an applied weight is applied to the electric prosthetic leg 1 in a compression direction, the applied weight FZ approaches zero and takes a negative value when the applied weight further increases.
Referring to
When the electric prosthetic leg 1 is the standing leg, the hip joint torque calculation unit 104 calculates the hip joint torque MYh acting on the hip joint 7 by the applied weight FZ (S3). When the electric prosthetic leg 1 is applied an applied weight in the compression direction, a hip joint torque which pivots the hip joint 7 backward (counterclockwise in
When the calculated hip joint torque MYh is equal to or less than 0 (N·m) (YES in S4), that is, when the torque acts in the direction in which the hip joint 7 is pivoted backward (counterclockwise in
On the other hand, when the calculated hip joint torque MYh is larger than 0 (NO in S4), that is, when the torque acts in a direction in which the hip joint 7 is pivoted forward (counterclockwise in
When the electric prosthetic leg 1 is the idling leg, as illustrated in
When the thigh angle β is smaller than 0° in step S10 (NO in S10), the knee target angle is set as a value obtained by multiplying the thigh angle β by −1 and adding θk1, the motor M is current-controlled (S12). A in
On the other hand, in step S8, when the thigh angle β is equal to or less than the threshold value θh1 (NO in S8), and when the knee joint mechanism 30 is bent from step S12 and the thigh angle β becomes equal to or less than the threshold value θh1 (YES in S14), it is determined to be in the latter stage of the idling leg, that is, the knee joint mechanism 30 is to be stretched when the user lowers the thigh 4 (S13). In the latter stage of the idling leg, subsequently, it is determined whether the thigh angle β is smaller than a threshold value θh2 (θh2 is negative and θh2>θh1) (S15). When the thigh angle β is smaller than θh2 (YES in S15), the knee target angle is set to a value obtained by multiplying the thigh angle β by −1 and adding θh2, and the motor M is current-controlled until the thigh angle R becomes equal to or larger than θh2 (S16). In step S15, when the thigh angle R is equal to or larger than θh2 (NO in S15), the knee target angle is set to 0° and the motor M is current-controlled (S17). B in
As illustrated in
The control system 100 of the electric prosthetic leg 1 includes the applied and extracted weight acquisition unit 102 which acquires the applied weight FZ applied to the lower-knee member 10, the knee angle calculation unit 103 which acquires the knee angle θ which is the angle between the center line CL5 of the lower leg 5 and the center line CIA of the thigh 4, the thigh angle calculation unit 106 which calculates the thigh angle θ which is the angle of the thigh 4 with respect to the virtual line LN extending in the vertical direction through the hip joint 7, a thigh applied weight acquisition unit 112 which acquires the applied weight FZ2 applied to the thigh 4, a knee torque acquisition unit 113 which acquires the knee torque MYk, a knee shear force acquisition unit 114 which acquires the knee shear force FXk applied to the thigh 4, the hip joint torque calculation unit 104 which calculates the hip joint torque MYh which acts on the hip joint 7 by the knee torque MYk and the knee shear force FXk, the motor control unit 108 which controls the motor M, and the connection and disconnection mechanism control unit 110 which controls a state of the connection and disconnection mechanism 50.
The applied and extracted weight acquisition unit 102, the knee angle calculation unit 103, the thigh angle calculation unit 106, and the motor control unit 108 are similar as those in the first example, and description thereof will be omitted.
The thigh applied weight acquisition unit 112, the knee torque acquisition unit 113, and the knee shear force acquisition unit 114 respectively acquire the applied weight FZ2, the knee torque MYk, and the knee shear force FXk from the force sensor 207. In the present embodiment, the positive direction is a direction when the applied weight FZ2 applied to the thigh 6 is in the compression direction.
The hip joint torque calculation unit 104 adds a value obtained by multiplying the length L of the thigh 4 by the knee shear force FXk to the knee torque MYk to obtain the hip joint torque MYh. In this example, the hip joint torque MYh is expressed by the following Formula (2). The positive direction is a direction in which the hip joint 7 is pivoted forward (clockwise in
MYh=MYk+L×FXk (2)
The connection and disconnection mechanism control unit 110 switches the connection and disconnection mechanism 50 to the first gear shift state, the second gear shift state, and the free state described above based on the applied weight FZ2 acquired by the thigh applied weight acquisition unit 112.
Specifically, when the thigh applied weight acquisition unit 112 acquires or predicts a transition from a state in which no applied weight is applied from the outside to a state in which an applied weight is applied, in other words, when the electric prosthetic leg 1 transitions from an idling leg to a standing leg or the transition is predicted, the upper clutch 50U out of the upper clutch 50U and the lower clutch 50D of the connection and disconnection mechanism 50 is switched to an engaged state and sets the state to the first gear shift state. Accordingly; in a case of the standing leg where the knee joint mechanism 30 is stretched from the bent state, power can be transmitted via the first transmission mechanism T1 having a small transmission gear ratio, and large power can be transmitted to the electric prosthetic leg 1 in a state of being applied an applied weight from the outside.
On the other hand, when the thigh applied weight acquisition unit 112 acquires or predicts a transition from a state in which an applied weight is applied from the outside to a state in which no applied weight is applied, in other words, when the electric prosthetic leg 1 transitions from the standing leg to the idling leg or the transition is predicted, the lower clutch 50D out of the upper clutch 50U and the lower clutch 50D of the connection and disconnection mechanism 50 is switched to an engaged state and sets the state to the second gear shift state. Accordingly, in a case of the idling leg where the knee joint mechanism 30 is bent from the stretched state, power can be transmitted via the second transmission mechanism T2 having a large transmission gear ratio, and the knee joint mechanism 30 can be quickly bent in a state where an applied weight is not applied to the electric prosthetic leg 1 from the outside.
The control system 100 may include a traveling direction acquisition unit which acquires a traveling direction of the user of the electric prosthetic leg 1 as in the first example.
Hereinafter, a control flow of the step ascending control according to the second example will be described.
As illustrated in
Referring to
When the applied weight FZ2 is equal to or less than the lower threshold value −T12, it is determined that the electric prosthetic leg 1 lands and the electric prosthetic leg 1 is the standing leg (S24). The landing determination may be made based on an input of the user.
When the electric prosthetic leg 1 is the standing leg, the hip joint torque calculation unit 104 calculates the hip joint torque MYh acting on the hip joint 7 based on the knee torque MYk and the knee shear force FXk (S25). The hip joint torque calculation unit 104 acquires the hip joint torque MYh based on a sum of the knee shear force FXk, the length L of the thigh 4, and the knee torque MYk according to Formula (2).
Subsequently, the motor control unit 108 calculates a motor voltage (S26). The motor voltage is acquired according to a formula based on the hip joint torque MYh, a map indicating a relationship between the hip joint torque MYh and the motor voltage, or the like. That is, by setting the motor voltage and controlling the motor torque generated by the motor M based on the hip joint torque calculated by the hip joint torque calculation unit 104, the motor control unit 108 can appropriately set the motor torque for stretching.
When the hip joint torque MYh is smaller than a threshold value −M1 (S27), that is, when a torque acts in a direction of pivoting the hip joint 7 backward (counterclockwise in
When the hip joint torque MYh is smaller than the threshold value −M1 (S27), that is, when a torque acts in the direction of pivoting the hip joint 7 backward (counterclockwise in
When the hip joint torque MYh is larger than a threshold value M1 (S31), that is, when a torque acts in a direction of pivoting the hip joint 7 forward (clockwise in
When the hip joint torque MYh is larger than the threshold value M1 (S31), that is, when a torque acts in the direction of pivoting the hip joint 7 forward (clockwise in
When the hip joint torque MYh is equal to or larger than the threshold value −M1 and is equal to or smaller than the threshold value M1 (S36, region AR4 in
According to the second example, in the landing determination (S21), when the behavior of the applied weight FZ2 is in an unstable region, the motor M is stopped without determining whether the electric prosthetic leg 1 is a standing leg or a idling leg (S22), or when the behavior of the hip joint torque MYh is in an unstable region, the motor M is stopped without stretching or bending the knee joint mechanism 30 (S37), so that the motor M can be prevented from being driven in a status not intended by the user.
Although various embodiments have been described above with reference to the drawings, it is needless to say that the present invention is not limited to these examples. It is apparent that those skilled in the art can conceive of various modifications and changes within the scope described in the claims, and it is understood that such modifications and changes naturally fall within the technical scope of the present invention. In addition, respective constituent elements in the above-described embodiments may be freely combined without departing from the gist of the invention.
For example, in the above embodiment, the electric prosthetic leg is exemplified as one embodiment of the joint device of the present invention. However, the present invention is not limited thereto, and may be applied to an upper limb (arm joint), may be an animal other than a human being as a wearing subject, or may be a robot.
In the above embodiment, the power of one motor M is transmitted to the first transmission mechanism T1 and the second transmission mechanism T2 via the connection and disconnection mechanism 50. However, the present invention is not limited thereto, and a connection and disconnection mechanism may be provided between each of two power sources and a respective one of the first transmission mechanism T1 and the second transmission mechanism T2.
Further, both the first transmission mechanism T1 and the second transmission mechanism T2 are not necessarily provided, and only one of the first transmission mechanism T1 and the second transmission mechanism T2 may be provided.
The connection and disconnection mechanism 50 is not limited to the dog clutch, and may be another clutch mechanism such as a friction clutch or a centrifugal clutch, or may be a clutchless mechanism such as a continuous transmission gear ratio switching mechanism.
In the present specification, at least the following matters are described. Corresponding constituent elements and the like in the embodiment described above are shown in parentheses, but the present invention is not limited thereto.
According to (1), the coupling portion can be stretched and bent via the power transmission portion which transmits power of the power source. Since the power transmission portion includes two power transmission paths having different transmission gear ratios, an operation speed and generated power of stretching and bending of the coupling portion can be switched.
It is possible to appropriately switch between the two power transmission paths by the first connection and disconnection mechanism and the second connection and disconnection mechanism.
Further, by controlling at least one of the first connection and disconnection mechanism and the second connection and disconnection mechanism based on the applied weight applied to the joint device, the coupling portion can be stretched or bent by power from the drive source.
According to (2), by switching one of the first connection and disconnection mechanism and the second connection and disconnection mechanism to an engaged state at the time of transition, the coupling portion can be stretched or bent smoothly.
According to (3), by determining ascending and descending states, it is possible to appropriately determine a status in which the coupling portion is stretched and a status in which the coupling portion is bent.
According to (4), a large amount of power can be generated by bringing the first transmission path having a small transmission gear ratio into the connected state at the time of ascending.
According to (5), by acquiring the pivoting force of the first portion relative to the second portion, it is possible to more appropriately set the amount of power for stretching.
According to (6), the pivoting force can be accurately and easily acquired.
According to (7), the pivoting force can be accurately and easily acquired.
According to (8), the pivoting force can be accurately and easily acquired.
According to (9), the amount of power for stretching can be appropriately set.
According to (10), the amount of power for stretching can be appropriately set.
According to (11), by determining ascending and descending states, it is possible to appropriately determine a status in which the coupling portion is stretched and a status in which the coupling portion is bent.
The present application is based on the Japanese patent application (Japanese Patent Application No. 2021-032992) filed on Mar. 2, 2021, and the contents thereof are incorporated herein by reference.
Number | Date | Country | Kind |
---|---|---|---|
2021-032992 | Mar 2021 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/007967 | 2/25/2022 | WO |