Walking assist apparatus
09603761 ยท 2017-03-28
Assignee
Inventors
Cpc classification
A61H3/04
HUMAN NECESSITIES
International classification
A61G5/00
HUMAN NECESSITIES
A61H3/04
HUMAN NECESSITIES
Abstract
A walking assist apparatus includes a pair of wheels, at least one first driving unit that drives the pair of wheels, a main body that rotatably supports the pair of wheels, and a grip that is disposed at one end of the main body to be able to be gripped. The walking assist apparatus includes a sensor unit configured to detect an angular change in an inclination angle of the main body in a pitch direction, and a first control unit configured and programmed to control an operation of the at least one first driving unit based on an output of the sensor unit such that the angular change of the main body is zero.
Claims
1. A walking assist apparatus comprising: a pair of wheels; one rotatable auxiliary wheel or a pair of rotatable auxiliary wheels; at least one first driving unit that drives the pair of wheels; a main body that rotatably supports the pair of wheels; a grip that is disposed at one end of the main body to be able to be gripped by a user while standing up and walking and to assist the user in standing up and walking; a sensor unit configured to detect an angular change in an inclination angle of the main body in a pitch direction; and a first control unit configured and programmed to control an operation of the at least one first driving unit based on an output of the sensor unit such that the angular change in the inclination angle of the main body converges to zero; wherein the grip is turnable in a yaw direction of the main body in order to selectively position the one rotatable auxiliary wheel or pair of rotatable auxiliary wheels between the pair of wheels of the main body and the user, or to position the pair of wheels of the main body between the one rotatable auxiliary wheel or pair of rotatable auxiliary wheels and the user.
2. The walking assist apparatus according to claim 1, wherein the sensor unit includes at least one of an angular velocity sensor, an inclination sensor, and an angular acceleration sensor.
3. The walking assist apparatus according to claim 1, wherein the main body includes a support unit connected at a first end thereof to the main body so as to be pivotable in the pitch direction; and a second end of the support unit is provided with the one rotatable auxiliary wheel or a pair of rotatable auxiliary wheels.
4. The walking assist apparatus according to claim 3, further comprising: a second driving unit configured to rotate a connection portion of the support unit or the one rotatable auxiliary wheel or pair of auxiliary wheels; and a second control unit configured and programmed to control the second driving unit; wherein the second control unit receives designation of a target angle for an angle between the support unit and the main body; and the second control unit is programmed to control an operation of the second driving unit based on an output of the sensor unit such that the angle between the support unit and the main body is equal to the target angle.
5. The walking assist apparatus according to claim 4, wherein the second driving unit is provided in the connection portion of the support unit; and the second control unit is programmed to determine whether a change in output of the sensor unit exceeds a predetermined threshold, and, if it is determined that the change in output of the sensor unit exceeds the predetermined threshold, the second control unit is programmed to perform delay control to reduce a change in angle between the support unit and the main body.
6. The walking assist apparatus according to claim 4, wherein the second driving unit is provided in the connection portion of the support unit; and the second control unit is programmed to determine whether a change in output of the sensor unit or a change in output of an encoder of the second driving unit exceeds a predetermined threshold, and, if it is determined that the change in output of the sensor unit or the change in output of the encoder of the second driving unit does not exceed the predetermined threshold, the second control unit is programmed not to control the second driving unit.
7. The walking assist apparatus according to claim 3, further comprising: a first restraining mechanism configured to restrain pivoting of the support unit; and a detector arranged to detect whether there is an input from the user to the grip; wherein if the detector detects that there is no input to the grip, the first restraining mechanism stops pivoting of the support unit.
8. The walking assist apparatus according to claim 7, wherein if the detector determines that there is no change in output of the sensor unit for more than a certain period of time, the detector detects that there is no input to the grip.
9. The walking assist apparatus according to claim 7, wherein the detector includes a contact sensor provided in the grip.
10. The walking assist apparatus according to claim 7, wherein when the first restraining mechanism stops pivoting of the support unit, the first control unit is programmed not to control the first driving unit.
11. The walking assist apparatus according to claim 7, further comprising a second restraining mechanism configured to stop rotation of at least one wheel of the pair of wheels when the first restraining mechanism stops pivoting of the support unit.
12. The walking assist apparatus according to claim 1, wherein the sensor unit includes a pitch gyro sensor, the at least one first driving unit includes a pitch motor, and the main body includes a pitch encoder.
13. The walking assist apparatus according to claim 12, wherein the pitch gyro sensor is arranged to detect a pitch angular velocity in a right and left direction or substantially in the right and left direction.
14. The walking assist apparatus according to claim 1, wherein the main body includes a frame that connects the pair of wheels to the main body.
15. The walking assist apparatus according to claim 1, wherein the first control unit includes a control board including a driver arranged to drive a pitch motor, an analog-to-digital converter, a digital-to-analog converter, a counter and a controller.
16. The walking assist apparatus according to claim 1, wherein the first control unit is programmed to use a reaction torque of the pair of wheels to control the angular change of the inclination angle of the main body to converge to zero.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
(12) A walking assist apparatus according to preferred embodiments of the present invention will now be specifically described on the basis of the drawings.
(13)
(14) A pitch direction will now be defined.
(15) As illustrated in
(16) The main body 3 is equipped with a control board (first control unit) 32 that controls the operation (rotation) of the pitch motor 6, and a battery 33. The control board 32 includes a driver that drives the pitch motor 6 to rotate, an A/D converter, a D/A converter, a counter, and a controller mounted thereon. The controller is, for example, a microprocessor, a CPU, or an LSI. The walking assist apparatus 1 performs control to achieve a balance in the pitch direction by using a reaction torque associated with rotation of the pair of wheels 2.
(17) As illustrated in
(18) In response to the rotational velocity of the pitch motor 6 determined by the pitch rotational velocity calculating unit 43, the target pitch angle calculating unit 44 multiplies the rotational velocity of the pitch motor 6 by a proportionality factor to determine a target pitch angle .sub.rp such that the pair of wheels 2 is oriented forward when the pitch motor 6 rotates to move the pair of wheels 2 forward, and that the pair of wheels 2 is oriented backward when the pitch motor 6 rotates to move the pair of wheels 2 backward. Thus, it is possible to correct inclination in the pitch direction while ensuring the rotational velocity for movement required by the instruction.
(19) A pitch AD converter unit 45 AD-converts a pitch angular velocity output of the pitch gyro sensor 5 and acquires the resulting pitch angular velocity output. A pitch angular velocity calculating unit 46 multiples the acquired pitch angular velocity output by a conversion factor to determine a pitch angular velocity .sub.1p.
(20) In response to the pitch angular velocity .sub.1p and a pitch torque command .sub.2p (described below), the pitch inclination angle estimating unit 47 derives Equation 18 (described below) and solves Equation 18 to estimate a pitch inclination angle from equations of motion of a system including the main body 3 and the pair of wheels 2 in an inclination angle direction (pitch direction). An estimate of the pitch inclination angle is determined preferably by adding on a first-order lag element in series to provide an appropriate estimated velocity to stabilize a loop. Specifically, a first-order lag element, such as 1/(0.1 S+1), is added in series to the pitch inclination angle estimated using Equation 18. The first-order lag element is not limited to this, and any first-order lag element can be added, as long as an appropriate estimated velocity can be realized.
(21) A pitch direction external torque estimating unit 52 multiplies the estimate of the pitch inclination angle by a conversion factor to determine an estimate of a pitch direction external torque acting on the main body 3, and produces a pitch correction torque .sub.3p corresponding to the determined estimate of the pitch direction external torque.
(22) A target pitch angular velocity calculating unit 48 multiplies, by a proportional gain, a pitch angular deviation obtained by subtracting the estimate of the pitch inclination angle from the target pitch angle .sub.rp so as to determine a target pitch angular velocity .sub.2p. A pitch torque command generating unit 49 performs, for example, PI control on a deviation between the target pitch angular velocity .sub.2p and the pitch angular velocity .sub.1p to generate a pitch torque command .sub.0p. A pitch motor torque command voltage calculating unit 50 multiplies, by a conversion factor, the pitch torque command .sub.2p obtained by adding the pitch correction torque .sub.3p to the pitch torque command .sub.0p so as to determine a command voltage. Finally, a pitch DA converter unit 51 outputs the command voltage to the driver, which controls the operation of the pitch motor 6.
(23) A method for deriving a calculation equation (Equation 18) used to estimate a pitch inclination angle will now be described.
(24)
(25) where I.sub.1p is a moment of inertia of the main body about a rotational center O, .sub.1p is an inclination angle of the main body with respect to the vertical axis in the pitch direction, I.sub.2p is a moment of inertia of the wheels about the rotational center O, .sub.2p is a rotational angle of the wheels with respect to the main body, m.sub.1 is a mass of the main body, l.sub.Gp is a distance between the rotational center O and a position of the center of gravity of the main body, g is a gravitational acceleration, r is a radius of the wheels, and m.sub.2 is a mass of an inertia rotor.
(26) The amount of differentiation in the generalized coordinates and a generalized velocity is as follows:
(27)
(28) Equations 3 to 8 are substituted into Lagrange's equations, Equations 9 and 10:
(29)
(30) where .sub.1p is a torque about the rotational center O acting on the main body, and .sub.2p is a torque acting on the wheels.
(31) As a result, the following Equations 11 and 12 are obtained as equations of motion:
Numerical Expression 4
I.sub.1p{umlaut over ()}.sub.1p+I.sub.2p({umlaut over ()}.sub.1p+{umlaut over ()}.sub.2p)m.sub.1l.sub.Gpg sin .sub.1p=.sub.1pEquation 11
I.sub.2p({umlaut over ()}.sub.1p+{umlaut over ()}.sub.2p)=.sub.2pEquation 12
(32) Equation 13 is obtained by modifying Equation 12:
(33)
(34) Equation 14 is obtained by substituting Equation 13 into Equation 11 and approximating sin .sub.1p by .sub.1p. Equation 14 makes a motion of the main body 3 irrelevant to the rotational angle and the angular velocity of the pair of wheels 2:
Numerical Expression 6
I.sub.1p{umlaut over ()}.sub.1pm.sub.1l.sub.Gpg.sub.1p=.sub.1p.sub.2pEquation 14
(35) Although the pitch inclination angle can be obtained by integrating the output of the pitch gyro sensor 5, the method for obtaining the pitch inclination angle is not particularly limited to this. For example, by using an equation of motion of the model illustrated in
(36)
(37) The pitch angular velocity .sub.1p is expressed by Equation 16:
Numerical Expression 8
{umlaut over ()}.sub.1p{dot over ()}.sub.1pEquation 16
(38) When a torque .sub.1p is produced by an external force in a direction (pitch direction) in which the main body 3 is inclined, an apparent balanced inclination angle .sub.0p is given by Equation 17:
(39)
(40) Therefore, a deviation angle (pitch inclination angle) between the apparent balanced inclination angle .sub.0p and the current inclination angle .sub.1p in the pitch direction can be estimated by solving Equation 18 derived from Equations 15, 16, and 17 described above. To provide an appropriate estimated velocity to stabilize a loop, a first-order lag element may be preferably added on in series. Equation 18 is an exemplary calculation equation for estimating a pitch inclination angle, and the calculation equation for estimating a pitch inclination angle may vary depending on the model used:
(41)
(42) where {tilde over ()}.sub.1p is an estimate of the pitch inclination angle.
(43) From the pitch angular velocity .sub.1p and the pitch torque command .sub.2p generated on the basis of the target pitch angle .sub.rp, a pitch inclination angle is estimated, which is an angle by which the main body 3 is inclined from a balanced state in the pitch direction. Thus, it is possible to accurately estimate a pitch inclination angle. Since the pitch angular velocity output of the pitch gyro sensor 5 is not subjected to integration, there is no calculation error in target pitch angle caused by accumulation of noise or offsets. It is thus possible to accurately correct inclination from a balanced state in the pitch direction by using a reaction torque associated with rotation of the pair of wheels 2, and prevent falling in the pitch direction.
(44) A pitch direction external torque is compensated for with the deviation angle estimated using Equation 18 (i.e., the estimate of the pitch inclination angle). An estimate of the pitch direction external torque can be expressed by Equation 19 using the deviation angle estimated using Equation 18 (i.e., the estimate of the pitch inclination angle):
(45) Numerical Expression 11
{tilde over ()}.sub.2p=m.sub.1l.sub.Gpg{tilde over ()}.sub.1pEquation 19
(46) where {tilde over ()}.sub.2p is an estimate of the pitch direction external torque.
(47) A pitch direction internal torque obtained by subtracting the estimate of the pitch direction external torque from the torque .sub.2p acting on the wheels is expressed by Equation 20:
Numerical Expression 12
.sub.2p={circumflex over ()}.sub.2p+{tilde over ()}.sub.2pEquation 20
(48) where {circumflex over ()}.sub.2p is a pitch direction internal torque.
(49) Since the equation of motion, Equation 14, can be modified to Equation 21 by using Equations 14, 18, 19, and 20, it is possible to compensate for the pitch direction external torque. By using Equation 18 to estimate the pitch inclination angle by which the main body 3 is inclined from a balanced state in the pitch direction, the pitch direction external torque produced by the inclination from the balanced state in the pitch direction can be estimated. It is thus possible to calculate a pitch correction torque corresponding to the estimated pitch direction external torque. Therefore, since the rotation of the pitch motor 6 can be more properly controlled by taking the influence of the pitch direction external torque into account, it is possible to more accurately correct the inclination from a balanced state in the pitch direction and prevent falling in the pitch direction. In particular, even when the response frequencies of an inclination angle loop and an inclination angle velocity loop are low, it is possible to continue the control operation to prevent falling in the pitch direction by compensating for the pitch direction external torque through feedforward control. Stable control can thus be achieved:
(50) Numerical Expression 13
I.sub.1p{umlaut over ()}.sub.1p={circumflex over ()}.sub.2pEquation 21
(51) The corrected pitch torque command is output through the pitch DA converter unit 51 to the driver, which controls the rotation of the pitch motor 6. The rotation of the pitch motor 6 is transmitted to the pair of wheels 2.
(52) A control operation to control the operation of the walking assist apparatus 1 including the control blocks illustrated in
(53) As illustrated in
(54) The controller calculates a rotational velocity deviation in the pitch direction on the basis of the number of pulses obtained by subtracting the number of pulses of the output (pulse signal) of the pitch encoder 61 from the number of pulses of the pulse signal representing the instruction for forward (or backward) movement (step S503). Specifically, after converting the number of pulses obtained by the subtraction into a rotational angle, the controller differentiates the resulting rotational angle to determine the rotational velocity deviation. On the basis of the rotational velocity deviation in the pitch direction, the controller calculates a target pitch angle which is a target inclination angle in the pitch direction (step S504).
(55) The controller subtracts, from the determined target pitch angle, a pitch inclination angle estimated in step S512 (described below) to determine a pitch angular deviation (step S505), and multiplies the determined pitch angular deviation by a proportional gain to determine the target pitch angular velocity .sub.2p (step S506).
(56) The controller calculates a pitch angular velocity deviation between the determined target pitch angular velocity .sub.2p and the pitch angular velocity .sub.1p determined in step S511 (described below) (step S507), and performs, for example, PI control on the calculated pitch angular velocity deviation to generate the pitch torque command .sub.0p (step S508).
(57) The controller corrects the generated pitch torque command .sub.0p with the pitch direction external torque .sub.3p estimated in step S513 (described below), and generates the pitch torque command .sub.2p (step S509).
(58) The controller A/D-converts a pitch angular velocity output of the pitch gyro sensor 5 and acquires the resulting pitch angular velocity output (step S510). The controller multiples the acquired pitch angular velocity output by a conversion factor to determine the pitch angular velocity .sub.1p (step S511).
(59) By using Equation 18, the controller estimates, from the determined pitch angular velocity .sub.1p and the pitch torque command .sub.2p generated in step S509, a pitch inclination angle by which the main body 3 is inclined from a balanced state in the pitch direction (step S512). On the basis of the estimated pitch inclination angle, the controller estimates a pitch direction external torque produced by inclination from the balanced state in the pitch direction (step S513).
(60) The controller determines whether the pitch torque command .sub.2p has been generated in step S509 (step S514).
(61) If the controller determines that the pitch torque command .sub.2p has been generated (YES in step S514), the controller multiplies the generated pitch torque command .sub.2p by a conversion factor to determine a command voltage (step S515). The controller D/A-converts the determined command voltage and outputs the resulting command voltage to the driver that drives the pitch motor 6 to rotate (step S516). The controller returns the process to step S501 and step S510 and repeats the process described above.
(62) On the other hand, if the controller determines that the pitch torque command .sub.2p has not been generated (NO in step S514), since the main body 3 is in a balanced state and no forward/backward movement instruction is received, the controller terminates the process. The process described above is performed when a forward or backward movement instruction is received in the form of a pulse signal of a rotational angle. However, even when a pulse signal of a rotational velocity is received as a forward or backward movement instruction, an inclination angle in the pitch direction can be controlled, through the same process, by determining a deviation in pitch angular velocity.
(63) Referring back to
(64) The position of a support point 10 about which the support unit 7 pivots is not particularly limited, as long as it is within the main body 3. That is, the support point 10 may be located anywhere within the main body 3, as long as the main body 3 can be prevented from falling.
(65) An electric motor (second driving unit) 9 that rotates a connection portion of the support unit 7 or the auxiliary wheel 8 may be provided in the connection portion of the support unit 7. In this case, the control board 32 serves as a second control unit. For example, the controller receives designation of a target angle .sub.ref, in advance, for an angle between the support unit 7 and the main body 3, and controls the operation of the electric motor 9 such that an angle between the support unit 7 and the main body 3 is equal to the target angle .sub.ref. The angle between the support unit 7 and the main body 3 is calculated from a pulse signal output by a support unit angle encoder 91 included in the electric motor 9.
(66)
(67) A pitch inclination angle estimating unit 602 integrates a pitch angular velocity d/dt output by the pitch gyro sensor 5 to estimate a pitch inclination angle . On the basis of the estimated pitch inclination angle , a target angle change estimating unit 603 estimates a target angle change d for the support unit 7 that supports the auxiliary wheel 8. Specifically, the target angle change estimating unit 603 calculates the angle change d of the target angle .sub.ref using Equation 22:
(68)
(69) In Equation 22, .sub.0 denotes a balanced angle of the pitch inclination angle, denotes the pitch inclination angle estimated by the pitch inclination angle estimating unit 602, and .sub.ref denotes the designated target angle for the support unit 7 received by the auxiliary wheel target angle receiving unit 601.
(70) The angle between the support unit 7 and the main body 3 is calculated as a sum of the target angle .sub.ref and the target angle change d. A torque command generating unit 604 performs, for example, PID control on a deviation between the angle calculated from the output (pulse signal) of the support unit angle encoder 91 and the calculated target angle (.sub.ref+d) to generate a torque command . The generated torque command is multiplied by a conversion factor to determine a command voltage. The DA converter or the like outputs the command voltage to the driver, which controls the operation of the electric motor 9.
(71)
(72) When no external force is applied to the walking assist apparatus 1 as illustrated in
(73) If a large external force is suddenly applied to the walking assist apparatus 1 as illustrated in
(74) Possible patterns of falling of the user include falling in the forward direction and falling in the backward direction during walking. Either falling in the forward direction or falling in the backward direction can be prevented depending on the relative position of the user, the auxiliary wheel 8, and the pair of wheels 2 of the main body 3.
(75)
(76)
(77) A method for changing the relative position of the user 80, the auxiliary wheel 8, and the pair of wheels 2 of the main body 3 is not particularly limited, but, for example, the grip 4 may be turnably provided at one end of the main body 3.
(78) For example, as illustrated in
(79) As illustrated in
(80) The height of the grip 4 illustrated in
(81) Instead of the electric motor 9 that turns the support unit 7, the one or pair of auxiliary wheels 8 may be provided with a rotary motor to regulate the rotation of the one or pair of auxiliary wheels 8. In this case, the controller determines whether the angle exceeds a predetermined threshold, such as an inclination angle of 25 degrees, for example. If the controller determines that the angle exceeds the predetermined threshold, it is possible to regulate the rotation of the rotary motor and control the operation of the rotary motor so as not to allow rotation of the one or pair of auxiliary wheels 8. This allows the one or pair of auxiliary wheels 8 to serve as a brake, and to support the user 80 like a stick does.
(82)
(83) As illustrated in
(84) The controller counts the number of pulses of the output (pulse signal) of the support unit angle encoder 91 (step S1105), and acquires a deviation between the angle of the support unit 7 calculated from the output (pulse signal) of the support unit angle encoder 91 and the target angle (.sub.ref+d) for the support unit 7 (step S1106). The controller uses the deviation between the angle of the support unit 7 and the target angle (.sub.ref+d) for the support unit 7 to estimate a pitch direction external torque that causes the support unit 7 to pivot in the pitch direction (step S1107).
(85) On the basis of the estimated pitch direction external torque, the controller generates a pitch torque command (step S1108), and multiples the generated pitch torque command by a conversion factor to determine a command voltage (step S1109). The controller D/A-converts the determined command voltage and outputs the resulting command voltage to the driver that drives the electric motor 9 to rotate (step S1110). The controller repeats the process from step S1101 to step S1110.
(86) In the present preferred embodiment, by controlling the operation of the pitch motor 6 such that the angular change of the main body 3 is zero, the inclination angle of the main body 3 in the pitch direction can be controlled to converge to a balanced angle at which the main body 3 can be kept balanced and does not fall over. Thus, without requiring the elderly or disabled person (user 80) to particularly consciously apply an external force, the walking assist apparatus 1 can stably assist the elderly or disabled person (user 80) in walking. Even when the elderly or disabled person (user 80) leans his or her body weight on the grip 4, the auxiliary wheel 8 can reduce inclination of the main body 3, so that the walking assist apparatus 1 can safely assist the elderly or disabled person (user 80) in walking. Even if a large external force is suddenly applied and the user 80 almost falls, the behavior of the main body 3 does not change significantly. Thus, it is possible to reduce the risk of falling of the elderly or disabled person (user 80).
(87) Given that the walking assist apparatus 1 is used outside in one implementation of various preferred embodiments of the present invention, it is natural to use the battery 33 as a driving source. However, if the battery 33 serving as a driving source always controls the operation of the pitch motor 6 and the electric motor 9, the battery 33 may run out very quickly and may not be able to be used for a long time.
(88) Accordingly, for example, the controller may be configured such that if it determines that the pitch inclination angle does not exceed a predetermined threshold, it does not supply power to the electric motor 9 or the second control unit that controls the operation of the electric motor 9 (i.e., the controller does not control the second control unit (electric motor 9)). This makes it possible to reduce power consumption.
(89) The walking assist apparatus 1 may include a brake mechanism (first restraining mechanism) that restrains pivoting of the support unit 7 and a detector that detects whether there is an input from the user to the grip 4. Then, if it is determined that nothing is input or received from the user to the grip 4 for more than a certain period of time (e.g., 10 seconds), the supply of power to the electric motor 9 or the second control unit that controls the operation of the electric motor 9 may be stopped (i.e., no control of the second control unit (electric motor 9) may be performed) with the brake mechanism activating, so that power consumption can be reduced.
(90) The supply of power to the pitch motor 6 or the first control unit that controls the operation of the pitch motor 6 may be stopped. Since the position of the walking assist apparatus can be maintained by the support unit 7 alone, the amount of power required to control the first driving unit (pitch motor 6) can be reduced.
(91) As a detector arranged to detect whether there is an input from the user to the grip 4, an output signal from the pitch gyro sensor 5 may be used. Alternatively, the grip 4 may be provided with a contact sensor that detects whether the user has touched the grip 4.
(92) It is to be understood that the preferred embodiments described above can be changed without departing from the scope of the present invention. For example, although the pair of wheels 2 described above is preferably provided with one pitch motor 6, each of the wheels may be provided with one pitch motor, for example. Similarly, although the brake mechanism (first restraining mechanism) described above is preferably provided in the connection portion of the support unit 7, the pair of wheels 2 may be provided with another restraining mechanism (second restraining mechanism), or each of the wheels 2 may be provided with one restraining mechanism (second restraining mechanism), for example. Although an angular velocity sensor is preferably used as the pitch gyro sensor 5 described above, an angular acceleration sensor, an inclination sensor, or a combination of these sensors may be used as the pitch gyro sensor 5.
(93) While preferred embodiments of the present invention have been described above, it is to be understood that variations and modifications will be apparent to those skilled in the art without departing from the scope and spirit of the present invention. The scope of the present invention, therefore, is to be determined solely by the following claims.