Walking assist device
10350129 ยท 2019-07-16
Assignee
Inventors
Cpc classification
International classification
A61H1/02
HUMAN NECESSITIES
Abstract
Provided is a walking assist device including a main frame configured to be worn by a user, a power unit mounted on the main frame, a pair of power transmission members for transmitting assist force provided by the power unit to femoral parts of the user and a control unit for controlling an operation of the power unit, wherein the control unit comprises a differential angle computation unit for computing a differential angle between angular positions of the femoral parts of the user about respective hip joints of the user; a differential angle phase computation unit for computing a differential angle phase according to the differential angle; and an assist force computation unit for computing an assist force to be applied to the user according to the differential angle phase.
Claims
1. A walking assist device including a main frame configured to be worn by a user, a power unit mounted on the main frame, a pair of power transmission members pivotally attached to the main frame so as to be rotatable about respective hip joints of the user and to transmit assist force provided by the power unit to left and right femoral parts of the user and a control unit for controlling an operation of the power unit, wherein the control unit comprises: a differential angle computation unit for computing a differential angle between an angular position of the left femoral part of the user relative to a coronal plane of the user and an angular position of the right femoral part of the user relative to the coronal plane of the user; a differential angle phase computation unit for computing a differential angle phase according to the differential angle; and an assist force computation unit for computing an assist force to be applied to the user according to the differential angle phase.
2. The walking assist device according to claim 1, wherein the differential angle phase computation unit comprises: a differential angular speed computation unit for computing a differential angular speed according to the differential angle; a differential angular speed normalization unit for normalizing the differential angular speed; a differential angle normalization unit for normalizing the differential angle; and an inverse tangent computation unit for computing the differential angle phase by performing an inverse tangent computation on the differential angle normalized by the differential angle normalization unit and the differential angular speed normalized by the differential angular speed normalization unit.
3. The walking assist device according to claim 1, wherein the differential angle phase computation unit comprises: a differential angle normalization unit for normalizing the differential angle; and a map unit for determining the differential angle phase according to the normalized differential angle by using a map defining a relationship between the differential angle phase and the normalized differential angle.
4. The walking assist device according to claim 1, wherein the differential angle phase computation unit comprises: a filter unit for filtering at least one of the differential angle and the differential angle phase; a walking frequency estimation unit for estimating a walking frequency according to the differential angle; a phase delay estimation unit for estimating a phase delay caused by the filter unit according to the walking frequency; and a phase delay compensation unit for compensating the phase delay of the differential angle phase according to the estimated phase delay.
5. The walking assist device according to claim 1, wherein the assist force computation unit comprises: an oscillator phase arithmetic operation unit for computing a phase of an oscillator that oscillates in synchronism with the differential angle phase; and an assist force determination unit for determining the assist force according to the oscillator phase computed by the oscillator phase computation unit.
6. The walking assist device according to claim 5, wherein the oscillator phase computation unit comprises: an oscillator natural angular frequency computation unit for computing a natural angular frequency of a phase oscillator corresponding to the walking frequency of the user determined from the differential angle; and a phase oscillator integration computation unit for computing the oscillator phase by performing an integration computation on a phase change of the phase oscillator by taking into account a phase difference between the differential angle phase and the oscillator phase.
7. The walking assist device according to claim 6, wherein the oscillator natural angular frequency computation unit is configured to compute the natural angular frequency of the phase oscillator by using the walking frequency determined from the differential angle.
8. The walking assist device according to claim 1, wherein the assist force determination unit comprises: an assist phase computation unit for computing, from the differential angle phase, an assist force phase adjusted to cause the assist force to be produced at an appropriate timing; and a right and a left assist force computation unit for computing assist forces for the left and right femoral parts of the user according to the assist force phase.
9. The walking assist device according to claim 8, wherein the assist force determination unit comprises: a left assist phase computation unit for adjusting the differential angle phase so as to be a left assist force phase that allows the assist force for the left femoral part to be produced at an appropriate timing; a left assist force computation unit for computing the left assist force according to the left assist force phase; a right assist phase computation unit for adjusting the differential angle phase so as to be a right assist force phase that allows the assist force for the right femoral part to be produced at an appropriate timing; and a right assist force computation unit for computing the right assist force according to the right assist force phase.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
DESCRIPTION OF THE PREFERRED EMBODIMENT(S)
(18) Preferred embodiments of the present invention are described in the following with reference to the appended drawings.
First Embodiment
(19) As shown in
(20) The main frame 2 is made of a combination of stiff material such as hard plastics and metals and flexible material such as fabrics and foamed plastics, and is secured to the pelvic part of the user P by a belt 11 detachably connected between the opposite ends of the main frame 2 on the front side of the user P. A flexible back support plate 12 is provided on the front side of the rear part of the main frame 2 to provide a flexible support for the back side of the user P.
(21) The femoral support units 3 each consist of an arm member 14 and a femoral retainer 13. Each arm member 4 is made of stiff material such as hard plastics and metals, and extends along the length of the femoral part of the user P. Each femoral retainer 13 is made of a combination of stiff material and flexible material, and is configured to the detachably worn on the lower femoral part of the user P. Thus, each arm member 14 connects the corresponding femoral retainer 13 to an output shaft of the corresponding power unit 4.
(22) Each power unit 4 is incorporated with an electric motor, and may additionally include a speed reduction mechanism and/or a compliance mechanism. By receiving electric power supplied by the battery via the control unit 5, each power unit 4 angularly drives the corresponding arm member 14, and assists the movement of the femoral part of the user P via the corresponding femoral retainer 13.
(23) Each angular position sensor 6 consists of an absolute angle sensor provided in association with the corresponding power unit 4, and produces a signal corresponding to the femoral angle L, R of the femoral part of the user P with respect to the coronal plane of the user P. The signals from the angular position sensors 6 are forwarded to the control unit 5.
(24) As shown in
(25) The battery is received in or attached to the main frame 2, and supplies electric power to the control unit 5 and the power units 4. The control unit 5 is received in or attached to the main frame 2. The battery and/or the control unit 5 may also be provided separately from the walking assist device 1.
(26) The control unit 5 consists of an electronic circuit unit including CPU, RAM, ROM and a peripheral circuit, and is programmed to execute required computational processes by reading out commands and necessary data from a storage unit (memory) not shown in the drawings. The control unit 5 thereby controls the operation of the power units 4 and hence the assist force that is applied to the femoral parts of the user P.
(27) The walking assist device 1 is thus configured to assist the walking movement of the user P by applying the power of the power units 4 to the femoral parts of the user P via the main frame 2 and the femoral support units 3.
(28) As shown in
(29) The assist force computation unit 23 includes an oscillator phase computation unit 24 for computing the oscillator phase of a phase oscillator that oscillate in synchronism with the differential angle phase by executing a computation process using a phase oscillator corresponding to the walking frequency freq of the user P wearing the walking assist device 1 based on the walking frequency freq and the differential angle phase computed by the differential angle phase computation unit 22, and an assist force determination unit 25 for computing the assist forces for the two femoral parts of the user P by executing a computational process (which will be described hereinafter) based on the oscillator phase c computed by the oscillator phase computation unit 24.
(30) When powered up, the control unit 5 drives the power units 4L and 4R so as to produce the assist forces L and R determined from the outputs of the angular position sensors 6L and 6R.
(31) The differential angle computation unit 21 computes the differential angle between the two femoral parts by subtracting one of the femoral angles (right femoral angle) R from the other femoral angle (left femoral angle) L, or by the following equation (1).
=LR(1)
(32) Thus, the differential angle is given as the angle of the left femoral part relative to the right femoral part, and is positive in sign when the left femoral part is ahead of the right femoral part (or is bent), and negative in sign when the left femoral part is behind the right femoral part (or is extended). When the user P has stood up or has squatted with the two femoral parts aligned with each other, the two femoral angles L and R are equal to each other so that the differential angle is zero. Likewise, the differential angular speed which is given as the time differential of the differential angle is positive in sign when the left femoral part is bent and the right femoral part is extended, and negative in sign when the left femoral part is extended and the right femoral part is bent. The differential angle computation unit 21 executes the computational process mentioned above at a prescribed computational cycle of the control unit 5.
(33) Instead of using the two angular position sensors 6L and 6R for measuring the femoral angles, it is also possible to provide a sensor in the main frame 2 to detect the relative angle between the right and left femoral support units 3L and 3R, and to have the differential angle computation unit 21 use the output signal of this sensor as the differential angle between the two femoral parts of the user. It is also possible to use an IMU including an acceleration sensor and a gyro sensor for measuring the attitudes of the two femoral parts of the user, and obtain the differential angle as the difference between the angles of the two femoral parts with respect to the vertical line as projected onto the sagittal plane.
(34) The differential angle phase computation unit 22 shown in
(35) First of all, the differential angle phase computation unit 22 executes the process of a first low pass filter 31 at each computational process cycle.
(36) The first low pass filter 31 performs a low pass filter (high cut) process consisting of shutting off a high frequency component of the signal corresponding to the differential angle computed by the differential angle computation unit 21.
(37) Following the execution of the process of the first low pass filter 31, the differential angle phase computation unit 22 executes the process of a differential angular speed computation unit 32 shown in
(38) Based on the differential angle f, the differential angular speed computation unit 32 computes a differential angular speed . More specifically, the differential angular speed computation unit 32 computes the differential angular speed by performing the computation of Equation (2) given in the following:
=(f_Nf_N1)/Tc(2)
where f_N is the differential angle f computed in the current computation cycle, f_N1 is the differential angle f computed in the previous computational cycle, and Tc is the computational cycle period.
(39) After executing the process of the differential angular speed computation unit 32, the differential angle phase computation unit 22 executes the process of a differential angular speed normalization unit 33 shown in
(40) The differential angular speed normalization unit 33 normalizes the differential angular speed according to a prescribed rule based on the maximum value and the minimum value of the differential angular speed in the preceding walking cycle, and produces a normalized differential angular speed n. More specifically, the differential angular speed normalization unit 33 computes the differential angular speed by performing the computation of Equation (3) given in the following.
n=((MAX+MIN)/2)/{(MAXMIN)/2}(3)
where MAX is the maximum value of the differential angular speed in the preceding walking cycle, and MIN is the minimum value of the differential angular speed in the preceding walking cycle.
(41) The numerator of the normalized differential angular speed n represented in Equation (3) indicates that the offset of the differential angular speed is removed so that the absolute values of the positive peak and the negative peak of the differential angular speed are equal to each other, and the denominator indicates the amplitude of the differential angular speed in the preceding step of the walking movement. Therefore, the differential angular speed is normalized by the differential angular speed normalization unit 33 executing the computation of Equation (3) at the same time as the user P walks.
(42) Following the process of the first low pass filter 31, the differential angle phase computation unit 22 performs the process of a differential angle normalization unit 34 shown in
(43) The differential angle normalization unit 34 normalizes the differential angle f that has been processed by the first low pass filter 31 according to a prescribed rule based on the maximum value and the minimum value of the differential angle in the preceding walking cycle, and produces a normalized differential angle n. More specifically, the differential angle normalization unit 34 computes the differential angle by performing the computation of Equation (4) given in the following.
n=((MAX+MIN)/2)/{(MAXMIN)/2}(4)
where MAX is the maximum value of the differential angle in the preceding walking cycle, and MIN is the minimum value of the differential angle in the preceding walking cycle.
(44) The numerator of the normalized differential angle n in Equation (4) represents the removal of the offset which performed in such a manner that the positive peak and the negative peak of the differential angle in the previous cycle of the walking motion are equal to each other, and the denominator represents the amplitude of the differential angle in the previous cycle of the walking motion. Therefore, by performing the computation of Equation (4) with the differential angle normalization unit 34, the differential angle f is normalized according to the walking motion of the user P.
(45) Following the processes executed by the differential angle normalization unit 34 and the differential angular speed normalization unit 33, the differential angle phase computation unit 22 performs of the process of an inverse tangent computation unit 35.
(46) Based on the normalized differential angle n normalized by the differential angle normalization unit 34 and the normalized differential angular speed con normalized by the differential angular speed normalization unit 33, the inverse tangent computation unit 35 computes a differential angle phase r by executing an inverse tangent computation. More specifically, by performing the computation of Equation (5) given in the following, the inverse tangent computation unit 35 computes the differential angle phase r in the phase plane of the normalized differential angle n and the normalized differential angular speed n as shown in
r=arc tan(n/n)(5)
(47) The differential angle phase r computed by Equation (5) represents the progress of the walking motion of a basic cycle consisting of two steps made by the left and right legs one after the other as schematically illustrated in the phase plane of
(48) After executing the process of the inverse tangent computation unit 35, the differential angle phase computation unit 22 executes the process of a second low pass filter 36.
(49) The second low pass filter 36 executes a low pass (high cut) process consisting of shutting off a high frequency component from a signal corresponding to the differential angle phase r computed by the inverse tangent computation unit 35, and permitting the passage of a low frequency component. The cut off frequency of the second low pass filter 36 is preferably set to a frequency (0.5 Hz to 1 Hz) higher than the range of the walking frequency freq which is normally associated with the walking motion of the user P, as opposed to the first low pass filter 31. The differential angle phase r that has passed through the second low pass filter 36 is provided with a phase property 2f (freq) which is a mathematical function of the walking frequency.
(50) The differential angle phase computation unit 22 executes a process of a walking frequency estimation unit 37 simultaneously as the above mentioned process in each computation cycle of the control unit 5.
(51) The walking frequency estimation unit 37 estimates the walking frequency freq from the differential angle . For instance, the walking frequency estimation unit 37 computes the walking frequency freq by using a high speed Fourier transformation or a wavelet transformation. When the walking frequency freq is computed by the walking frequency estimation unit 37, window functions are multiplied to each other. The interval of the window functions may be selected so as to contain the differential angle for a plurality of steps.
(52) After executing the process of the walking frequency estimation unit 37 and the process of the second low pass filter 36, the differential angle phase computation unit 22 executes a process of a phase delay estimation unit 38.
(53) The phase delay estimation unit 38 estimates a phase delay dp according to the phase property 2f (freq) of the differential angle phase r that has passed through the second low pass filter 36, the phase property 1f (freq) of the differential angle that has passed through the first low pass filter 31 and the walking frequency freq computed by the walking frequency estimation unit 37. The phase delay dp can computed by Equation (6) given in the following.
dp=1f(freq)+2f(freq)(6)
(54) The differential angle phase computation unit 22 then executes the process of a phase delay compensation unit 39. The phase delay compensation unit 39 corrects the differential angle phase f that has passed through the second low pass filter 36 in dependence on the phase delay dp computed by the phase delay estimation unit 38, and produces the corrected differential angle phase . More specifically, the differential angle phase computation unit 22 computes the differential angle phase by executing the computation consisting of subtracting the phase delay dp from the differential angle phase r as represented by Equation (7) given in the following.
=rdp(7)
(55) The oscillator phase computation unit 24 of the illustrated embodiment shown in
(56) The oscillator natural angular frequency computation unit 41 computes an oscillator natural angular frequency 0 or the natural frequency of the oscillator according to the walking frequency freq estimated by the walking frequency estimation unit 37 shown in
0=2freq(8)
(57) The oscillator natural angular frequency 0 computed by Equation (8) is a variable based on the walking frequency freq of the user P of the walking assist device 1, but may also consist of a constant value assigned to the oscillator natural angular frequency computation unit 41 as a target walking frequency or may be obtained by applying a low pass filter to the walking frequency freq.
(58) After executing the process of the oscillator natural angular frequency computation unit 41, the differential angle phase computation unit 22 executes the process of a phase oscillator integration computation unit 42.
(59) The phase oscillator integration computation unit 42 produces an oscillator phase c of a phase oscillator which oscillates in synchronism with the differential angle phase according to the natural angular frequency 0 of the oscillator by using the differential angle phase corrected by the phase delay compensation unit 39 shown in
dc/dt=0+f(c+)(9)
where f(x) represents a mathematical function, and is a prescribed phase difference for adjusting the oscillator phase c. Preferably, f(x) is a monotonously increasing function when x is near zero (when /4<x</4, for instance). For instance, f(x) may be represented by Equation (10) given in the following.
f(x)=K sin(x)(10)
where K is a constant.
(60) The assist force determination unit 25 shown in
(61) An assist phase computation unit 51 adjusts the oscillator phase c computed by the oscillator phase computation unit 24 so that the assist force may be produced at an appropriate timing. More specifically, the assist phase computation unit 51 computes an assist force phase as by executing the computation represented by Equation (11) given in the following.
as=c(11)
where is an assist target phase difference. In other words, the assist phase computation unit 51 computes the assist force phase as which is adjusted such that the assist force is produced at an appropriate timing by subtracting the assist target phase difference (which is introduced for producing the assist force at an appropriate timing) from the computed oscillator phase c.
(62) Following the process of the assist phase computation unit 51, the assist force determination unit 25 executes a right and left assist force computation unit 52.
(63) The right and left assist force computation unit 52 computes the left and right assist forces L and R according to the assist force phase as of the differential angle . More specifically, the right and left assist force computation unit 52 performs the computations represented by Equations (12) and (13) given below.
L=Gsin as(12)
R=L(13)
where G is a gain constant which is set in dependence on the desired magnitude of the assist force, and can vary depending on the purpose and the condition of the user P of the walking assist device 1.
(64) Alternatively, the right and left assist force computation unit 52 may determine the left assist force L by looking up a map or a table that defines the relationship of the assist force between the assist force phase as as represented by Equation (14) given in the following.
L=LUT(as)(14)
In this case, if the assist force defined by the map takes into account the assist target phase difference , the left assist force L may be obtained by the right and left assist force computation unit 52 by using the oscillator phase c as an input without requiring the assist phase computation unit 51 as represented by Equation (14) given in the following.
L=LUT(c)(15)
(65) The control unit 5 executes the above discussed processes at the prescribed computational cycle, and supplies electric power to the left and right power units 4L and 4R such that the computed left and right assist forces L and R may be produced, and the walking motion of the user P of the walking assist device 1 may be appropriately assisted.
(66)
(67) In the case of a user P demonstrating a walking pattern as indicated by the solid line, the conventional method (dotted line) resulted in a poor performance in estimating the phase from the hip joint angle, and extending motion is mistaken for bending motion in some time intervals. Furthermore, the waveform of the estimated phase contains a significant amount of high frequency components. When extending motion is mistaken for bending motion, a torque opposing the motion of the femoral part (instead of a torque assisting the motion of the femoral part) is produced. An excessive amount of high frequency components causes discomfort to the user.
(68) On the other hand, according to the illustrated embodiment, as indicated by the broken line, the extending motion and the bending motion are estimated to take place in an alternating manner in synchronism with the frequency of the walking motion. Therefore, the assist torque can be produced at an appropriate timing in relation to the extending motion and the bending motion of the user P so that a smooth assisting action can be accomplished.
(69) Thus, according to the control unit 5 of the illustrated embodiment, as shown in
(70) In other words, even when the motion of the disabled leg is not cyclic or when the motion of the disabled leg is cyclic, but involves significant fluctuations, the conventional method was unable to produce an assist force at an optimum timing. On the other hand, according to the illustrated embodiment, by using the differential angle between the two legs about the respective hip joints, the differential angle phase of the walking motion can be estimated in a stable manner so that the assist force can be applied to the legs of the user P at an optimum timing.
(71) The walking assist device 1 of the illustrated embodiment can provide an assist force at an appropriate timing with a same algorithm and without requiring extensive changes in parameter settings not only to severely impaired users such as those with an asymmetric disability in acute phase, those with a non-cyclic walking pattern and those with a severe asymmetric disability but also to mildly impaired users such as those in a rehabilitation stage, healthy persons and those with a mild symmetric disability.
(72) When the left and right hip joints undergo a same phase motion such as when the user attempts a bowing movement, the conventional device typically produces a walking assist force even though the user does not intend to walk. However, when the differential angle is used as in the case of the present invention, because the differential angle that is used for the computation of the assist force remains unchanged in such a case, no unnecessary assist force is produced so that the assist force is applied to the user only when the user is walking, without requiring any special process to be executed.
(73) The differential angle phase computation unit 22 comprises the first low pass filter 31 for filter processing the differential angle and the second low pass filter 36 for filter processing the differential angle phase , and estimates the walking frequency freq with the walking frequency estimation unit 37 based on the differential angle . The differential angle phase computation unit 22 further estimates the phase delay dp caused by the two low pass filters 31 and 36 based on the walking frequency freq, and compensates the phase delay of the differential angle phase r with the phase delay estimation unit 38 based on the phase delay dp. Thereby, the noises that may be contained in the differential angle is canceled by the first low pass filter 31 so that the accuracy in estimating the differential angle phase with the inverse tangent computation can be improved. Meanwhile, because the first low pass filter 31 is a filter for the differential angle , the cutoff frequency of the first low pass filter 31 is required to be relatively high. Therefore, the first low pass filter 31 may not adequately eliminate estimation errors by itself. By applying the second low pass filter 36 to the differential angle phase r, a low pass filter with a relatively low cutoff frequency can be applied so that the accuracy in estimating the phase can be improved. Moreover, because the phase delay due to the first and second low pass filters 31 and 36 is compensated, even though a filter with a low cutoff frequency is applied, the walking motion of the user P wearing the walking assist device 1 can be assisted with a high precision without involving a delayed assist phase.
(74) As shown in
(75) As shown in
Second Embodiment
(76) A second embodiment of the present invention is described in the following with reference to
(77)
(78) In this embodiment, instead of using absolute type angular sensors for the hip joint angular position sensors 6L and 6R of the first embodiment, incremental type angular sensors 61L and 61R for detecting the angles of the femoral parts relative to the main frame 2 are used as shown in
(79) The differential angle computation unit 21 is provided with counter/angle computation units 62L and 62R for computing the hip joint angles L and R corresponding to the angles of the respective sub frames or the femoral support units 3L and 3R relative to the main frame 2 from the signals produced from the incremental type angular sensors 61L and 61R and a differential angle arithmetic operation unit 63 for computing the differential angle between the two femoral parts of the user P from the respective hip joint angles L and R computed by the counter/angle computation units 62L and 62R. The differential angle arithmetic operation unit 63 computes the differential angle by executing Equation (1) given above similarly as the first embodiment.
(80) The walking assist device 1 is modified from the first embodiment in this regard, but provides similar action and effects as the first embodiment. Alternatively, instead of the incremental type angular sensors 61L and 61R, a plurality of Hall sensors may be provided on each side of the user P so that the hip joint angles L and R of the respective femoral parts may be computed from the magnetic signals or Hall state signals provided by the Hall sensors.
Third Embodiment
(81)
(82) In this embodiment, the walking assist device 1 is provided with a left femoral G sensor 71L and a right femoral G sensor 71R for detecting the fore and aft accelerations of the respective femoral support units 3L and 3R, and a left femoral gyro sensor 72L and a right femoral gyro sensor 72R for detecting the angular speeds 3L and 3R of the respective femoral support units 3L and 3R, instead of the hip joint angular position sensors 6L and 6R of the first embodiment. The differential angle computation unit 21 computes the differential angle from the output signals provided by these sensors 71L, 71R, 72L and 72R.
(83) The differential angle computation unit 21 is provided with a left and right strap-down attitude estimation units 73L and 73R for estimating the respective attitude angle vectors BL and BR by executing a strap-down attitude estimation computation based on the detection signals of the femoral G sensors 71L and 71R and the femoral gyro sensors 72L and 72R, and a differential angle arithmetic operation unit 73 for computing the differential angle between the two femoral parts of the user P from the attitude angle vectors BL and BR estimated by the respective strap-down attitude estimation units 73L and 73R. Each strap-down attitude estimation unit 73 executes the per se known strap-down attitude estimation computation, and uses only the parameters associated with the motion of the femoral parts on the sagittal plans. The walking assist device 1 of the third embodiment is modified from the first embodiment in this regard, but provides similar action and effects as the first embodiment.
Fourth Embodiment
(84)
(85) In this embodiment, the walking assist device 1 is provided with a left femoral angular speed sensor 81L and a right femoral angular speed sensor 81R for detecting the angular speeds 3L and 3R of the respective femoral support units 3L and 3R, instead of the hip joint angular position sensors 6L and 6R of the first embodiment. The differential angle computation unit 21 computes the differential angle from the output signals provided by these femoral angular speed sensors 81L and 81R. The femoral angular speed sensors 81L and 81R may consist of gyro sensors, for instance.
(86) The differential angle computation unit 21 is provided with a left and a right angular speed integration computation unit 82L and 82R for computing the hip joint angles of the respective femoral parts or the hip joint angles L and R by integrating the angular speeds 3L and 3R provided by the respective femoral angular speed sensors 81L and 81R, and a differential angle arithmetic operation unit 83 for computing the differential angle between the two femoral parts of the user P from the hip joint angles L and R computed by the respective angular speed integration computation unit 82L and 82R. The differential angle arithmetic operation unit 83 computes the differential angle by executing Equation (1) given above similarly as the first embodiment. The walking assist device 1 of the fourth embodiment is modified from the first embodiment in this regard, but provides similar action and effects as the first embodiment. In this case, in order for the values computed by each angular speed integration computation unit 82 not to diverge during computation, a low cut filter may be applied to the detection signals of the left and right angular speeds L and R.
Fifth Embodiment
(87)
(88) In this embodiment, the second low pass filter 36 shown in
dp=1f(freq)(16)
(89) The differential angle phase computation unit 22 is thus modified from that of the first embodiment, but can provide the same action and effects as that of the first embodiment as long as the high frequency components of the differential angle is not particularly significant.
Sixth Embodiment
(90)
dp=2f(freq)(17)
(91) The differential angle phase computation unit 22 is thus modified from that of the first embodiment, but can provide the same action and effects as that of the first embodiment as long as the high frequency components of the differential angle are not particularly significant.
Seventh Embodiment
(92)
(93) In this embodiment, the differential angular speed computation unit 32 and the differential angular speed normalization unit 33 shown in
(94) The differential angle phase computation unit 22 is thus modified from that of the first embodiment, but can provide the same action and effects as that of the first embodiment.
Eighth Embodiment
(95)
(96) As shown in
(97) The reference phase oscillator integration computation unit 101 computes the oscillator phase b which oscillates in synchronism with the differential angle phase according to the oscillator natural angular frequency 0 computed by the oscillator natural angular frequency computation unit 41 by using the differential angle phase corrected by the phase delay compensation unit 39 (
db/dt=0+f(b+b)(18)
where f(x) represents a mathematical function, and b denotes a preset phase difference for adjusting the reference oscillator phase b. Preferably, f(x) is a monotonously increasing function when x is near zero (when /4<x</4, for instance). For instance, f(x) may be represented by Equation (19) given in the following.
f(x)=Kb sin(x)(19)
where Kb is a constant.
(98) The left and right phase oscillator integration arithmetic operation units 102L and 102R compute the oscillator phases cL and cR of the left and right oscillators, respectively, that oscillate in synchronism with the reference oscillator phase b according to the oscillator natural angular frequency 0 computed by the oscillator natural angular frequency computation unit 41 by using the differential angle phase b computed by the oscillator natural angular frequency computation unit 41 as an input, and produce the computed oscillator phases cL and cR of the left and right oscillators, respectively. As the computation is the same for the right and left oscillator phases, only the process executed by the left phase oscillator integration arithmetic operation unit 102L is described in the following. The left phase oscillator integration arithmetic operation unit 102L computes the left oscillator phase cL that oscillates in synchronism with the reference oscillator phase b by executing an integration computation for solving a differential equation represented by Equation (20) given in the following.
dcL/dt=0+f(bcL+L)(20)
where f(x) represents a mathematical function, and L denotes a preset phase difference for adjusting the left oscillator phase DCL. Preferably, f(x) is a monotonously increasing function when x is near zero (when /4<x</4, for instance). For instance, f(x) may be represented by Equation (21) given in the following.
f(x)=KL sin(x)(21)
where KL is a constant.
(99) Of the preset phase difference L in Equation (20) and the preset phase difference b in Equation (18), only one of the may be used.
(100) As shown in
asL=LL(22)
asR=RR(23)
where L is a left assist target phase difference, and R is a right assist target phase difference.
(101) The left and right assist force computation units 112L and 112R compute the left and right assist forces L and R according to the respective assist force phases L and R of the differential angle . More specifically, the left assist force computation unit 112L computes the left assist force L by executing the computation of Equation (24) given in the following, and the right assist force computation unit 112R computes the right assist force R by executing the computation of Equation (25) given in the following.
L=Gsin asL(24)
R=Gsin asR(25)
(102) Alternatively, the left and right assist force computation units 112L and 112R may produce the left and right assist forces L and R by looking up maps (or tables) that define the relationship between the left assist force phase asL and the left assist force L and the relationship between the right assist force phase asR and the right assist force R, respectively.
(103) The assist force computation unit 23 is thus modified from that of the first embodiment, but can provide the same action and effects as that of the first embodiment. In this embodiment, as the left and right assist forces L and R are computed individually, the walking motion of the user P can be assisted in a more smooth manner by providing a certain difference between the left and right assist forces L and R depending on the condition of the left and right legs of the user P wearing the walking assist device 1.
(104) The present invention has been described in terms of specific embodiments, but is not limited by such embodiments, and can be modified and substituted without departing from the spirit of the present invention. For instance, in the foregoing embodiments, the differential angle phase was modified by using a phase oscillator so that a non-cyclic walking pattern may be corrected to a more cyclic walking pattern. However, it is also possible to arrange such that the assist force computation unit 23 does not include the oscillator phase computation unit 24, and the assist force is computed from the differential angle phase which the differential angle phase computation unit 22 in the assist force determination unit 25 has computed. Also, the algorithms and the equations used in the various embodiments are only exemplary, and are not limited to those explicitly mentioned in this disclosure.
GLOSSARY OF TERMS
(105) 1 walking assist device 2 main frame 3 (3L, 3R) femoral support unit (power transmission member, sub frame) 4 (4L, 4R) power unit 5 control unit 6 (6L, 6R) angular position sensor 21 differential angle computation unit 22 differential angle phase computation unit 23 assist force computation unit 24 oscillator phase computation unit 25 assist force determination unit 31 first low pass filter 32 differential angular speed computation unit 33 differential angular speed normalization unit 34 differential angle normalization unit 35 inverse tangent computation unit 36 second low pass filter 37 walking frequency estimation unit 38 phase delay estimation unit 39 phase delay compensation unit 41 oscillator natural angular frequency computation unit 42 phase oscillator integration computation unit 51 assist phase computation unit 52 right and left assist force computation unit 91 differential angle/phase map unit 111L left assist phase computation unit 111R right assist phase computation unit 112L left assist force computation unit 112L right assist force computation unit P user (wearer) dp phase delay freq walking frequency differential angle phase c oscillator phase as assist force phase asL left assist force phase asR right assist force phase L hip joint angle of left femoral part R hip joint angle of right femoral part differential angle n normalized differential angle assist force (assist torque) L left assist force R right assist force differential angular speed n normalized differential angular speed 0 oscillator natural angular frequency