WO2019082802A1 - 歩行動作補助装置 - Google Patents
歩行動作補助装置Info
- Publication number
- WO2019082802A1 WO2019082802A1 PCT/JP2018/038974 JP2018038974W WO2019082802A1 WO 2019082802 A1 WO2019082802 A1 WO 2019082802A1 JP 2018038974 W JP2018038974 W JP 2018038974W WO 2019082802 A1 WO2019082802 A1 WO 2019082802A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- thigh
- walking
- hip joint
- angle
- phase angle
- Prior art date
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 190
- 210000000689 upper leg Anatomy 0.000 claims abstract description 261
- 210000004394 hip joint Anatomy 0.000 claims abstract description 130
- 238000001514 detection method Methods 0.000 claims abstract description 34
- 210000002414 leg Anatomy 0.000 claims abstract description 25
- 238000005070 sampling Methods 0.000 claims description 68
- 239000011159 matrix material Substances 0.000 claims description 20
- 210000000629 knee joint Anatomy 0.000 claims description 19
- 230000001133 acceleration Effects 0.000 claims description 8
- 230000017105 transposition Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 2
- 238000012545 processing Methods 0.000 description 14
- 238000000034 method Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 10
- 210000003127 knee Anatomy 0.000 description 10
- 230000000737 periodic effect Effects 0.000 description 7
- 230000008859 change Effects 0.000 description 6
- 238000012937 correction Methods 0.000 description 6
- 206010019468 Hemiplegia Diseases 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000002159 abnormal effect Effects 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 206010033799 Paralysis Diseases 0.000 description 2
- 238000005452 bending Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000003780 insertion Methods 0.000 description 2
- 230000037431 insertion Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 238000000926 separation method Methods 0.000 description 2
- 230000004913 activation Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 210000001624 hip Anatomy 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 210000003205 muscle Anatomy 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H1/00—Apparatus for passive exercising; Vibrating apparatus; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
- A61H1/02—Stretching or bending or torsioning apparatus for exercising
- A61H1/0237—Stretching or bending or torsioning apparatus for exercising for the lower limbs
- A61H1/024—Knee
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B5/00—Measuring for diagnostic purposes; Identification of persons
- A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
- A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/0006—Exoskeletons, i.e. resembling a human figure
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H40/00—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices
- G16H40/60—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices for the operation of medical equipment or devices
- G16H40/63—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices for the operation of medical equipment or devices for local operation
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H50/00—ICT specially adapted for medical diagnosis, medical simulation or medical data mining; ICT specially adapted for detecting, monitoring or modelling epidemics or pandemics
- G16H50/30—ICT specially adapted for medical diagnosis, medical simulation or medical data mining; ICT specially adapted for detecting, monitoring or modelling epidemics or pandemics for calculating health indices; for individual health risk assessment
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/16—Physical interface with patient
- A61H2201/1602—Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
- A61H2201/164—Feet or leg, e.g. pedal
- A61H2201/1642—Holding means therefor
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/16—Physical interface with patient
- A61H2201/1602—Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
- A61H2201/165—Wearable interfaces
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5007—Control means thereof computer controlled
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5069—Angle sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5079—Velocity sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5084—Acceleration sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2230/00—Measuring physical parameters of the user
- A61H2230/62—Posture
- A61H2230/625—Posture used as a control parameter for the apparatus
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39188—Torque compensation
Definitions
- the present invention relates to a walking motion assisting device.
- a walking movement assistance device equipped with an actuator such as an electric motor that assists the movement of the leg is proposed as a walking aid or rehabilitation device for a person who has paralysis due to a person with a leg disorder or a stroke etc. (See Patent Documents 1 to 3 below).
- the conventional walking motion assisting devices described in Patent Documents 1 to 3 are provided with a thigh side brace attached to the user's thigh, and a user's knee joint attached to the user's lower thigh and against the thigh side brace.
- a lower leg brace rotatably connected, an actuator capable of applying an assist force around the knee joint to the lower leg brace, mounted on the upper leg brace, and a turn of the lower leg against the thigh around the knee joint
- a lower leg angle sensor for detecting a movement angle
- a control device for controlling the operation of the actuator, wherein the control device is configured to execute the operation control of the actuator based on a detection signal from the lower leg angle sensor It is done.
- the conventional walking movement assisting device recognizes the walking movement state based on the rotation angle around the knee joint of the lower leg detected by the lower leg angle sensor, and the size and direction of the walking movement state are determined according to the walking movement state.
- the actuator is configured to perform operation control so as to output an auxiliary force.
- the lower leg rotates around the knee joint while the thigh rotates around the hip joint. That is, in the conventional configuration, the rotation angle of the lower leg around the knee joint with respect to the thigh rotating around the hip joint is detected, and therefore, it is difficult to accurately recognize the walking motion state.
- the walking motion of the thigh (relative motion of the thigh around the hip joint) can be performed relatively normally
- the walking motion of the lower leg (long knee motion around the knee joint) Motion can not be performed normally.
- the operation control of the actuator is performed based on the movement of the lower leg which can not perform a normal walking motion, and in this respect as well, it is possible to provide an appropriate walking assistance force. There was a risk that I could not do it.
- a walking motion state is recognized based on a thigh phase angle defined by periodic motion of a hip joint, and a walking assistance force corresponding to the recognized walking motion state is output to the thigh
- a walking assistance device is disclosed that performs operation control of the actuator.
- the walking assistance device described in Patent Document 4 includes an applying unit that applies a walking assistance force to the thigh, a control unit that performs operation control of the applying unit, and at least one of a hip joint angle and a hip joint angular velocity.
- the detection unit includes: a detection unit that detects, and a calculation unit that calculates the phase angle of the thigh based on the detection result of the detection unit, and the control unit is configured to perform operation control of the application unit based on the phase angle. It is done.
- the phase angle of the thigh is calculated based on the hip joint angle detected by the detection unit and the hip joint angular velocity obtained by differentiating the hip joint angle.
- the noise component is emphasized by the differential processing, and it becomes difficult to obtain an accurate thigh phase angle.
- the present invention has been made in view of such prior art, and it is possible to apply an appropriate walking assistance power corresponding to the walking state during the walking cycle with the time delay prevented or reduced as much as possible.
- An object of the present invention is to provide an operation assisting device.
- the present invention provides an actuator for applying an assisting force to a user's walking motion, and a hip joint angle related signal related to a hip joint angle which is an anteroposterior rocking angle of the user's thigh at each sampling timing.
- Position detection means for detecting the position
- thigh phase angle calculation means for calculating the thigh phase angle at one sampling timing k, and the relationship between the thigh phase angle and the torque value to be output by the actuator, either directly or indirectly
- Auxiliary torque calculation for calculating a torque value to be output at the one sampling timing k by applying the thigh phase angle calculated by the thigh phase angle calculation means to the output pattern data having the prescribed output pattern data Means for outputting the assisting force of the torque value calculated by the assisting torque calculating means
- Operation control means for controlling operation of the tuator, and the thigh phase angle calculation means is attached with a mass point of a predetermined mass m at the tip of the movement of the leg including the thigh and the lower leg of the user during walking
- the rod-like rigid body having the predetermined length
- the hip joint angle and hip joint angular velocity of the thigh are estimated by the state estimator using the angle-related signal input from the thigh posture detection means at the sampling timing k as an observation value, and sampling using this estimated hip joint angle and estimated hip joint angular velocity
- a walking motion assisting device for calculating a thigh phase angle at timing k is provided.
- Angle and hip joint angular velocity are estimated by a state estimator using an angle-related signal input from the thigh posture detection means as an observation value, and a thigh phase angle is calculated using the estimated hip joint angle and estimated hip joint angular velocity, and the thigh phase angle Since the operation control of the actuator is performed so that the assist torque value calculated based on the above is output, the appropriate walking assistance power according to the walking state during the walking cycle is prevented or reduced as much as possible. It can be granted in the state.
- the state estimator is a Kalman filter.
- the thigh phase angle calculation means uses the equation (1a) based on the equation of motion and the equation (1b) using the angle related signal input from the thigh posture angle detection means as the observation value and the equation (2a) using the Kalman filter And the equation (2e) to calculate the estimated rocking angle and the estimated rocking angular velocity.
- the thigh phase angle calculation means calculates a deviation between the rocking center point of the estimated hip joint angle and the hip joint angle zero point in the completed past walking cycle, and detects the thigh posture during the current walking cycle.
- the angle related signal input from the means is corrected according to the deviation, and the corrected angle related signal is used as an observation value of the state estimator.
- the walking motion assisting device includes a thigh brace mounted on the user's thigh, and a lower thigh mounted on the user's lower thigh and rotatably coupled to the knee brace around the user's knee joint.
- An appliance may be provided, and the actuator may be mounted on the femoral device and be able to apply an assist force around a knee joint to the lower thigh device.
- FIG. 1 is a perspective view of a walking motion assisting apparatus according to an embodiment of the present invention.
- FIG. 2 is a partial front view of the walking motion assisting apparatus.
- FIG. 3 is a partially exploded perspective view of the walking motion assisting apparatus, showing a state viewed from the outside in the user's width direction.
- FIG. 4 is a partially exploded perspective view of the walking motion assisting apparatus, showing a state seen from the inside in the user's width direction.
- FIG. 5 is an exploded perspective view of a thigh frame and a lower leg frame in the walking motion assisting apparatus.
- FIG. 6 is a partial longitudinal sectional view of an actuator unit in the walking motion assisting apparatus.
- FIG. 7 is an end view taken along the line VII-VII in FIG. FIG.
- FIG. 8 is a control block diagram of the walking motion assisting apparatus.
- FIG. 9 (a) is a schematic side view schematically showing the movement around the hip joint of the leg including the thigh and the lower leg of the user during walking
- FIG. 9 (b) is the hip joint of the leg of the user
- FIG. 10 is a trajectory diagram obtained by plotting the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat calculated by the control device in the walking motion auxiliary device over one walking cycle.
- FIG. 11 is a graph in which the thigh phase angle ⁇ calculated by the control device is plotted for each walking cycle.
- FIG. 9 (a) is a schematic side view schematically showing the movement around the hip joint of the leg including the thigh and the lower leg of the user during walking
- FIG. 9 (b) is the hip joint of the leg of the user
- FIG. 10 is a trajectory diagram obtained by plotting the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇
- FIG. 12 is a schematic view showing the transition of the walking state during one walking cycle.
- FIGS. 13 (a) and 13 (b) show an example of assist force control data stored in advance in the control device and showing the relationship between the walking state during one walking cycle and the assist force to be output by the actuator unit. It is a graph which shows other examples.
- FIG. 14 is a flowchart of an actuator operation control mode executed by the control device.
- FIG. 15 is a flowchart of phase pattern function creation processing in the flowchart of FIG.
- FIG. 1 and FIG. 2 respectively show a perspective view and a partial front view of the walking motion assisting device 1 according to the present embodiment.
- 3 and 4 show partially exploded perspective views of the walking motion assisting device 1 as viewed from the outer side and the inner side in the width direction, respectively.
- the walking movement assisting device 1 is a device worn by a user with hemiplegia for walking assistance or for rehabilitation due to a person with a leg, stroke, etc. It is configured to be able to provide a walking assistance power.
- the walking movement assisting device 1 is configured to be able to apply a walking assistance force by the actuator unit 100 to the lower leg. More specifically, as shown in FIGS. 1 to 4, the walking motion assisting device 1 includes a thigh brace 10 mounted on the user's thigh, a lower thigh brace 30 mounted on the user's lower thigh, and the thigh side. An actuator unit 100 mounted on the brace 10 and capable of applying an assist force around the knee joint to the lower thigh brace 30 is provided.
- the thigh brace 10 has a thigh attachment 15 attached to the user's thigh and a thigh frame 20 connected to the thigh attachment 15.
- the thigh mount 15 can take various forms as long as it can be worn on the user's thigh.
- the thigh mounting body 15 is in the form of a tube having a mounting hole sized to allow insertion of the user's thigh and fit to the thigh.
- the thigh frame 20 has a first thigh frame 20 (1) extending up and down along the user's thigh on the width direction outer side of the user.
- the thigh frame 20 further includes the first thigh frame 20 (1) with the user's thigh inserted in the thigh mounting body 10. It has a second thigh frame 20 (2) extending up and down along the user's thigh on the widthwise inner side of the user so as to face each other.
- the lower leg orthosis 30 includes a lower leg attachment body 35 attached to the lower leg of the user, and a lower leg frame 40 connected to the lower leg attachment body 35.
- the lower leg attachment 35 may take various forms as long as it can be attached to the lower leg of the user.
- the lower leg attachment body 35 is in the form of a cylinder having an attachment hole sized to allow insertion of the user's lower leg and fit to the lower leg.
- the lower leg frame 40 has a first lower leg frame 40 (1) extending up and down along the user's lower leg on the width direction outer side of the user.
- the lower leg frame 40 further includes the first lower leg frame 40 (1) with the user's lower leg inserted in the lower leg attachment 30. It has a second lower leg frame 40 (2) extending up and down along the lower leg of the user on the widthwise inner side of the user so as to face each other.
- the lower thigh brace 30 further includes a foot mounting body 65 on which the user mounts a foot, and a foot frame 60 supporting the foot mounting body 65 and coupled to the lower thigh frame 40. have.
- the lower thigh brace 30 is connected to the thigh brace 10 so as to be rotatable around the knee joint of the user. That is, the lower leg frame 40 is connected to the thigh frame 20 so as to be rotatable about the swing axis X of the user's knee joint.
- the thigh frame 20 includes the first and second thigh frames 20 (1) and 20 (2), and the lower leg frame 40 includes the first and second lower leg frames 40. (1), 40 (2) are included.
- first lower leg frame 40 (1) is rotatably connected to the first upper leg frame 20 (1) about the swing axis X
- the second lower leg frame 40 (2) is connected to the second upper leg frame 20. (2) is connected so as to be rotatable around the swing axis X.
- FIG. 5 shows an exploded perspective view of the thigh frame 20 and the lower leg frame 40.
- the thigh frame 20 is fixed to the thigh frame main body 21 by pin connection, welding or the like so as to sandwich the lower end portion of the thigh frame main body 21 and the thigh frame main body 21 extending in the vertical direction. It has a pair of connection pieces 22a and 22b.
- the pair of connecting pieces 22a and 22b are an outer connecting piece 22a located on the side farther from the leg of the user than the thigh frame main body 21 and an inner side located on the side closer to the leg of the user than the thigh frame main body 21 And 22b.
- the lower leg frame 40 is connected to the pair of connection pieces 22a and 22b so as to be rotatable around the swing axis X in a state of being interposed between the pair of connection pieces 22a and 22b.
- mounting holes 23 and 43 are formed in the upper part of the pair of connection pieces 22a and 22b and the lower leg frame 40 coaxially with the swing axis X and along the user's width direction.
- the first thigh frame 20 (1) and the first lower leg frame 40 (1) which are located on the side on which the actuator unit 100 is mounted (outward in the user width direction from the corresponding leg of the user), It is connected so as to be rotatable around the swinging axis X via a pivoting connector 50 (1).
- the first rotation connector 50 (1) includes a first female screw member 51 (1) and a first male screw member 55 (1) which are separably connected to each other in the attachment holes 23 and 43. Have.
- the first female screw member 51 (1) is inserted into the mounting hole 23 from the side of the inner connection piece 22 b, and the cylindrical portion 52 at a position closer to the user's leg than the mounting hole 23. And a flange portion 53 extending radially outward from the above, and the cylindrical portion 52 is formed with a screw hole opened to the free end side.
- the first male screw member 55 (1) is the cylindrical portion 56 inserted into the mounting hole 23 from the side of the outer connection piece 22 a, and the cylindrical portion at a position separated from the leg of the user from the mounting hole 23 And an engagement projection 57 extended from the reference numeral 56.
- An external thread to be screwed into the screw hole of the first female screw member 51 (1) in the attachment holes 23, 43 is formed in the cylindrical portion 56 of the first male screw member 55 (1). There is.
- the first lower leg A frame 40 (1) is pivotally connected to the first thigh frame 20 (1).
- the second thigh frame 20 (2) and the second lower leg frame 40 (2), which are located inward in the width direction of the user than the corresponding leg of the user, are connected via the second pivoting connector 50 (2).
- the pivot axis X is coupled so as to be rotatable.
- the second rotation connector 50 (2) is configured such that the second female screw member 51 (2) and the second male screw member 55 (2) are connected separably to one another in the mounting holes 23, 43. Have.
- the second female screw member 51 (2) has the same configuration as the first female screw member 51 (1).
- the second male screw member 55 (2) is a cylindrical portion 56 which is inserted into the mounting hole 23 from the side of the outer connection piece 22a, and the cylindrical portion 56 inward of the mounting hole 23 in the user width direction. And a flange portion 58 extending radially outward therefrom.
- the cylindrical portion 56 of the second male screw member 55 (2) is formed with a male screw to be screwed into the screw hole of the second female screw member 51 (2) in the mounting holes 23, 43. There is.
- the second lower leg A frame 40 (2) is pivotally connected to the second thigh frame 20 (2).
- symbol 53a of FIG. 5 is a radial direction outward protrusion provided in the said flange part 53,
- the said internal thread member 51 is said inner connection It is held so as not to be relatively rotatable about an axis with respect to the piece 22b (ie, the thigh frame 20).
- the walking motion assisting device 1 further prohibits rotation of the lower leg frame 40 about the swing axis X with respect to the thigh frame 20.
- a lock member 70 is provided.
- the locking member 70 surrounds the thigh frame 20 and the lower thigh frame 40 to connect the two frames 20 and 40, and the lower thigh frame 40 rotates relative to the thigh frame 20 about the swing axis X 1 to 4 and the connection of the thigh frame 20 and the lower leg frame 40 is released, and the lower leg frame 40 swings with respect to the thigh frame 20. It is configured to be capable of taking a release state that allows relative rotation about the axis X.
- the locking member 70 is a first locking member 70 located on the outer side in the user's width direction acting on the first thigh frame 20 (1) and the first lower leg frame 40 (1). 1) and a second locking member 70 (2) positioned on the inner side in the user's width direction acting on the second thigh frame 20 (2) and the second lower thigh frame 40 (2).
- the upper end surface 45 (the end surface facing the thigh frame 20) of the lower leg frame 40 moves from one side to the other side around the swing axis X.
- the lower surface 25 (the end surface facing the lower leg frame 40) of the thigh frame 20 corresponds to the upper end surface 45 of the lower leg frame 40 so as to increase the radial distance from the swing axis X. It is considered to be an inclined surface.
- the lower leg frame 40 is allowed to rotate only to one side (the direction in which the lower leg of the user bends with respect to the thigh) about the swing axis X with respect to the thigh frame 20, to the other side
- the lower leg is allowed to extend relative to the thigh while not rotating further.
- FIG. 6 shows a partial longitudinal sectional view of the actuator unit 100.
- the actuator unit 100 includes an upper frame 120, a lower frame 340 rotatably connected to the upper frame 120 about a pivot axis Y, and the lower frame 340.
- Drive body 110 such as an electric motor that generates a driving force for rotating the pivot axis Y about the pivot axis Y, an upper connecting body 360 linking the upper frame 340 to the thigh frame 20, and the pivot axis Y
- a pivoting center connector 180 coaxially with the swing axis X and a lower connector 370 are provided.
- the upper frame 120 and the lower frame 340 are respectively provided with an upper frame mounting hole 120a and a lower frame mounting hole 140a coaxially arranged with the pivot axis Y.
- a pivoting connection shaft 151 is fixed to the lower frame attachment hole 140a, and the pivoting connection shaft 151 is rotatably supported by the upper frame attachment hole 120a via a bearing member 155 so as to be rotatable about its axis.
- the lower frame 340 is rotatably connected to the upper frame 120 about the pivot axis Y.
- the driving body 110 has a driving source 111 such as an electric motor and a transmission mechanism 115 for transmitting the driving force generated by the driving source 111 to the lower frame 340.
- a driving source 111 such as an electric motor
- a transmission mechanism 115 for transmitting the driving force generated by the driving source 111 to the lower frame 340.
- the driving source 111 is fixed to the outer surface of the upper frame 120.
- the drive source 111 is fixed to the outer surface of the upper frame 120 in a state where the output shaft 111a extends downward.
- the transmission mechanism 115 includes a drive-side bevel gear 116 supported non-rotatably on the output shaft 111a, and the lower frame 340 around the pivot axis Y.
- the driven bevel gear 117 is engaged with the drive bevel gear 116 in a state of being connected to the lower frame 340 so as to rotate integrally.
- the actuator unit 100 may have a sensor (not shown) for detecting the rotation angle of the rotation connection shaft 151 about the axis, and the rotation angle of the rotation connection shaft 151 about the rotation connection shaft 151 by the sensor.
- a sensor not shown
- the upper connecting body 360 is parallel to the pivot axis Y and opened outward in the user width direction (in the direction of the upper frame 120) by the first thigh frame 20 (1 And an engagement pin 362 provided on the upper frame 120 so as to be engageable with the engagement hole 361).
- the upper connecting member 360 is provided with a locking mechanism.
- the locking mechanism as shown in FIG. 4, can be moved back and forth in the radial direction from the outer surface of the engagement pin 362, and the engagement position is projected radially outward from the outer surface of the engagement pin
- a projection 366 capable of taking a release position retracted into the engagement pin, a biasing member (not shown) biasing the projection 366 toward the engagement position, and the engagement pin 362
- a recess (not shown) provided in the engagement hole so as to engage with the convex portion 366 in a state of being engaged in the engagement hole 361, and the biasing member according to an external operation from outside
- a release operation portion 367 for pressing the convex portion 366 to the release position against the biasing force of
- the pivot center connector 180 is positioned coaxially with the swing axis X, the first thigh frame 20 (1) or the first lower leg frame 40 (1 And an actuator side rotation center connection member 185 provided on the upper frame 120 or the lower frame 340 so as to be located coaxially with the pivot axis Y.
- an actuator side rotation center connection member 185 provided on the upper frame 120 or the lower frame 340 so as to be located coaxially with the pivot axis Y.
- the engagement convex portion 27 in the first rotation connector 50 (1) functions as the device side rotation center connection member.
- the actuator-side rotation center connection member 185 has an actuator-side uneven engagement portion 185a that detachably engages with the device-side rotation center connection member (in the present embodiment, the engagement convex portion 57). doing.
- the device side rotation center connection member in the present embodiment, the engagement convex portion 57
- the engagement convex portion 57 can be attached to and detached from the upper frame 120, and can rotate about an axis.
- An engagement recess which can be engaged is formed, and the engagement recess acts as the actuator-side uneven engagement portion 185a.
- the lower connecting body 370 is the first lower leg frame according to the movement of the lower frame 340 about the pivot axis Y with respect to the upper frame 120.
- the lower frame 340 is connected to the first lower leg frame 40 (1) such that the lower frame 40 (1) pivots about the swing axis X with respect to the first thigh frame 20 (1).
- the lower frame 340 is connected to the upper frame 120 via the pivot connection shaft 151 at a base end portion 341 pivotably connected with the pivot axis Y, and the base And a tip 345 extending from the end 341 to the side closer to the first lower leg frame 40 (1).
- the base end portion 341 supports the driven bevel gear 117 so as to integrally rotate around the pivot axis Y, whereby the driving body
- the driven bevel gear 117 and the base end 341 integrally rotate around the pivot axis Y by the rotational power from 110.
- the base end portion 341 is in the form of a flat plate extending substantially vertically.
- the tip end portion 345 forms an opposing surface that opposes an outer side surface of the first lower leg frame 40 (1) facing the user width direction outward in the first lower leg frame 40 (1).
- the distal end surface 346 has a predetermined length in the width direction D corresponding to the width direction (that is, the user longitudinal direction) of the first lower leg frame 40 (1).
- the tip end portion 345 has a flat plate shape substantially along the horizontal direction, and the tip end surface 346 has a substantially rectangular shape.
- the lower connecting body 370 includes a support hole 371 formed in the tip end portion 345, an engagement pin 372 accommodated in the support hole 371 so as to be movable back and forth, and the engagement.
- a biasing spring 373 for biasing the pin 372 and an engagement arm 375 provided at the tip 345 are provided.
- the support hole 371 opens in the opposite surface in the width direction intermediate region of the opposite surface, and extends in a direction substantially orthogonal to the outer surface of the first lower leg frame 40 (1).
- the engagement pin 372 can be in a projecting position where its tip end protrudes from the opposing surface and a retracted position where it enters the support hole 371 so as to be separated from the first lower leg frame 40 (1) from the projecting position.
- the support hole 371 is accommodated so as to be movable in the axial direction.
- the biasing spring 373 biases the engagement pin 371 to the projecting position.
- the biasing spring 373 is interposed between the proximal end of the engagement pin 371 and the bottom of the support hole 371.
- the support hole 371 is formed in the tip 345 so that one end is open to the opposite surface and the other end is open to the back opposite to the opposite surface.
- the other end side of the support hole 371 is closed by a closing plate 348 fixed to the back surface of the tip 345.
- the closing plate 348 forms the bottom of the support hole 371.
- the engagement arm 375 has an axially extending portion 376 extending along the pivot axis Y from the opposite surface to the side closer to the first lower leg frame 40 (1).
- the axially extending portion 376 is arranged such that the first lower leg frame 40 (1) can be disposed between the axially extending portion 376 and the engagement pin 372 in the width direction of the lower frame 340.
- a widthwise separation distance between the engaging pin 372 and the engaging pin 372 is set.
- the engagement pin 372 and the axially extending portion may be positioned such that the first lower leg frame 40 (1) can be positioned between the engagement pin 372 and the axially extending portion 376 in the user longitudinal direction.
- the widthwise distance between 376 is greater than the width of the first lower leg frame 40 (1).
- FIG. 7 shows an end view along the line VII-VII in FIG.
- the engagement pin 372 is in the retracted position against the biasing force of the biasing spring 373. While being positioned, the actuator unit 100 is relatively moved in the pivot axis Y direction to a position where the first lower leg frame 40 (1) overlaps with the axially extending portion 376 in the direction along the pivot axis Y.
- the movement of the engagement pin 372 to the retracted position can be performed via the outer side surface of the first lower leg frame 40 (1). That is, the actuator unit 100 is moved from the projecting position to the retracted position with the outer surface of the first lower leg frame 40 (1) in contact with the engaging pin 372. It can be moved relative to the first lower leg frame 40 (1) in the proximity direction. This state is shown by a broken line in FIG.
- the first lower leg frame 40 (1) is sandwiched by the engagement pin 372 and the axially extending portion 376 in the width direction (user front-rear direction) of the lower frame 340 (FIG. 7 Solid line), the lower frame 340 can be moved relative to the first lower leg frame 40 (1) in the longitudinal direction of the frame, the lower frame 340 about the pivot axis Y with respect to the upper frame 120
- An interlocked state in which the first lower leg frame 40 (1) is rotated about the swing axis X with respect to the thigh frame 20 appears in conjunction with the pivoting movement.
- the lower frame 340 connected to the first lower leg frame 40 (1) by the lower connecting body 370 can be removed by performing the reverse operation to the time of wearing. That is, when the lower frame 340 is connected to the first lower leg frame 40 (1) by the lower connecting body 370, the engagement pin 372 is positioned at the projecting position by the biasing force of the biasing spring 373. It is done.
- the lower frame 340 is rotated about the axis Y when the lower frame 340 is released while pushing the engagement pin 372 in this projecting position to the retracted position against the biasing force of the biasing spring 373 by manual operation force (FIG. 7). Is turned in the counterclockwise direction), and the state (the state of broken line in FIG. 7) in which the tip of the engagement pin 372 abuts on the outer surface of the first lower leg frame 40 (1) is revealed.
- the lower frame 340 can be removed from the first lower leg frame 40 (1) by relatively moving the first lower leg frame 40 (1) and the lower frame 340 in a direction away from each other. .
- the engagement arm 375 extends from the axial extension portion 376 in a direction close to the engagement pin 372 with respect to the width direction W of the opposing surface, and the lower frame 340 is the first lower leg frame 40 ( In the state of being connected to 1), a width direction extending portion 377 opposed to the inner side surface (a side surface facing inward in the user width direction) of the first lower leg frame 40 (1) is included.
- the width direction extending portion 377 includes the engagement pin 372 where the first lower leg frame 40 (1) forms the facing surface, the distal end surface 346, the axial extending portion 376, and the width direction extending portion
- the axial separation distance between the distal end surface 346 is larger than the thickness of the first lower leg frame 40 (1) so that it can be disposed in the holding space 370 S (see FIG. 4) surrounded by 377 Configured
- the lower frame 340 is connected to the first lower leg frame 40 (1) by the lower connecting body 370, the lower frame 340. And, it is possible to effectively prevent the relative movement of the first lower leg frame 40 (1) in the direction of separating along the pivot axis Y direction, whereby the lower frame 340 is not 1 It is possible to effectively prevent detachment from the lower leg frame 40 (1).
- the engagement arm 375 has first and second engagement arms 375 (1) and 375 (2) provided on one side and the other side in the width direction of the opposing surface.
- the lower frame 340 can be connected to the first lower leg frame 40 (1) regardless of which direction the lower frame 340 is pivoted about the pivot axis Y from the state shown by the broken line in FIG. 7. It is supposed to be.
- the swing axis X is the center of the first lower leg frame 40 (1) in the width direction (user longitudinal direction), the first lower leg frame 40. It is offset to one side in the width direction (user's front-rear direction) of (1). In FIG. 7, the swing axis X is offset rearward with respect to the front-rear direction of the user with respect to the center in the width direction of the first lower leg frame 40 (1).
- the engagement pin 372 is disposed at the center of the lower frame 40 in the width direction (user longitudinal direction), and the engagement arm 375 sandwiches the engagement pin 372 to the lower frame.
- the actuator unit 100 can be attached to either the left foot side or the right foot side of the walking motion assisting device 1.
- the actuator unit 100 when the actuator unit 100 is attached to the left foot side of the walking motion assisting device 1, the first lower leg frame 40 (1) is formed by the engagement pin 372 and the first engagement arm 375 (1).
- the actuator unit 100 is mounted on the right foot side of the walking movement assisting device 1 while holding the first lower thigh frame 40 (with the engagement pin 372 and the second engagement arm 375 (2) 1) can be inserted.
- the actuator unit 100 includes the engagement pin 372 and the first engagement arm 375 (1) located forward in the user longitudinal direction. (1) Although it is mounted so as to sandwich the lower leg frame 40 (1), when it is desired to widen the rotation angle for rotating the first lower leg frame 40 (1) with respect to the first thigh frame 20 (1) And attaching the actuator unit 100 so as to sandwich the first lower leg frame 40 (1) by the engagement pin 372 and the second engagement arm 375 (2) positioned rearward with respect to the user longitudinal direction. Can.
- the initial posture of the lower frame 340 (the The posture of the lower frame 340 when the user takes the substantially upright posture with the actuator unit 100 mounted, which is the posture shown by the solid line in FIG. From the posture shown by the broken line in FIG. 7, the posture rotated clockwise by a predetermined angle ⁇ around the pivot axis Y is taken.
- the lower leg is bent with respect to the thigh.
- the first lower leg frame 40 (1) rotates in the clockwise direction with respect to the first thigh frame 20 (1) when viewed from the inside in the user's width direction.
- the lower frame 340 is in a horizontal posture (the posture shown by the broken line in FIG. 7) when viewed from the inside in the user width direction. If the user rotates the lower leg in the bending direction with respect to the thigh to assist the bending operation of the knee if it is rotated clockwise about the pivot axis Y by a predetermined angle ⁇ , that is, the lower portion
- the pivoting range in which the pivoting axis Y can be pivoted in the clockwise direction is narrowed by the predetermined angle ⁇ with reference to the horizontal posture.
- the actuator unit 100 is mounted so as to sandwich the first lower leg frame 40 (1) by the engaging pin 372 and the second engaging arm 375 (2) positioned rearward with respect to the user longitudinal direction. Then, in the initial posture (the posture in which the user is substantially upright), the lower frame 340 is pivoted from the horizontal posture (the posture shown by the broken line in FIG. 7) when viewed from the inside in the width direction of the user. A posture rotated by a predetermined angle ⁇ in the counterclockwise direction around Y is taken.
- the lower frame 340 when the lower frame 340 is viewed from the inside in the width direction of the user, it pivots in the clockwise direction of the pivot axis Y when the pressing force can be applied in the direction to bend the knee to assist the walking operation of the user.
- the rotation range that can be made can be expanded by the predetermined angle ⁇ with reference to the horizontal posture.
- the walking movement assisting device 1 recognizes the walking state in the walking cycle based on the thigh phase angle, and operates the actuator unit 100 so that a walking assistance force suitable for the walking state is applied. Take control.
- the actuator unit 100 applies a walking assistance force to the lower leg. That is, the walking motion assisting apparatus 1 according to the present embodiment detects the motion of the thigh different from the lower thigh which is the control target site, and based on the motion of the thigh, the walking assistance force for the lower thigh which is the control target site Is configured to perform operation control of the actuator unit 100 that applies the
- FIG. 8 shows a control block diagram of the walking motion assisting device 1.
- the walking motion assisting device 1 is based on the thigh posture detecting means 510 capable of detecting an angle related signal related to a hip joint angle which is a back and forth rocking angle of the user's thigh.
- Thigh phase angle calculating means 550 for calculating the thigh phase angle ⁇
- a walking motion timing calculating means 560 for converting the thigh phase angle ⁇ into a walking state (walking motion timing) during the walking cycle, and output at the walking motion timing
- An auxiliary torque calculating means 570 for calculating a torque value to be calculated
- an operation control means 580 for controlling the operation of the actuator unit 100 (the driving body 110).
- the walking movement assisting device 1 includes a control device 500.
- the control device 500 functions as the thigh phase angle calculation means 550, the walking movement timing calculation means 560, the auxiliary torque calculation means 570, and the operation control means 580. Do.
- the control device 500 includes a calculation unit including control calculation means for performing calculation processing based on signals inputted from the thigh posture detection means 510 and an artificial operation member, and a ROM for storing control programs, control data and the like, Nonvolatile storage means that save setting values and the like without loss even when the power is turned off, and the setting values and the like can be rewritten, and RAM for temporarily retaining data generated during computation by the computing unit And a storage unit including
- the thigh posture detection means 510 detects the angle-related signal at predetermined sampling timings predetermined in one walking cycle.
- the thigh posture detection means 510 may have various forms such as a gyro sensor, an acceleration sensor, a rotary encoder, etc. as long as it can directly or indirectly detect the back and forth rocking angle (hip joint angle) of the thigh.
- the thigh posture detecting means 510 is assumed to have a three-axis angular velocity sensor (gyro sensor) 511 capable of detecting the longitudinal rocking angular velocity of the thigh.
- the walking motion assistance device 1 has a three-axis acceleration sensor 515, and the thigh phase angle calculation means 550 is a vertical axis Z detected by the three-axis acceleration sensor 515 at rest. It is configured to be used as a reference axis of the hip joint angle (front and rear rocking angle of the thigh).
- FIG. 9A is a schematic side view schematically showing the movement around the hip joint of the leg including the thigh and the lower leg of the user during walking.
- the thigh phase angle calculation means 550 has a predetermined mass at the tip as shown in FIG. 9 (b), the movement around the hip of the leg including the thigh and the lower leg of the user during walking.
- a rod-like rigid body 600 of a predetermined length, to which m mass points M are attached, is approximated by a pendulum movement movement with the base end as the rocking center 610, and state estimation designed for the equation of motion of this pendulum movement Is used to obtain an estimated hip joint angle ⁇ hat and an estimated hip joint angular velocity ⁇ dot hat at one sampling timing k. Note that m and? Are set for each user by experiment or the like, and the mass of the rod-like rigid body 600 is zero.
- equation (8) the equation of motion of the rod-like rigid body 600 with the mass point M with respect to the tangential direction of the circle Q along the swinging trajectory of the mass point M is equation (8).
- ⁇ (t) is a hip joint angle that is the back and forth rocking angle of the user's thigh, represented by the rocking angle of the rod-like rigid body 600 with respect to the vertical axis passing through the rocking center.
- g is a gravitational acceleration
- ⁇ is a viscous friction coefficient resulting from the frictional force around the rocking center of the rod-like rigid body due to viscous friction
- ⁇ is an unknown disturbance including a hip joint torque of the user.
- Expression (9b) is rewritten using vector x (t) (see Expression (9a)), Expression (10a) and Expression (10b) are obtained.
- coefficients A and G in equation (10a) are as follows.
- Formula (10a) and Formula (10b) are expressed by discrete time representation (sampling timing k), it will become Formula (1a) and Formula (1b).
- x [k + 1] means the value of x at sampling timing k + 1
- x [k] means the value of x at sampling timing k
- ⁇ [k] is at sampling timing k
- v [k] means the value of the observation noise at the sampling timing k.
- Equation (1a) the muscle force torque of the user acting on the hip joint is included in the unknown disturbance ⁇ as an unknown amount.
- the thigh phase angle calculation means 550 uses a Kalman filter as a state estimator.
- the estimation equation by the Kalman filter is expressed by equations (2a) to (2e).
- the thigh phase angle calculation means 550 calculates the Kalman gain according to the magnitudes of the estimation error and the observation error at each sampling timing. That is, the thigh phase angle calculation means 550 calculates a value that minimizes the covariance of the estimation error and the observation error at each sampling timing according to the equations (2c), (2d) and (2e), and this value Is used as the Kalman gain K [k] at the sampling timing.
- the thigh phase angle calculation means 550 uses the equation (1a) to calculate the vector value x [k + 1 at the next sampling timing k + 1 based on the vector value x [k] at the one sampling timing k. ] (Hereinafter referred to as "predicted value").
- the thigh phase angle calculation means 550 obtains the optimum Kalman gain K [k] calculated at the sampling timing k or the stationary Kalman gain K 1, and then obtains the formula at the immediately preceding sampling timing k ⁇ 1.
- the predicted value of the sampling timing one ahead calculated calculated by (2a) is used as the prior estimated value x hat [k
- k] is calculated.
- the thigh phase angle calculation unit 550 uses the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat included in the posterior estimated value x hat [k
- k] to calculate the thigh phase angle ⁇ (k) at the sampling timing k. ( ⁇ Arctan ( ⁇ dot hat (k) / ⁇ hat (k)) is calculated.
- the hip joint angle and the hip joint angular velocity at one sampling timing are obtained by performing differentiation processing and low pass processing on the hip joint angle detected by the gyro sensor or the like, and the thigh phase is obtained based on the hip joint angle and the hip joint angular velocity. It is also possible to calculate the angle (hereinafter referred to as a comparison configuration).
- the noise component is emphasized by the differential processing, and a time delay due to the low pass processing is also generated.
- the motion of the user's leg during walking is approximated by the pendulum motion of the rod-like rigid body 600, and a state estimator designed for the equation of motion of this pendulum motion. Since the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat at the sampling timing k are obtained by using the above, the enhancement of the noise component due to the differential processing and the time delay due to the low pass processing can be effectively prevented Can be obtained while the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat can be obtained.
- a Kalman filter is used as the state estimator.
- another state estimator such as an observer.
- the thigh phase angle calculation means 550 performs rotation center correction on the hip joint angle related signal from the thigh posture detection means 510 and corrects the hip joint angle relation after correction.
- the signal is used to calculate the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat.
- the thigh phase angle calculation means 550 calculates the rocking center point of the estimated hip joint angle ⁇ hat in the completed past walking cycle, and the deviation of the rocking center point from the hip joint angle zero point is calculated. calculate.
- the thigh phase angle calculation means 550 performs correction e according to the deviation with respect to the angle related signal inputted from the thigh posture detection means 510 during the walking cycle at the present time, and the corrected angle The associated signal is used as the observed value of the state estimator.
- the accuracy of the phase angle ⁇ calculated by the thigh phase angle calculation means 550 can be improved.
- the walking cycle targeted for calculation of the swing center point may be the entire walking cycle completed at that time, or among the walking cycles completed at that time, The walking cycle may be the nearest predetermined number of times (for example, five or ten times, etc.).
- the phase angle targeted at the calculation of the swing center point may be all sampling points in one walking cycle to be calculated, or one walking cycle to be calculated It may be the “positive” maximum phase angle and the “negative” maximum phase angle in
- the thigh phase angle calculation means 550 creates a trajectory diagram by plotting the thigh movement state defined by the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat on a phase angle plane. Is configured as.
- FIG. 10 shows a trajectory diagram obtained by plotting the thigh movement state (walking state) defined by the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat over one walking cycle.
- the thigh phase angle ⁇ determined by the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat is defined to change between 0 and 2 ⁇ in one walking cycle.
- hip joint angles when the thigh is positioned forward and backward from the vertical axis are respectively “positive” and “negative”
- hip joint angular velocity when the thigh is swung forward and backward is respectively “Positive” and “negative”.
- the estimated hip joint angle ⁇ hat is in the “negative” direction
- the walking region up to the state where the estimated hip joint angular velocity ⁇ dot hat becomes “zero” corresponds to the phase angles ⁇ / 2 to ⁇ .
- walking area A3 in FIG. 10 (the estimated hip joint angle ⁇ hat is “zero” and estimated from the state where the estimated hip joint angle ⁇ hat is maximum in the direction of “negative” and the estimated hip joint angular velocity ⁇ dot hat is “zero”
- the walking region up to the state in which the hip joint angular velocity ⁇ dot hat is maximized in the “positive” direction corresponds to the phase angle ⁇ to 3 ⁇ / 2.
- the estimated hip joint angle ⁇ hat is in the “positive” direction
- the walking region up to the state where the estimated hip joint angular velocity ⁇ dot hat becomes “zero” corresponds to the phase angles 3 ⁇ / 2 to 2 ⁇ .
- the sampling timing of the thigh posture detection means 510 is determined such that a plurality of sampling points are included in one walking cycle, and the thigh phase angle calculation means 550 calculates the thigh phase angle ⁇ at each sampling timing.
- the thigh phase angle calculation means 550 determines the vector length of the plot point Sk on the trajectory diagram drawn by the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k (the trajectory diagram It is determined whether the origin (ie, the distance between the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k zero point) and the plot point Sk exceeds a predetermined threshold, and the vector length If T exceeds the predetermined threshold value, the thigh phase angle ⁇ k is calculated based on the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k, and the thigh phase angle ⁇ k is transmitted to the walking motion timing calculation means 560 .
- the thigh phase angle calculation means 550 outputs an actuator operation prohibition signal.
- the thigh phase angle calculation means 550 has the above configuration, such a slight posture change is detected as a vector having a short vector length. Accordingly, it is assumed that the walking motion is performed only when the vector length of the vector Vk (see FIG. 10) defined by the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k exceeds a predetermined threshold. By making a determination, it is possible to effectively prevent the actuator unit 100 from operating unintentionally despite the fact that the walking motion has not been started.
- the walking movement timing calculation means 560 has a phase pattern function that defines the relationship between the thigh phase angle ⁇ and the walking movement timing in the walking cycle, and one sampling sent from the thigh phase angle calculation means 550 The thigh phase angle ⁇ at the timing is applied to the phase pattern function to calculate which walking operation timing in the walking cycle corresponds to the one sampling timing.
- the walking motion timing calculation means 560 may, for each completion of the walking cycle, the latest phase angle data in which the thigh phase angle ⁇ in the completed walking cycle and the walking motion timing corresponding to the thigh phase angle are associated.
- the latest phase pattern function is calculated by the least squares method with respect to the effective phase angle data including the past phase angle data stored at that time, and the calculated latest phase pattern function is overwritten and saved.
- the walking motion timing calculation means 560 stores an initial phase pattern function ⁇ ( ⁇ ) (C0) as the phase pattern function.
- the initial phase pattern function ⁇ ( ⁇ ) (C0) is created for each user and stored in advance in the walking motion timing calculation means 560.
- the thigh phase angle calculation means 550 calculates ⁇ k as the thigh phase angle at one sampling timing Sk and transmits it to the walking movement timing calculation means 560.
- the walking motion timing calculation means 560 Since the first walking cycle C1 has not been completed at this time, the walking motion timing calculation means 560 has the initial phase pattern function ⁇ ( ⁇ ) (C0) as the phase pattern function.
- the walking motion timing calculation means 560 applies the thigh phase angle ⁇ k sent from the thigh phase angle calculation means 550 to the initial phase pattern function ⁇ ( ⁇ ) (C0). Then, the storage cycle walking operation timing tk corresponding to the one sampling timing k is calculated and transmitted to the auxiliary torque calculating means 570.
- the walking motion timing calculation means 560 repeats such processing until the first walking cycle C1 is completed.
- the completion of one walking cycle may be determined, for example, based on whether the thigh phase angle ⁇ defined by the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat has returned to the preset walking cycle reference angle. Can.
- the walking movement timing calculating means 560 calculates the thigh phase angle and the thigh phase angle received from the thigh phase angle calculating means 550 during the completed first walking cycle C1.
- the latest phase angle data in a state in which it is associated with the walking movement timing corresponding to is stored by the past phase angle data stored at that time (in this example, generated by the initial phase pattern function ⁇ ( ⁇ ) (C0) Phase angle data), and generates effective effective phase angle data at that time, and using the least squares method for the effective phase angle data, the latest phase angle pattern function (in this example, the first phase angle data)
- the phase pattern function ⁇ ( ⁇ ) (C1)) is calculated, and the latest phase angle pattern function is overwritten and saved.
- the coefficient parameter of is calculated, and .phi. (. Alpha.) (C1) is stored as a phase pattern function of the thigh phase angle.
- m is a positive integer.
- the walking motion timing calculation means 560 uses the phase pattern function ⁇ ( ⁇ ) (C1) at the time of completion of the first walking cycle stored at that time during the second walking cycle C2 to save the cycle.
- the operation timing tk is calculated.
- the walking movement timing calculation means 560 performs least squares on the effective phase angle data effective at that time.
- ⁇ ( ⁇ ) (C2) a0 (2) + a1 (2) ⁇ + a2 (2) ⁇ 2 + ... + am (2) ⁇ m
- the coefficient parameter of is calculated, and .phi. (. Alpha.) (C2) is overwritten and saved as a phase pattern function of the thigh phase angle.
- the walking movement timing calculation means 560 uses the second walking cycle completion phase pattern function ⁇ ( ⁇ ) (C2) stored at that time during the third walking cycle C3 to save the storage cycle. Calculate the operation timing.
- the walking motion timing calculation means 560 repeats such processing.
- the effective phase angle data may include phase angle data for all walking cycles completed at that time, and instead, it may be stored in the storage capacity of the walking movement timing calculation means 560. Accordingly, it is also possible to limit to only the phase angle data in the walking cycle of the latest predetermined number of times (for example, 100 times).
- the walking motion timing calculation means 560 has the following configuration to prevent abnormal phase angle data from being included in the effective phase angle data at the time of calculation of the phase angle pattern function.
- the walking motion timing calculation means 560 calculates the current cycle walking motion timing Tk calculated based on the thigh phase angle ⁇ k at one sampling timing k received from the thigh phase angle calculation means 550, and the thigh phase angle ⁇ n Is applied to the phase pattern function .phi. (. Alpha.) Stored at that time to calculate the difference .DELTA.T from the storage periodic walking motion timing tk.
- the walking motion timing calculation unit 560 calculates effective phase angle data used when calculating a new phase pattern function ⁇ ( ⁇ ) at the completion of the walking cycle.
- the current periodic walking motion timing Tk is stored.
- the walking motion timing calculation unit 560 calculates the latest phase pattern function at the completion of one walking cycle, the thigh during the one walking cycle.
- the current periodic walking movement timing Tk is stored as the walking movement timing associated with the thigh phase angle ⁇ received from the phase angle calculation means 550.
- the walking movement timing calculation unit 560 calculates the effective phase angle data used when calculating the latest phase pattern function at the completion of the walking cycle.
- the storage cycle walking operation timing tk is stored.
- the walking movement timing calculation unit 560 calculates the latest phase pattern function at the completion of one walking cycle, the thigh during the one walking cycle.
- the storage cycle walking operation timing tk is stored as the walking operation timing associated with the thigh phase angle ⁇ received from the phase angle calculation means 550.
- the auxiliary torque calculation means 570 has an output torque pattern that defines the relationship between the walking movement timing and the torque value to be output, and the walking movement timing sent from the walking movement timing calculation means 560 is output as the output.
- the torque value to be output at the sampling timing Sn is calculated by applying to the torque pattern.
- the output torque pattern is created for each user and stored in advance in the auxiliary torque calculation means 570.
- the operation control means 580 executes the operation control of the actuator unit 100 so as to output the assisting force of the torque value calculated by the auxiliary torque calculating means 570.
- the walking motion assistance device 1 grasps the walking state (walking motion timing) in the walking cycle based on the thigh phase angle ⁇ , and outputs the assisting force according to the walking state. Is configured as. Therefore, it is possible to accurately recognize the walking state (walking operation timing) and to output the assisting force suitable for the walking state.
- the walking motion assisting device 1 is configured to calculate the walking state (walking motion timing) by applying the thigh phase angle ⁇ to the phase pattern function stored at that time. There is. Therefore, even if irregular walking motion occurs during the walking cycle, it is possible to output the assisting power in the corrected state.
- the thigh phase angle calculating means 550 is a vector of plot points on the trajectory diagram drawn by the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat.
- the thigh phase angle ⁇ is calculated based on the estimated hip joint angle ⁇ hat and the estimated hip joint angular velocity ⁇ dot hat only when the length exceeds the predetermined threshold, and the thigh phase angle ⁇ is transmitted to the walking motion timing calculation means
- an actuator operation inhibition signal is output.
- the actuator unit 100 outputs the walking assisting force even though the walking action is not started. It can be effectively prevented.
- the walking motion assisting device 1 recognizes the walking state in one walking cycle based on the thigh phase angle ⁇ , and then assists the walking of the lower thigh by the actuator unit 100. It is configured to apply a force. Therefore, accurate walking assistance power can be supplied to the user having hemiplegia due to a stroke or the like.
- the conventional walking assistance device configured to apply the walking assistance force by the actuator unit detects the movement of the control target portion to which the assistance force is applied by the actuator unit, and the actuator unit is detected based on the detection result. It is configured to perform operation control of
- operation control of an actuator that applies walking assistance force to the thigh is performed based on the detection result of the movement of the thigh.
- operation control of an actuator that applies the walking assistance force to the lower thigh is performed.
- the walking motion of the thigh (back and forth rocking motion around the hip joint) can be performed relatively normally, but the walking motion of the lower leg (back and forth rocking motion around the knee joint) Can not be done normally.
- the walking assistance force is applied to the lower thigh based on the movement of the lower thigh which can not perform a normal walking motion. Since the operation control of the provided actuator is performed, there is a possibility that an appropriate walking assistance force can not be provided.
- the walking motion assisting apparatus 1 performs operation control of the actuator unit 100 for applying a walking assistance force to the lower leg based on the thigh phase angle ⁇ . Is configured. Therefore, even if the user has hemiplegia due to a stroke or the like, it is possible to supply an appropriate walking assistance power to the lower leg.
- FIG. 12 shows a schematic view of the walking state changing during one walking cycle.
- one walking cycle includes a heel contact period (a period before and after the foot which has stepped down) X1 including the heel contact point at which heels are grounded on the front side from the vertical axis It was standing from the end of standing phase X2 with standing phase (period in which the implanted floor moves relative to the body backward) X and relative position to move backward with the contacted leg grounded. It includes swinging phase X3 in which the leg is pulled up and relatively moved forward.
- FIG. 13 (a) shows an example of the change pattern of the assist force defined by the output torque pattern.
- the output torque pattern is a first method for preventing the knee breakage by rotating the lower leg side brace 30 around the knee joint in the knee extension direction in the heel contact period X1.
- the second thigh pattern Y2 for preventing the knee breakage by rotating the lower thigh side device 30 around the knee joint in the knee extension direction and standing from the end of the standing period X2
- the lower thigh brace 30 is rotated around the knee joint in the knee flexion direction to assist lifting of the leg
- the torque pattern Y3 and the fourth torque pattern Y4 for rotating the lower leg brace 30 in the knee extension direction around the knee joint in the late stage X3b of the swing phase X3 are included.
- FIG. 13 (b) shows another example of the change pattern of the assisting force defined by the output torque pattern.
- the output torque pattern includes only the third torque pattern Y3 and the fourth torque pattern Y4.
- the heel contact is set as the walking cycle reference timing. As described above, by setting the heel contact as the walking cycle reference timing, it is possible to accurately grasp the timing at which the walking assistance force is required during the walking cycle.
- the timing of the heel contact can be recognized by various methods. For example, when the hip joint angular velocity when the thigh is rocking forward and backward with respect to the vertical axis is positive and negative, respectively, the hip joint angular velocity calculated by the control device 500 has a positive value. It can be configured to recognize as the heel contact point in time a point advanced by a predetermined phase angle ⁇ from the timing (P in FIG. 10) when shifting from zero to zero.
- the walking movement assisting device 1 is provided with heel contact detection means for detecting a heel contact, and the thigh phase angle detection means recognizes the timing detected by the heel contact detection means as a heel contact time point. It is also possible to configure so as to recognize the thigh phase angle ⁇ at that timing as the heel contact phase angle.
- the acceleration sensor 515 when the acceleration sensor 515 is provided, the acceleration sensor 515 can also be used as the heel contact detecting means. Instead of this, it is also possible to separately provide a pressure sensor capable of detecting the ground of the heel, and to act the pressure sensor as the heel contact detection means.
- FIG. 14 shows a flow of the actuator operation control mode in the walking motion assisting apparatus 1.
- the controller 500 activates the actuator operation control mode in response to the activation signal input.
- the start signal is input, for example, in response to an operation by a user on an artificial operation member such as a start button.
- the thigh phase angle detecting means 550 measures the one sampling timing k based on the angle related signal at the one sampling timing k from the thigh posture detecting means 510.
- the hip joint angle ⁇ k is recognized (step S11).
- the thigh phase angle detection unit 550 performs a rotation center correction process on the hip joint angle ⁇ k to calculate a corrected hip joint angle ⁇ k (step S12). At a stage where the past rocking center is not recognized, in step 12, zero correction (no correction) is made.
- the thigh phase angle detection means 550 uses the state estimator (Kalman filter in the present embodiment) designed for the motion equation of the pendulum motion of the rod-like rigid body 600 which approximates the motion of the leg of the user.
- the estimated hip joint angle ⁇ dot k and the estimated hip joint angular velocity ⁇ dot hat k at k are calculated (step S13).
- the thigh phase angle detection means 550 creates a trajectory diagram based on the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k (step S14), and the vector length of the plot point on the trajectory diagram (plot points and It is determined whether the distance to the origin exceeds the threshold (step S15).
- step S15 If the step S15 is NO, the thigh phase angle detecting means 550 determines that the walking motion is not started, and outputs an actuator operation prohibition signal (step 30). In this case, the actuator operation control mode returns to step S11.
- the thigh phase angle detecting means 550 determines that the walking motion is being performed, and the thigh phase angle is determined based on the estimated hip joint angle ⁇ hat k and the estimated hip joint angular velocity ⁇ dot hat k. It calculates ⁇ k and sends it to the walking motion timing calculating means 560 (step S16).
- the walking motion timing calculation means 560 applies the thigh phase angle ⁇ k from the thigh phase angle detection means 550 to the phase pattern function ⁇ ( ⁇ ) effective at that time to calculate the storage cycle walking motion timing tk And transmits to the auxiliary torque calculating means 570 (step S17). At the same time, the walking motion timing calculation means 560 executes phase pattern function creation processing. The phase pattern function creation process will be described later.
- the assist torque calculation unit 570 applies the storage cycle walking operation timing tk from the walking operation timing calculation unit 560 to the output torque pattern to be stored, and the actuator unit 100 outputs the output torque pattern at this timing (sampling timing k).
- the magnitude and direction of the walking assist power to be obtained are acquired and transmitted to the operation control means 580 (step S18).
- the operation control means 580 controls the operation of the actuator unit 100 so that the walking assistance force of the size and direction calculated by the assistance torque calculation means 570 is output (step S19).
- phase pattern function creation process judges whether the walking motion at the sampling timing k is normal or not, and selects the effective phase angle data to be used in calculating the phase pattern function used in the subsequent walking cycle, and walks The effective phase angle data is used to create a new phase pattern function when the cycle is completed.
- the walking motion timing calculation means 560 calculates the current cycle walking motion timing Tk calculated by (.phi.k / 2.pi.). Times.100 (%) and the storage periodic walking motion calculated in step S17. It is determined whether the difference ⁇ T with the timing tk is less than or equal to a predetermined threshold.
- step S40 determines that the walking motion at the sampling timing k is normal, and the thigh phase angle
- the ⁇ k and the current periodic walking motion timing Tk are stored as phase angle data (step S41).
- step S40 determines that the walking movement at the sampling timing k is abnormal, and the thigh
- the phase angle ⁇ k and the storage cycle walking motion timing tk are stored as phase angle data (step S42).
- the walking motion timing calculation means 560 determines whether or not one walking cycle has ended (step S43), and when one walking cycle ends, phase angle data in the walking cycle and that time are stored A new phase pattern function is calculated using the least squares method based on the effective phase angle data including the phase angle data in the past preserved walking cycle, and is overwritten and stored (step S44). If one walking cycle has not ended, step S44 is bypassed.
- phase pattern function processing By including the phase pattern function processing, it is possible to effectively prevent the data of the abnormal walking motion from being included in the phase pattern function.
- step S20 the control device 500 determines whether the termination signal of the actuator operation control mode is input or not. When the termination signal is not input, the process returns to step S11, and the termination signal is input. Ends the control mode.
- the end signal is input, for example, in response to an operation by the user on an artificial operation member such as an end button.
- the walking motion assistance device 1 grasps the walking motion state (walking motion timing) based on the thigh phase angle ⁇ and applies a walking assistance force suitable for the walking motion state to the lower thigh.
- the present invention is not limited to such a form, the present invention is configured to provide the thigh with a walking assistance force suitable for the walking motion state grasped based on the thigh phase angle ⁇ . Is also possible.
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Epidemiology (AREA)
- Veterinary Medicine (AREA)
- Animal Behavior & Ethology (AREA)
- Biomedical Technology (AREA)
- Medical Informatics (AREA)
- Pain & Pain Management (AREA)
- Rehabilitation Therapy (AREA)
- Physical Education & Sports Medicine (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Primary Health Care (AREA)
- Pathology (AREA)
- Human Computer Interaction (AREA)
- Business, Economics & Management (AREA)
- Data Mining & Analysis (AREA)
- Databases & Information Systems (AREA)
- General Business, Economics & Management (AREA)
- Physiology (AREA)
- Surgery (AREA)
- Molecular Biology (AREA)
- Biophysics (AREA)
- Physics & Mathematics (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Dentistry (AREA)
- Heart & Thoracic Surgery (AREA)
- Rehabilitation Tools (AREA)
- Manipulator (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
本発明の歩行動作補助装置は、ユーザーの大腿及び下腿を含む脚部の股関節回りの動きを棒状剛体の振り子動作で近似し、振り子動作の運動方程式に基づいて算出される大腿の股関節角度及び股関節角速度を、大腿姿勢検出手段から入力される角度関連信号を観測値として用いた状態推定器によって推定し、推定股関節角度及び推定股関節角速度を用いて大腿位相角を算出し、大腿位相角に基づき算出された補助トルク値を出力するように構成されている。
Description
本発明は、歩行動作補助装置に関する。
脚の不自由な人や脳卒中等の為に麻痺を有する人の歩行補助用又はリハビリテーション用の器具として、脚の動きを補助する電動モータ等のアクチュエータが備えられた歩行動作補助装置が提案されている(下記特許文献1~3参照)。
詳しくは、前記特許文献1~3に記載の従来の歩行動作補助装置は、ユーザーの大腿に装着される大腿側装具と、ユーザーの下腿に装着され且つ前記大腿側装具に対してユーザーの膝関節回り回動可能に連結された下腿側装具と、前記大腿側装具に装着され、前記下腿側装具に対して膝関節回りの補助力を付与可能なアクチュエータと、大腿に対する下腿の膝関節回りの回動角度を検出する下腿角度センサと、前記アクチュエータの作動制御を司る制御装置とを備え、前記制御装置が、前記下腿角度センサからの検出信号に基づいて前記アクチュエータの作動制御を実行するように構成されている。
即ち、前記従来の歩行動作補助装置は、前記下腿角度センサによって検出される下腿の膝関節回りの回動角度に基づいて歩行動作状態を認識し、この歩行動作状態に応じた大きさ及び方向の補助力を出力するように前記アクチュエータの作動制御を行うように構成されている。
しかしながら、歩行動作の際には、下腿は膝関節回りに回動動作しつつ、大腿は股関節回りに回動動作する。
即ち、前記従来構成においては、股関節回りに回動する大腿に対する下腿の膝関節回りの回動角度を検出しており、従って、歩行動作状態を正確に認識することが困難であった。
即ち、前記従来構成においては、股関節回りに回動する大腿に対する下腿の膝関節回りの回動角度を検出しており、従って、歩行動作状態を正確に認識することが困難であった。
さらに、ユーザーが脳卒中等の為に麻痺を有する場合、大腿の歩行動作(股関節回りの大腿の前後揺動動作)は比較的正常に行えるものの、下腿の歩行動作(膝関節回りの下腿の前後揺動動作)は正常に行えないことが多い。
このような場合、前記従来の構成では、正常な歩行動作を行えない下腿の動きに基づいて前記アクチュエータの作動制御を行うことになり、この点においても、的確な歩行補助力を提供することができないおそれがあった。
また、下記特許文献4には、股関節の周期的な動作によって規定される大腿位相角に基づいて歩行動作状態を認識し、認識された歩行動作状態に応じた歩行補助力を大腿に対して出力するようにアクチュエータの作動制御を行う歩行補助装置が開示されている。
詳しくは、前記特許文献4に記載の歩行補助装置は、大腿に対して歩行補助力を付与する付与部と、前記付与部の作動制御を行う制御部と、股関節角度及び股関節角速度の少なくとも一方を検出する検出部と、前記検出部の検出結果に基づいて大腿の位相角を算出する算出部とを備え、前記制御部が、前記位相角に基づいて前記付与部の作動制御を行うように構成されている。
ここで、前記特許文献4においては、大腿の位相角は、前記検出部によって検出された股関節角度及び当該股関節角度を微分して得られる股関節角速度に基づいて算出されている。
斯かる構成では、微分処理によって雑音成分が強調されることになり、正確な大腿位相角を得ることは困難となる。
斯かる構成では、微分処理によって雑音成分が強調されることになり、正確な大腿位相角を得ることは困難となる。
この点に関し、前記検出部によって検出された信号に対しローパス処理を行うことによって雑音成分を除去することも可能であるが、この場合には、時間遅れが生じ、前記付与部の作動制御を適切なタイミングで行うことが困難となる。
本発明は、斯かる従来技術に鑑みなされたものであり、歩行周期中の歩行状態に即した適切な歩行補助力を、時間遅れを可及的に防止乃至は低減した状態で付与可能な歩行動作補助装置の提供を、目的とする。
本発明は、前記目的を達成するために、ユーザーの歩行動作に対して補助力を付与するアクチュエータと、サンプリングタイミング毎にユーザーの大腿の前後揺動角度である股関節角度に関連する股関節角度関連信号を検出する大腿姿勢検出手段と、一のサンプリングタイミングkでの大腿位相角を算出する大腿位相角算出手段と、大腿位相角と前記アクチュエータが出力すべきトルク値との関係が直接又は間接的に規定された出力パターンデータを有し、前記大腿位相角算出手段によって算出された大腿位相角を前記出力パターンデータに適用して前記一のサンプリングタイミングkにおいて出力すべきトルク値を算出する補助トルク算出手段と、前記補助トルク算出手段によって算出されたトルク値の補助力を出力するように、前記アクチュエータの作動制御を司る作動制御手段とを備え、前記大腿位相角算出手段は、歩行時におけるユーザーの大腿及び下腿を含む脚部の股関節回りの動きを、先端部に所定質量mの質点が取り付けられた所定長さ?の棒状剛体が基端部を揺動中心として振り子動作する動きで近似し、前記質点の揺動軌跡に沿った円の接線方向における運動方程式に基づいて近似算出される前記大腿の股関節角度及び股関節角速度を、サンプリングタイミングkにおいて前記大腿姿勢検出手段から入力される角度関連信号を観測値として用いた状態推定器によって推定し、この推定股関節角度及び推定股関節角速度を用いてサンプリングタイミングkでの大腿位相角を算出する歩行動作補助装置を提供する。
本発明に係る歩行動作補助装置によれば、ユーザーの大腿及び下腿を含む脚部の股関節回りの動きを棒状剛体の振り子動作で近似し、振り子動作の運動方程式に基づいて算出される大腿の股関節角度及び股関節角速度を、大腿姿勢検出手段から入力される角度関連信号を観測値として用いた状態推定器によって推定し、推定股関節角度及び推定股関節角速度を用いて大腿位相角を算出し、大腿位相角に基づき算出された補助トルク値が出力されるようにアクチュエータの作動制御を行うので、歩行周期中の歩行状態に応じた適切な歩行補助力を、時間遅れを可及的に防止乃至は低減した状態で付与できる。
一形態においては、前記状態推定器はカルマンフィルタとされる。
この場合、前記大腿位相角算出手段は、前記運動方程式に基づく式(1a)及び前記大腿姿勢角検出手段から入力される角度関連信号を観測値とする式(1b)と前記カルマンフィルタによる式(2a)~式(2e)とを用いて、前記推定揺動角度及び前記推定揺動角速度を算出する。
この場合、前記大腿位相角算出手段は、前記運動方程式に基づく式(1a)及び前記大腿姿勢角検出手段から入力される角度関連信号を観測値とする式(1b)と前記カルマンフィルタによる式(2a)~式(2e)とを用いて、前記推定揺動角度及び前記推定揺動角速度を算出する。
但し、式(1a)、式(1b)及び式(2a)~式(2e)における記号は下記の通りであり、式中の右肩記号Tは行列の転置操作を表している。
θ:股関節角度
θドット:股関節角速度
g:重力加速度
μ:歩行時に股関節回りに働く股関節トルク
γ:未知外乱
v:観測雑音
xハット[k|k]:サンプリングタイミングkでの事後推定値
xハット[k|k-1]: サンプリングタイミングkでの事前推定値
K[k]:サンプリングタイミングkでのカルマンゲイン
P[k|k]:サンプリングタイミングkでの事後誤差共分散行列
P[k|k-1]:サンプリングタイミングkでの事前誤差共分散行列
y[k]:サンプリングタイミングkでの大腿姿勢検出手段の観測値(計測値)
C:観測行列
Q:未知外乱γの共分散行列
R:観測雑音vの共分散行列
θドット:股関節角速度
g:重力加速度
μ:歩行時に股関節回りに働く股関節トルク
γ:未知外乱
v:観測雑音
xハット[k|k]:サンプリングタイミングkでの事後推定値
xハット[k|k-1]: サンプリングタイミングkでの事前推定値
K[k]:サンプリングタイミングkでのカルマンゲイン
P[k|k]:サンプリングタイミングkでの事後誤差共分散行列
P[k|k-1]:サンプリングタイミングkでの事前誤差共分散行列
y[k]:サンプリングタイミングkでの大腿姿勢検出手段の観測値(計測値)
C:観測行列
Q:未知外乱γの共分散行列
R:観測雑音vの共分散行列
好ましくは、前記大腿位相角算出手段は、完了している過去の歩行周期における推定股関節角度の揺動中心点と股関節角度ゼロ点との偏差を算出し、現時点の歩行周期中において前記大腿姿勢検出手段から入力される角度関連信号に対して前記偏差に応じた補正を行い、補正後の角度関連信号を前記状態推定器の観測値として用いるように構成される。
本発明に係る歩行動作補助装置は、ユーザーの大腿に装着される大腿側装具と、ユーザーの下腿に装着され且つ前記大腿側装具に対してユーザーの膝関節回り回動可能に連結された下腿側装具とを備え、前記アクチュエータは前記大腿側装具に装着され、前記下腿側装具に対して膝関節回りの補助力を付与可能とされ得る。
以下、本発明に係る歩行動作補助装置の一実施の形態について、添付図面を参照しつつ説明する。
図1及び図2に、それぞれ、本実施の形態に係る歩行動作補助装置1の斜視図及び部分正面図を示す。
また、図3及び図4に、それぞれ、前記歩行動作補助装置1の幅方向外方側及び内方側から視た部分分解斜視図を示す。
図1及び図2に、それぞれ、本実施の形態に係る歩行動作補助装置1の斜視図及び部分正面図を示す。
また、図3及び図4に、それぞれ、前記歩行動作補助装置1の幅方向外方側及び内方側から視た部分分解斜視図を示す。
前記歩行動作補助装置1は、脚の不自由な人や脳卒中等の為に片麻痺を有するユーザーが歩行補助の為、又は、リハビリテーションの為に装着する器具であり、付設されるアクチュエータユニット100によって歩行補助力を付与し得るように構成されている。
本実施の形態に係る歩行動作補助装置1は、前記アクチュエータユニット100による歩行補助力を下腿に付与し得るように構成されている。
詳しくは、図1~図4に示すように、前記歩行動作補助装置1は、ユーザーの大腿に装着される大腿側装具10と、ユーザーの下腿に装着された下腿側装具30と、前記大腿側装具10に装着され、前記下腿側装具30に対して膝関節回りの補助力を付与可能なアクチュエータユニット100とを備えている。
詳しくは、図1~図4に示すように、前記歩行動作補助装置1は、ユーザーの大腿に装着される大腿側装具10と、ユーザーの下腿に装着された下腿側装具30と、前記大腿側装具10に装着され、前記下腿側装具30に対して膝関節回りの補助力を付与可能なアクチュエータユニット100とを備えている。
本実施の形態においては、前記大腿側装具10は、ユーザーの大腿に装着される大腿装着体15と、前記大腿装着体15に連結された大腿フレーム20とを有している。
前記大腿装着体15は、ユーザーの大腿に装着可能とされる限り種々の形態を取り得る。
本実施の形態においては、図1に示すように、前記大腿装着体15は、ユーザーの大腿が挿入可能で且つ大腿にフィットするような大きさの装着孔を有する筒状とされている。
本実施の形態においては、図1に示すように、前記大腿装着体15は、ユーザーの大腿が挿入可能で且つ大腿にフィットするような大きさの装着孔を有する筒状とされている。
図1~図4に示すように、前記大腿フレーム20は、ユーザーの幅方向外方側においてユーザーの大腿に沿って上下に延びる第1大腿フレーム20(1)を有している。
本実施の形態においては、図1~図4に示すように、前記大腿フレーム20は、さらに、前記大腿装着体10に挿入されたユーザーの大腿を挟んで前記第1大腿フレーム20(1)と対向するようにユーザーの幅方向内方側においてユーザーの大腿に沿って上下に延びる第2大腿フレーム20(2)を有している。
本実施の形態においては、前記下腿側装具30は、ユーザーの下腿に装着される下腿装着体35と、前記下腿装着体35に連結された下腿フレーム40とを有している。
前記下腿装着体35は、ユーザーの下腿に装着可能とされる限り種々の形態を取り得る。
本実施の形態においては、図1に示すように、前記下腿装着体35は、ユーザーの下腿が挿入可能で且つ下腿にフィットするような大きさの装着孔を有する筒状とされている。
本実施の形態においては、図1に示すように、前記下腿装着体35は、ユーザーの下腿が挿入可能で且つ下腿にフィットするような大きさの装着孔を有する筒状とされている。
図1~図4に示すように、前記下腿フレーム40は、ユーザーの幅方向外方側においてユーザーの下腿に沿って上下に延びる第1下腿フレーム40(1)を有している。
本実施の形態においては、図1~図4に示すように、前記下腿フレーム40は、さらに、前記下腿装着体30に挿入されたユーザーの下腿を挟んで前記第1下腿フレーム40(1)と対向するようにユーザーの幅方向内方側においてユーザーの下腿に沿って上下に延びる第2下腿フレーム40(2)を有している。
本実施の形態においては、前記下腿側装具30は、さらに、ユーザーが足を載置する足装着体65と、前記足装着体65を支持し且つ前記下腿フレーム40に連結される足フレーム60とを有している。
前記下腿側装具30は、前記大腿側装具10に対してユーザーの膝関節回り回動可能に連結されている。
即ち、前記下腿フレーム40が前記大腿フレーム20に対してユーザーの膝関節の揺動軸線X回り回動可能に連結されている。
即ち、前記下腿フレーム40が前記大腿フレーム20に対してユーザーの膝関節の揺動軸線X回り回動可能に連結されている。
前述の通り、本実施の形態においては、前記大腿フレーム20は前記第1及び第2大腿フレーム20(1)、20(2)を有し、前記下腿フレーム40は第1及び第2下腿フレーム40(1)、40(2)を有している。
従って、前記第1下腿フレーム40(1)が前記第1大腿フレーム20(1)に揺動軸線X回り回動可能に連結され、前記第2下腿フレーム40(2)が前記第2大腿フレーム20(2)に揺動軸線X回り回動可能に連結されている。
図5に、前記大腿フレーム20及び前記下腿フレーム40の分解斜視図を示す。
図5に示すように、前記大腿フレーム20は、上下方向に延びる大腿フレーム本体21と、前記大腿フレーム本体21の下端部を挟むように当該大腿フレーム本体21にピン連結又は溶接等によって固着された一対の連結片22a、22bとを有している。
図5に示すように、前記大腿フレーム20は、上下方向に延びる大腿フレーム本体21と、前記大腿フレーム本体21の下端部を挟むように当該大腿フレーム本体21にピン連結又は溶接等によって固着された一対の連結片22a、22bとを有している。
前記一対の連結片22a、22bは、前記大腿フレーム本体21よりユーザーの脚から離間する側に位置する外側連結片22aと、前記大腿フレーム本体21よりユーザーの脚に近接する側に位置する内側連結片22bとを有している。
前記下腿フレーム40は、前記一対の連結片22a、22bの間に介挿された状態で前記揺動軸線X回り回動可能に前記一対の連結片22a、22bに連結されている。
詳しくは、前記一対の連結片22a、22b及び前記下腿フレーム40の上部には前記揺動軸線Xと同軸上においてユーザー幅方向に沿った取付孔23、43が形成されている。
前記アクチュエータユニット100が装着される側(ユーザーの対応する脚よりユーザー幅方向外方側)に位置する、前記第1大腿フレーム20(1)及び前記第1下腿フレーム40(1)は、第1回動連結具50(1)を介して前記揺動軸線X回り回動可能に連結されている。
前記第1回動連結具50(1)は、前記取付孔23、43内において互いに対して分離可能に連結される第1雌ネジ部材51(1)及び第1雄ネジ部材55(1)を有している。
前記第1雌ネジ部材51(1)は、前記内側連結片22bの側から前記取付孔23に挿入される筒部52と、前記取付孔23よりユーザーの脚に近接する位置において前記筒部52から径方向外方へ延在されるフランジ部53とを有しており、前記筒部52には自由端側に開くネジ穴が形成されている。
前記第1雄ネジ部材55(1)は、前記外側連結片22aの側から前記取付孔23内に挿入される筒部56と、前記取付孔23よりユーザーの脚から離間する位置において前記筒部56から延在された係合凸部57とを有している。
前記第1雄ネジ部材55(1)の筒部56には、前記取付孔23、43内において前記第1雌ネジ部材51(1)の前記ネジ穴に螺入される雄ネジが形成されている。
前記第1雄ネジ部材55(1)に形成された雄ネジ及び前記第1雌ネジ部材51(1)の雌ネジを、前記取付孔23、43内で螺入させることによって、前記第1下腿フレーム40(1)が前記第1大腿フレーム20(1)に対して揺動可能に連結される。
ユーザーの対応する脚よりユーザー幅方向内方側に位置する、前記第2大腿フレーム20(2)及び前記第2下腿フレーム40(2)は、第2回動連結具50(2)を介して前記揺動軸線X回り回動可能に連結されている。
前記第2回動連結具50(2)は、前記取付孔内23、43において互いに対して分離可能に連結される第2雌ネジ部材51(2)及び第2雄ネジ部材55(2)を有している。
前記第2雌ネジ部材51(2)は、前記第1雌ネジ部材51(1)と同一構成を有している。
前記第2雄ネジ部材55(2)は、前記外側連結片22aの側から前記取付孔23内に挿入される筒部56と、前記取付孔23よりユーザー幅方向内方側において前記筒部56から径方向外方へ延在されたフランジ部58とを有している。
前記第2雄ネジ部材55(2)の筒部56には、前記取付孔23、43内において前記第2雌ネジ部材51(2)の前記ネジ穴に螺入される雄ネジが形成されている。
前記第2雄ネジ部材55(2)に形成された雄ネジ及び前記第2雌ネジ部材51(2)の雌ネジを、前記取付孔23、43内で螺入させることによって、前記第2下腿フレーム40(2)が前記第2大腿フレーム20(2)に対して揺動可能に連結される。
なお、図5の符号53aは、前記フランジ部53に設けられた径方向外方突起であり、前記内側連結片22bに形成された凹部に係合することで、前記雌ねじ部材51が前記内側連結片22b(即ち、前記大腿フレーム20)に対して軸線回り相対回転不能に保持されるようになっている。
本実施の形態においては、前記歩行動作補助装置1は、図1~図4に示すように、さらに、前記下腿フレーム40の前記大腿フレーム20に対する揺動軸線X回りの回動を禁止する為のロック部材70を有している。
前記ロック部材70は、前記大腿フレーム20及び前記下腿フレーム40を囲繞して両フレーム20、40を連結し、前記下腿フレーム40が前記大腿フレーム20に対して前記揺動軸線X回りに相対回転することを防止するロック状態示す状態(図1~図4に示す状態)と、前記大腿フレーム20及び前記下腿フレーム40の連結を解除し、前記下腿フレーム40が前記大腿フレーム20に対して前記揺動軸線X回りに相対回転することを許容する解除状態とを取り得るように構成されている。
なお、本実施の形態においては、前記ロック部材70は、前記第1大腿フレーム20(1)及び前記第1下腿フレーム40(1)に作用するユーザー幅方向外側に位置する第1ロック部材70(1)と、前記第2大腿フレーム20(2)及び前記第2下腿フレーム40(2)に作用するユーザー幅方向内側に位置する第2ロック部材70(2)とを有している。
また、本実施の形態においては、図5に示すように、前記下腿フレーム40の上端面45(前記大腿フレーム20に対向する端面)は前記揺動軸線X回り一方側から他方側へ行くに従って前記揺動軸線Xからの径方向距離が増大するような傾斜面とされており、前記大腿フレーム20の下端面25(前記下腿フレーム40に対向する端面)は前記下腿フレーム40の上端面45に対応した傾斜面とされている。
斯かる構成により、前記下腿フレーム40は、前記大腿フレーム20に対して前記揺動軸線X回り一方側(ユーザーの下腿が大腿に対して屈曲する方向)へのみ回動が許容され、他方側へは、下腿が大腿に対して伸展することを許容しつつそれ以上は回動しないようになっている。
図6に、前記アクチュエータユニット100の部分縦断面図を示す。
図1~図4及び図6に示すように、前記アクチュエータユニット100は、上部フレーム120と、前記上部フレーム120に枢支軸線Y回り回動可能に連結された下部フレーム340と、前記下部フレーム340を枢支軸線Y回りに回動させる為の駆動力を発生する電動モータ等の駆動体110と、前記上部フレーム340を前記大腿フレーム20に連結させる上部連結体360と、前記枢支軸線Yを前記揺動軸線Xと同軸上に位置させる回動中心連結体180と、下部連結体370とを備えている。
図1~図4及び図6に示すように、前記アクチュエータユニット100は、上部フレーム120と、前記上部フレーム120に枢支軸線Y回り回動可能に連結された下部フレーム340と、前記下部フレーム340を枢支軸線Y回りに回動させる為の駆動力を発生する電動モータ等の駆動体110と、前記上部フレーム340を前記大腿フレーム20に連結させる上部連結体360と、前記枢支軸線Yを前記揺動軸線Xと同軸上に位置させる回動中心連結体180と、下部連結体370とを備えている。
前記上部フレーム120及び前記下部フレーム340には、それぞれ、前記枢支軸線Yと同軸上に配置された上部フレーム取付孔120a及び下部フレーム取付孔140aが設けられている。
前記下部フレーム取付孔140aには回動連結軸151が固着されており、前記回動連結軸151が軸受部材155を介して前記上部フレーム取付孔120aに軸線回り回動可能に支持されており、これにより、前記下部フレーム340が前記上部フレーム120に前記枢支軸線Y回り回動可能に連結されている。
前記駆動体110は、電動モータ等の駆動源111と、前記駆動源111によって発生された駆動力を前記下部フレーム340に伝達する伝動機構115とを有している。
前記駆動源111は前記上部フレーム120の外側面に固着されている。
本実施の形態においては、図6に示すように、前記駆動源111は、出力軸111aが下方へ延在された状態で前記上部フレーム120の外側面に固着されている。
本実施の形態においては、図6に示すように、前記駆動源111は、出力軸111aが下方へ延在された状態で前記上部フレーム120の外側面に固着されている。
本実施の形態においては、図6に示すように、前記伝動機構115は、前記出力軸111aに相対回転不能に支持された駆動側ベベルギヤ116と、前記枢支軸線Y回りに前記下部フレーム340と一体的に回転するように前記下部フレーム340に連結された状態で前記駆動側ベベルギヤ116に噛合された従動側ベベルギヤ117とを備えている。
なお、前記アクチュエータユニット100は、前記回動連結軸151の軸線回りの回転角度を検出するセンサ(図示せず)を有することができ、前記センサによって前記回動連結軸151の軸線回りの回転角度を検出して、前記下部フレーム340の前記枢支軸線Y回りの揺動角度を認識することができる。
図3及び図4に示すように、前記上部連結体360は、枢支軸線Yに平行で且つユーザー幅方向外方(前記上部フレーム120の方向)に開くように前記第1大腿フレーム20(1)に設けられた係合孔361と、前記係合孔361に係合可能なように前記上部フレーム120に設けられた係合ピン362とを有している。
本実施の形態においては、前記上部連結体360には、ロック機構が備えられている。
前記ロック機構は、図4に示すように、前記係合ピン362の外表面から径方向に沿って進退自在とされ、前記係合ピンの外表面から径方向外方へ突出された係合位置及び前記係合ピン内に退避された解除位置を取り得る凸部366と、前記凸部366を係合位置へ向けて付勢する付勢部材(図示せず)と、前記係合ピン362が前記係合孔361に係入された状態において前記凸部366と係合するように前記係合孔に設けられた凹部(図示せず)と、外部からの人為操作に応じて前記付勢部材の付勢力に抗して前記凸部366を解除位置へ押動する解除操作部367とを有している。
前記ロック機構は、図4に示すように、前記係合ピン362の外表面から径方向に沿って進退自在とされ、前記係合ピンの外表面から径方向外方へ突出された係合位置及び前記係合ピン内に退避された解除位置を取り得る凸部366と、前記凸部366を係合位置へ向けて付勢する付勢部材(図示せず)と、前記係合ピン362が前記係合孔361に係入された状態において前記凸部366と係合するように前記係合孔に設けられた凹部(図示せず)と、外部からの人為操作に応じて前記付勢部材の付勢力に抗して前記凸部366を解除位置へ押動する解除操作部367とを有している。
図4及び図6に示すように、前記回動中心連結体180は、前記揺動軸線Xと同軸上に位置するように前記第1大腿フレーム20(1)又は前記第1下腿フレーム40(1)に設けられた装具側回動中心連結部材と、前記枢支軸線Yと同軸上に位置するように前記上部フレーム120又は前記下部フレーム340に設けられたアクチュエータ側回動中心連結部材185とを有している。
本実施の形態においては、前記第1回動連結具50(1)における前記係合凸部27が前記装具側回動中心連結部材として作用する。
前記アクチュエータ側回動中心連結部材185は、前記装具側回動中心連結部材(本実施の形態においては前記係合凸部57)に着脱可能に凹凸係合するアクチュエータ側凹凸係合部185aを有している。
本実施の形態においては、図6に示すように、前記上部フレーム120に、前記装具側回動中心連結部材(本実施の形態においては前記係合凸部57)が着脱可能且つ軸線回り回動可能に係入される係合凹部が形成されており、前記係合凹部が前記アクチュエータ側凹凸係合部185aとして作用する。
図3、図4及び図6に示すように、前記下部連結体370は、前記下部フレーム340が前記上部フレーム120に対して枢支軸線Y回りに回動する動きに応じて前記第1下腿フレーム40(1)が前記第1大腿フレーム20(1)に対して揺動軸線X回りに回動するように、前記下部フレーム340を前記第1下腿フレーム40(1)に連結させる。
詳しくは、図6に示すように、前記下部フレーム340は、前記回動連結軸151を介して前記上部フレーム120に枢支軸線Y回り回動可能に連結される基端部341と、前記基端部341から前記第1下腿フレーム40(1)に近接する側へ延びる先端部345とを有している。
図6等に示すように、本実施の形態においては、前記基端部341は、前記従動側ベベルギヤ117を枢支軸線Y回りに一体回転するように支持しており、これにより、前記駆動体110からの回転動力によって前記従動側ベベルギヤ117及び前記基端部341が枢支軸線Y回りに一体回動する。
本実施の形態においては、前記基端部341は略垂直に沿った平板状とされている。
本実施の形態においては、前記基端部341は略垂直に沿った平板状とされている。
図4及び図6に示すように、前記先端部345は、先端面346が前記第1下腿フレーム40(1)におけるユーザー幅方向外方を向く外側面と対向する対向面を形成している。
前記先端面346は、前記第1下腿フレーム40(1)の幅方向(即ち、ユーザー前後方向)に対応した幅方向Dに関し所定長さを有している。
本実施の形態においては、前記先端部345は略水平に沿った平板状とされており、先端面346は略矩形とされている。
前記先端面346は、前記第1下腿フレーム40(1)の幅方向(即ち、ユーザー前後方向)に対応した幅方向Dに関し所定長さを有している。
本実施の形態においては、前記先端部345は略水平に沿った平板状とされており、先端面346は略矩形とされている。
図4及び図6に示すように、前記下部連結体370は、前記先端部345に形成された支持孔371と、前記支持孔371に進退自在に収容された係合ピン372と、前記係合ピン372を付勢する付勢ばね373と、前記先端部345に設けられた係合アーム375とを有している。
前記支持孔371は、前記対向面の幅方向中間領域において前記対向面に開き且つ前記第1下腿フレーム40(1)の外側面に対して略直交する方向に延びている。
前記係合ピン372は、先端が前記対向面から突出された突出位置及び前記突出位置より前記第1下腿フレーム40(1)から離間するように前記支持孔371に入り込んだ退避位置を取り得るように、前記支持孔371に軸線方向移動可能に収容されている。
前記付勢ばね373は、前記係合ピン371を突出位置へ向けて付勢する。
本実施の形態においては、前記付勢ばね373は、前記係合ピン371の基端部と前記支持孔371の底面との間に介挿されている。
本実施の形態においては、前記付勢ばね373は、前記係合ピン371の基端部と前記支持孔371の底面との間に介挿されている。
詳しくは、本実施の形態においては、前記支持孔371は、一端側が前記対向面に開き且つ他端側が前記対向面とは反対側の裏面に開くように前記先端部345に形成されており、前記支持孔371の他端側は前記先端部345の裏面に固着される閉塞プレート348によって閉じられている。この場合、前記閉塞プレート348が前記支持孔371の底面を形成する。
前記係合アーム375は、前記対向面から前記第1下腿フレーム40(1)に近接する側へ枢支軸線Yに沿って延びる軸方向延在部376を有している。
前記軸方向延在部376は、前記第1下腿フレーム40(1)が前記下部フレーム340の幅方向に関し前記軸方向延在部376及び前記係合ピン372の間に配置可能なように、前記係合ピン372との間の幅方向離間距離が設定されている。
前記軸方向延在部376は、前記第1下腿フレーム40(1)が前記下部フレーム340の幅方向に関し前記軸方向延在部376及び前記係合ピン372の間に配置可能なように、前記係合ピン372との間の幅方向離間距離が設定されている。
即ち、前記第1下腿フレーム40(1)がユーザー前後方向に関し前記係合ピン372及び前記軸方向延在部376の間に位置し得るように、前記係合ピン372及び前記軸方向延在部376の間の幅方向離間距離が前記第1下腿フレーム40(1)の幅よりも大とされている。
ここで、前記下部連結体370による前記下部フレーム340の前記第1下腿フレーム40(1)への装着動作について説明する。
図7に、図2におけるVII-VII線に沿った端面図を示す。
図7に、図2におけるVII-VII線に沿った端面図を示す。
前記下部フレーム340を前記第1下腿フレーム40(1)に前記下部連結体370によって連結させる際には、まず、前記係合ピン372を前記付勢ばね373の付勢力に抗して退避位置に位置させつつ、前記第1下腿フレーム40(1)が枢支軸線Yに沿った方向に関し前記軸方向延在部376と重合する位置まで前記アクチュエータユニット100を枢支軸線Y方向に相対移動させる。
この際、好ましくは、前記係合ピン372の退避位置への移動を前記第1下腿フレーム40(1)の外側面を介して行うことができる。
即ち、前記第1下腿フレーム40(1)の外側面を前記係合ピン372に当接させた状態で前記係合ピン372が突出位置から退避位置へ移動するように、前記アクチュエータユニット100を前記第1下腿フレーム40(1)に対して近接方向へ相対移動させることができる。
この状態を図7に破線で示す。
即ち、前記第1下腿フレーム40(1)の外側面を前記係合ピン372に当接させた状態で前記係合ピン372が突出位置から退避位置へ移動するように、前記アクチュエータユニット100を前記第1下腿フレーム40(1)に対して近接方向へ相対移動させることができる。
この状態を図7に破線で示す。
図7において破線で示された状態から、前記下部フレーム340を枢支軸線Y回り連結方向(図7においては時計回り方向)に回動させると、前記係合ピン372と前記第1下腿フレーム40(1)との当接が解除されて、前記係合ピン372が前記付勢ばね373の付勢力によって退避位置から突出位置に位置される。
これにより、前記第1下腿フレーム40(1)は、前記下部フレーム340の幅方向(ユーザー前後方向)に関し前記係合ピン372及び前記軸方向延在部376によって挟まれることになり(図7の実線参照)、前記下部フレーム340が前記第1下腿フレーム40(1)に対してフレーム長手方向へは相対移動可能な状態で、前記下部フレーム340の前記上部フレーム120に対する前記枢支軸線Y回りの回動動作に連動して前記第1下腿フレーム40(1)を前記大腿フレーム20に対して前記揺動軸線X回りに回動させる連動状態が現出される。
なお、装着時とは逆の操作を行うことによって、前記下部連結体370によって前記第1下腿フレーム40(1)に連結されている前記下部フレーム340を取り外すことができる。
即ち、前記下部連結体370によって前記下部フレーム340が前記第1下腿フレーム40(1)に連結されている際には、前記係合ピン372は前記付勢ばね373の付勢力によって突出位置に位置されている。
即ち、前記下部連結体370によって前記下部フレーム340が前記第1下腿フレーム40(1)に連結されている際には、前記係合ピン372は前記付勢ばね373の付勢力によって突出位置に位置されている。
この突出位置の前記係合ピン372を人為操作力によって前記付勢ばね373の付勢力に抗して退避位置まで押動しつつ、前記下部フレーム340を枢支軸線Y回り解除方向(図7においては反時計回り方向)に回動させて、前記係合ピン372の先端部が前記第1下腿フレーム40(1)の外側面に当接する状態(図7の破線の状態)を現出させる。
その後に、前記第1下腿フレーム40(1)及び前記下部フレーム340を互いに対して離間する方向へ相対移動させることによって、前記下部フレーム340を前記第1下腿フレーム40(1)から取り外すことができる。
好ましくは、前記係合アーム375は、前記軸方向延在部376から前記対向面の幅方向Wに関し前記係合ピン372に近接する方向へ延び、前記下部フレーム340が前記第1下腿フレーム40(1)に連結された状態において前記第1下腿フレーム40(1)の内側面(ユーザー幅方向に関し内側を向く側面)と対向する幅方向延在部377を含むものとされる。
前記幅方向延在部377は、前記第1下腿フレーム40(1)が前記係合ピン372、前記対向面を形成する前記先端面346、前記軸方向延在部376及び前記幅方向延在部377によって囲まれる保持空間370S(図4参照)内に配置可能なように、前記先端面346との間の軸方向離間距離が前記第1下腿フレーム40(1)の厚みよりも大となるように構成される。
前記係合アーム375に前記幅方向延在部377を備えることによって、前記下部フレーム340が前記下部連結体370によって前記第1下腿フレーム40(1)に連結されている状態において、前記下部フレーム340及び前記第1下腿フレーム40(1)が枢支軸線Y方向に沿って離間する方向へ相対移動することを有効に防止することができ、これにより、前記下部フレーム340が意に反して前記第1下腿フレーム40(1)から脱離することを有効に防止することができる。
本実施の形態においては、前記係合アーム375は、前記対向面の幅方向一方側及び他方側にそれぞれ設けられた第1及び第2係合アーム375(1)、375(2)を有しており、図7の破線で示す状態から前記下部フレーム340を枢支軸線Y回りに何れの方向に回動させても、前記下部フレーム340を前記第1下腿フレーム40(1)に連結させ得るようになっている。
また、本実施の形態においては、図7に示すように、揺動軸線Xが前記第1下腿フレーム40(1)の幅方向(ユーザー前後方向)の中心に対して、前記第1下腿フレーム40(1)の幅方向(ユーザー前後方向)一方側に偏位されている。図7においては、揺動軸線Xは前記第1下腿フレーム40(1)の幅方向中心に対して、ユーザー前後方向に関し後方へ偏位されている。
このような場合には、前記係合ピン372を前記下部フレーム40の幅方向(ユーザー前後方向)の中央に配置させると共に、前記係合アーム375が、前記係合ピン372を挟んで前記下部フレーム40の幅方向一方側及び他方側(ユーザー前後方向に関し前方側及び後方側)に位置する前記第1及び第2係合アーム375(1)、375(2)を有するように構成することで、前記アクチュエータユニット100を歩行動作補助装置1の左足側及び右足側の何れにも装着させることができる。
即ち、前記歩行動作補助装置1の左足側に前記アクチュエータユニット100を装着させる場合には、前記係合ピン372と前記第1係合アーム375(1)とによって前記第1下腿フレーム40(1)を挟む一方、前記歩行動作補助装置1の右足側に前記アクチュエータユニット100を装着させる場合には、前記係合ピン372と前記第2係合アーム375(2)とによって前記第1下腿フレーム40(1)を挟むことができる。
なお、本実施の形態においては、図7に示すように、前記アクチュエータユニット100は、前記係合ピン372とユーザー前後方向に関し前方に位置する前記第1係合アーム375(1)とによって前記第1下腿フレーム40(1)を挟むように装着されているが、前記第1下腿フレーム40(1)を前記第1大腿フレーム20(1)に対して回動させる回動角度を広げたい場合には、前記アクチュエータユニット100を、前記係合ピン372とユーザー前後方向に関し後方に位置する前記第2係合アーム375(2)とによって前記第1下腿フレーム40(1)を挟むように装着させることができる。
即ち、前記係合ピン372とユーザー前後方向に関し前方に位置する前記第1係合アーム375(1)とによって前記第1下腿フレーム40(1)を挟むと、前記下部フレーム340の初期姿勢(前記アクチュエータユニット100を装着した状態でユーザーが略直立姿勢と取る際の前記下部フレーム340の姿勢であり、図7の実線で示す姿勢)が、ユーザー幅方向内方から視た際に、水平姿勢(図7の破線で示す姿勢)から枢支軸線Y回りに時計回り方向へ所定角度αだけ回転された姿勢をとることになる。
ここで、前記アクチュエータユニット100付きの歩行動作補助装置1をユーザーが左脚に装着して歩行する際の左脚の動きを考えると、下腿が大腿に対して屈曲される動きを行う際には前記第1下腿フレーム40(1)はユーザー幅方向内方から視た状態において前記第1大腿フレーム20(1)に対して時計回り方向へ回動することになる。
従って、前記アクチュエータユニット100を前記歩行動作補助装置1に装着させた状態の初期姿勢において、ユーザー幅方向内方から視た際に、前記下部フレーム340が水平姿勢(図7の破線で示す姿勢)から枢支軸線Y回りに時計回り方向へ所定角度αだけ回転されているとすると、ユーザーが膝を曲げる動作をアシストすべく下腿を大腿に対して屈曲方向へ押動できる範囲、つまり、前記下部フレーム340を、ユーザー幅方向内方から視た際に枢支軸線Y回り時計回り方向へ回動できる回動範囲が、水平姿勢を基準にして前記所定角度α分だけ狭まることになる。
これに対し、前記係合ピン372とユーザー前後方向に関し後方に位置する前記第2係合アーム375(2)とによって前記第1下腿フレーム40(1)を挟むように、前記アクチュエータユニット100を装着させれば、前記下部フレーム340は、初期姿勢(ユーザーが略直立状態となる姿勢)において、ユーザー幅方向内方から視た際に、水平姿勢(図7の破線で示す姿勢)から枢支軸線Y回りに反時計回り方向へ所定角度αだけ回転された姿勢をとることになる。
従って、ユーザーの歩行動作をアシストすべく膝を曲げる方向へ押動力を付加できる範囲、つまり、前記下部フレーム340をユーザー幅方向内方から視た際に枢支軸線Y回り時計回り方向へ回動できる回動範囲を、水平姿勢を基準にして前記所定角度α分だけ広げることができる。
ここで、本実施の形態に係る歩行動作補助装置1の制御構造について説明する。
本実施の形態に係る歩行動作補助装置1は、大腿位相角に基づいて歩行周期中の歩行状態を認識し、当該歩行状態に適した歩行補助力が付与されるように前記アクチュエータユニット100の作動制御を行う。
本実施の形態に係る歩行動作補助装置1は、大腿位相角に基づいて歩行周期中の歩行状態を認識し、当該歩行状態に適した歩行補助力が付与されるように前記アクチュエータユニット100の作動制御を行う。
前述の通り、本実施の形態においては、前記アクチュエータユニット100は下腿に対して歩行補助力を付与する。
即ち、本実施の形態に係る歩行動作補助装置1は、制御対象部位である下腿とは異なる大腿の動きを検出し、この大腿の動きに基づいて制御対象部位である下腿に対して歩行補助力を付与する前記アクチュエータユニット100の作動制御を行うように構成されている。
即ち、本実施の形態に係る歩行動作補助装置1は、制御対象部位である下腿とは異なる大腿の動きを検出し、この大腿の動きに基づいて制御対象部位である下腿に対して歩行補助力を付与する前記アクチュエータユニット100の作動制御を行うように構成されている。
図8に、前記歩行動作補助装置1の制御ブロック図を示す。
図8に示すように、前記歩行動作補助装置1は、ユーザーの大腿の前後揺動角度である股関節角度に関連する角度関連信号を検出可能な大腿姿勢検出手段510と、前記角度関連信号に基づいて大腿位相角φを算出する大腿位相角算出手段550と、前記大腿位相角φを歩行周期中の歩行状態(歩行動作タイミング)に変換する歩行動作タイミング算出手段560と、前記歩行動作タイミングにおいて出力すべきトルク値を算出する補助トルク算出手段570と、前記アクチュエータユニット100(前記駆動体110)の作動制御を司る作動制御手段580とを備えている。
図8に示すように、前記歩行動作補助装置1は、ユーザーの大腿の前後揺動角度である股関節角度に関連する角度関連信号を検出可能な大腿姿勢検出手段510と、前記角度関連信号に基づいて大腿位相角φを算出する大腿位相角算出手段550と、前記大腿位相角φを歩行周期中の歩行状態(歩行動作タイミング)に変換する歩行動作タイミング算出手段560と、前記歩行動作タイミングにおいて出力すべきトルク値を算出する補助トルク算出手段570と、前記アクチュエータユニット100(前記駆動体110)の作動制御を司る作動制御手段580とを備えている。
図1に示すように、本実施の形態に係る前記歩行動作補助装置1は制御装置500を備えている。
本実施の形態においては、図8に示すように、前記制御装置500が、前記大腿位相角算出手段550、前記歩行動作タイミング算出手段560、前記補助トルク算出手段570及び前記作動制御手段580として作用する。
本実施の形態においては、図8に示すように、前記制御装置500が、前記大腿位相角算出手段550、前記歩行動作タイミング算出手段560、前記補助トルク算出手段570及び前記作動制御手段580として作用する。
前記制御装置500は、前記大腿姿勢検出手段510や人為操作部材等から入力される信号に基づいて演算処理を実行する制御演算手段を含む演算部と、制御プログラムや制御データ等を記憶するROM,設定値等を電源を切っても失われない状態で保存し且つ前記設定値等が書き換え可能とされた不揮発性記憶手段及び前記演算部による演算中に生成されるデータを一時的に保持するRAM等を含む記憶部とを有するものとされる。
前記大腿姿勢検出手段510は、一歩行周期中において、予め定められた所定サンプリングタイミング毎に前記角度関連信号を検出する。
前記大腿姿勢検出手段510は、大腿の前後揺動角度(股関節角度)を直接又は間接的に検出し得る限り、ジャイロセンサ、加速度センサ、ロータリーエンコーダ等の種々の形態を有し得る。
本実施の形態に係る前記歩行動作補助装置1においては、前記大腿姿勢検出手段510は、大腿の前後揺動角速度を検出可能な3軸角速度センサ(ジャイロセンサ)511を有するものとされている。
なお、本実施の形態に係る歩行動作補助装置1は、3軸加速度センサ515を有しており、前記大腿位相角算出手段550は、静止時に前記3軸加速度センサ515によって検出される鉛直軸Zを股関節角度(大腿の前後揺動角度)の基準軸として用いるように構成されている。
図9(a)に、歩行時におけるユーザーの大腿及び下腿を含む脚部の股関節回りの動きを模式的に表す模式側面図を示す。
本実施の形態においては、前記大腿位相角算出手段550は、歩行時におけるユーザーの大腿及び下腿を含む脚部の股関節回りの動きを、図9(b)に示すような、先端部に所定質量mの質点Mが取り付けられた所定長さ?の棒状剛体600が基端部を揺動中心610として振り子動作する動きで近似しており、この振り子動作の運動方程式に対して設計された状態推定器を用いて一のサンプリングタイミングkでの推定股関節角度θハット及び推定股関節角速度θドットハットを得るように構成されている。
なお、m及び?は、実験等によってユーザー毎に設定され、棒状剛体600の質量は0とする。
なお、m及び?は、実験等によってユーザー毎に設定され、棒状剛体600の質量は0とする。
詳しくは、前記質点Mの揺動軌跡に沿った円Qの接線方向に関する前記質点Mを伴った棒状剛体600の運動方程式は、式(8)となる。
式(8)において、θ(t)は揺動中心を通る鉛直軸に対する棒状剛体600の揺動角によって表される、ユーザーの大腿の前後揺動角度である股関節角度である。
また、gは重力加速度で、μは粘性摩擦に起因する棒状剛体の揺動中心回りの摩擦力に起因する粘性摩擦係数であり、γはユーザーの股関節トルクも含む未知外乱である。
また、gは重力加速度で、μは粘性摩擦に起因する棒状剛体の揺動中心回りの摩擦力に起因する粘性摩擦係数であり、γはユーザーの股関節トルクも含む未知外乱である。
ここで、θ(t)は比較的小さな揺動範囲に収まるものとすると、sinθ(t)θ(t)の近似が成立し、この近似を適用し、かつ、前記質点Mの揺動角及び揺動角速度で近似されるユーザーの股関節角θ及び股関節角速度θドットを下記式(9a)のベクトルとしてまとめ、これを用いて式(8)を書き直すと下記式(9b)となる。
式(9b)をベクトルx(t)(式(9a)参照)を用いて書き換えると、式(10a)及び式(10b)となる。
但し、式(10a)中の係数A及びGは以下の通りである。
式(10a)及び式(10b)を離散時間表現(サンプリングタイミングk)で表記すると、式(1a)及び式(1b)となる。
式(1a)及び式(1b)における[ ]内は、サンプリングタイミングを示している。
即ち、x[k+1]は、サンプリングタイミングk+1でのxの値を意味し、x[k]は、サンプリングタイミングkでのxの値を意味し、γ[k]は、サンプリングタイミングkでの未知外乱の値を意味し、v[k]は、サンプリングタイミングkでの観測雑音の値を意味している。
即ち、x[k+1]は、サンプリングタイミングk+1でのxの値を意味し、x[k]は、サンプリングタイミングkでのxの値を意味し、γ[k]は、サンプリングタイミングkでの未知外乱の値を意味し、v[k]は、サンプリングタイミングkでの観測雑音の値を意味している。
また、式(1a)中のF及びGdは、それぞれ、以下の通りである。
なお、式(1a)において、股関節に作用するユーザーの筋力トルクは未知量として、未知外乱γに含めている。
なお、式(1a)において、股関節に作用するユーザーの筋力トルクは未知量として、未知外乱γに含めている。
本実施の形態においては、前記大腿位相角算出手段550は、状態推定器としてカルマンフィルタを用いている。
カルマンフィルタによる推定式は、式(2a)から式(2e)によって表される。
カルマンフィルタによる推定式は、式(2a)から式(2e)によって表される。
なお、式(2a)~式(2e)の記号は以下の通りである。また、式中の右肩記号Tは行列の転置操作を表している。
xハット[k|k]:サンプリングタイミングkでの事後推定値
xハット[k|k-1]: サンプリングタイミングkでの事前推定値
K[k]:サンプリングタイミングkでのカルマンゲイン
P[k|k]:サンプリングタイミングkでの事後誤差共分散行列
P[k|k-1]:サンプリングタイミングkでの事前誤差共分散行列
y[k]:サンプリングタイミングkでの大腿姿勢検出手段の観測値(計測値)
C:観測行列
Q:未知外乱γの共分散行列
R:観測雑音vの共分散行列
xハット[k|k]:サンプリングタイミングkでの事後推定値
xハット[k|k-1]: サンプリングタイミングkでの事前推定値
K[k]:サンプリングタイミングkでのカルマンゲイン
P[k|k]:サンプリングタイミングkでの事後誤差共分散行列
P[k|k-1]:サンプリングタイミングkでの事前誤差共分散行列
y[k]:サンプリングタイミングkでの大腿姿勢検出手段の観測値(計測値)
C:観測行列
Q:未知外乱γの共分散行列
R:観測雑音vの共分散行列
ここで、前記大腿位相角算出手段550は、サンプリングタイミング毎に、推定誤差及び観測誤差の大きさに応じてカルマンゲインを算出する。
即ち、前記大腿位相角算出手段550は、サンプリングタイミング毎に、推定誤差及び観測誤差の共分散を最小とする値を式(2c)、式(2d)および式(2e)により算出し、この値をそのサンプリングタイミングでのカルマンゲインK[k]として用いる。
即ち、前記大腿位相角算出手段550は、サンプリングタイミング毎に、推定誤差及び観測誤差の共分散を最小とする値を式(2c)、式(2d)および式(2e)により算出し、この値をそのサンプリングタイミングでのカルマンゲインK[k]として用いる。
なお、前記カルマンフィルタは、式(2a)~式(2e)によって推定股関節角度と推定股関節角速度を算出し、その際、サンプリングタイミングkにおけるカルマンゲインK[k]は、毎サンプリングタイミングにおいて式(2c)~式(2e)によって計算されるが、サンプリングタイミング毎にカルマンゲインK[k]を算出する代わりに、下記式(11a)及び式(11b)によって簡易的に事前に計算された値Kによって代用することもできる。すなわち、K[k]=Kとして使用する。
前記大腿位相角算出手段550は、式(1a)を用いて、一のサンプリングタイミングkでのベクトル値x[k]を元にした一つ先のサンプリングタイミングk+1でのベクトル値x[k+1]を予測する(以下、予測値という)。
前記大腿位相角算出手段550は、サンプリングタイミングkにおいて算出した最適なカルマンゲインK[k]、又は、定常カルマンゲインK を知得した上で、一つ前のサンプリングタイミングk-1の時点において式(2a)によって算出しておいた一つ先のサンプリングタイミングの予測値を、サンプリングタイミングkでの事前推定値xハット[k|k-1]として用い、式(2b)によって当該サンプリングタイミングkでの事後推定値xハット[k|k]を算出する。
前記大腿位相角算出手段550は、事後推定値xハット[k|k]に含まれる推定股関節角度θハット及び推定股関節角速度θドットハットを用いて、サンプリングタイミングkでの大腿位相角φ(k)(=-Arctan(θドットハット(k)/θハット(k))を算出する。
斯かる構成によれば、下記効果を得ることができる。
即ち、ジャイロセンサ等によって検出された股関節角度に対して微分処理及びローパス処理を実行することによって、一のサンプリングタイミングでの股関節角度及び股関節角速度を得て、この股関節角度及び股関節角速度に基づき大腿位相角を算出することも可能である(以下、比較構成という)。
即ち、ジャイロセンサ等によって検出された股関節角度に対して微分処理及びローパス処理を実行することによって、一のサンプリングタイミングでの股関節角度及び股関節角速度を得て、この股関節角度及び股関節角速度に基づき大腿位相角を算出することも可能である(以下、比較構成という)。
しかしながら、前記比較構成においては、微分処理によって雑音成分が強調されると共に、ローパス処理を行うことによる時間遅れも生じることになる。
これに対し、本実施の形態においては、前述の通り、歩行時におけるユーザーの脚部の動きを棒状剛体600の振り子動作で近似し、この振り子動作の運動方程式に対して設計された状態推定器を用いてサンプリングタイミングkでの推定股関節角度θハット及び推定股関節角速度θドットハットを得ているので、微分処理に起因する雑音成分の強調、及び、ローパス処理に起因する時間遅れを有効に防止乃至は低減しつつ、推定股関節角度θハット及び推定股関節角速度θドットハットを得ることができる。
なお、本実施の形態においては、状態推定器としてカルマンフィルタを用いているが、これに代えて、オブザーバ等の他の状態推定器を用いることも可能である。
図8に示すように、本実施の形態においては、前記大腿位相角算出手段550は、前記大腿姿勢検出手段510からの股関節角度関連信号に対して回転中心補正を行い、補正後の股関節角度関連信号を用いて、推定股関節角度θハット及び推定股関節角速度θドットハットを算出するように構成されている。
具体的には、前記大腿位相角算出手段550は、完了している過去の歩行周期における推定股関節角度θハットの揺動中心点を算出し、股関節角度ゼロ点に対する前記揺動中心点の偏差を算出する。
その上で、前記大腿位相角算出手段550は、現時点の歩行周期中において前記大腿姿勢検出手段510から入力される角度関連信号に対して、前記偏差に応じた補正eを行い、補正後の角度関連信号を前記状態推定器の観測値として用いる。
斯かる構成によれば、前記大腿位相角算出手段550によって算出される位相角φの精度を向上させることができる。
なお、前記揺動中心点の算出の際に対象とする歩行周期は、その時点において完了している全歩行周期であっても良いし、若しくは、その時点において完了している歩行周期のうち、直近の所定回数(例えば、5回又は10回等)の歩行周期であっても良い。
また、前記揺動中心点の算出の際に対象とする位相角は、算出対象とされる一の歩行周期における全サンプリングポイントであっても良いし、若しくは、算出対象とされる一の歩行周期における「正」の最大位相角及び「負」の最大位相角であっても良い。
また、前記揺動中心点の算出の際に対象とする位相角は、算出対象とされる一の歩行周期における全サンプリングポイントであっても良いし、若しくは、算出対象とされる一の歩行周期における「正」の最大位相角及び「負」の最大位相角であっても良い。
本実施の形態においては、前記大腿位相角算出手段550は、推定股関節角度θハット及び推定股関節角速度θドットハットによって画される大腿動作状態を位相角平面上にプロットしてトラジェクトリ線図を作成するように構成されている。
図10に、推定股関節角度θハット及び推定股関節角速度θドットハットによって画される大腿動作状態(歩行状態)を一歩行周期に亘ってプロットすることによって得られるトラジェクトリ線図を示す。
図10に示すように、推定股関節角度θハット及び推定股関節角速度θドットハットによって定まる大腿位相角φは、一歩行周期において0~2πの間で変化するように定義される。
図10に示すように、推定股関節角度θハット及び推定股関節角速度θドットハットによって定まる大腿位相角φは、一歩行周期において0~2πの間で変化するように定義される。
詳しくは、大腿が鉛直軸より前方及び後方に位置されている状態の股関節角度をそれぞれ「正」及び「負」とし、大腿が前方及び後方へ向けて揺動されている状態の股関節角速度をそれぞれ「正」及び「負」とする。
この条件で、推定股関節角度θハットが「正」の方向に最大で且つ推定股関節角速度θドットハットが「ゼロ」の状態(図10の点P)の位相角を0とすると、図10の歩行領域A1(推定股関節角度θハットが「正」の方向に最大で且つ推定股関節角速度θドットハットが「ゼロ」の状態から推定股関節角度θハットが「ゼロ」で且つ推定股関節角速度θドットハットが「負」の方向に最大となる状態までの歩行領域)は位相角0~π/2に相当する。
また、図10中の歩行領域A2(推定股関節角度θハットが「ゼロ」で且つ推定股関節角速度θドットハットが「負」の方向に最大の状態から推定股関節角度θハットが「負」の方向に最大で且つ推定股関節角速度θドットハットが「ゼロ」となる状態までの歩行領域)は位相角π/2~πに相当する。
さらに、図10中の歩行領域A3(推定股関節角度θハットが「負」の方向に最大で且つ推定股関節角速度θドットハットが「ゼロ」の状態から推定股関節角度θハットが「ゼロ」で且つ推定股関節角速度θドットハットが「正」の方向に最大となる状態までの歩行領域)は位相角π~3π/2に相当する。
また、図10中の歩行領域A4(推定股関節角度θハットが「ゼロ」で且つ推定股関節角速度θドットハットが「正」の方向に最大の状態から推定股関節角度θハットが「正」の方向に最大で且つ推定股関節角速度θドットハットが「ゼロ」となる状態までの歩行領域)は位相角3π/2~2πに相当する。
一歩行周期当たりに複数のサンプリングポイントが含まれるように前記大腿姿勢検出手段510のサンプリングタイミングが定められており、前記大腿位相角算出手段550は、サンプリングタイミング毎に大腿位相角φを算出する。
本実施の形態においては、前記大腿位相角算出手段550は、推定股関節角度θハットk及び推定股関節角速度θドットハットkによって画されるトラジェクトリ線図上のプロット点Skのベクトル長(トラジェクトリ線図の原点(即ち、推定股関節角度θハットk及び推定股関節角速度θドットハットkがゼロの点)とプロット点Skとの間の距離)が所定の閾値を越えているか否かを判断し、前記ベクトル長が所定の閾値を越えていると、推定股関節角度θハットk及び推定股関節角速度θドットハットkに基づく大腿位相角φkを算出して、大腿位相角φkを前記歩行動作タイミング算出手段560に送信する。
これに対し、前記ベクトル長が所定の閾値以下の場合には、前記大腿位相角算出手段550は、アクチュエータ作動禁止信号を出力する。
斯かる構成を備えることにより、歩行動作が開始されていないにも拘わらず、前記歩行動作補助装置1が前記アクチュエータユニット100を作動させることを有効に防止することができる。
斯かる構成を備えることにより、歩行動作が開始されていないにも拘わらず、前記歩行動作補助装置1が前記アクチュエータユニット100を作動させることを有効に防止することができる。
即ち、前記歩行動作補助装置1を装着したユーザーが歩行動作を開始する前に、意に反して微少な範囲で姿勢変動を起こす場合がある。特に、ユーザーが片麻痺等を有する場合には、そのような事態が生じ易い。
前記大腿位相角算出手段550が前記構成を備えていれば、このような微少な姿勢変動はベクトル長の短いベクトルとして検出される。
従って、推定股関節角度θハットk及び推定股関節角速度θドットハットkによって画されるベクトルVk(図10参照)のベクトル長が所定の閾値を越えている場合にのみ、歩行動作が行われていると判断することにより、歩行動作が開始されていないにも拘わらず、意に反して前記アクチュエータユニット100が作動することを有効に防止することができる。
従って、推定股関節角度θハットk及び推定股関節角速度θドットハットkによって画されるベクトルVk(図10参照)のベクトル長が所定の閾値を越えている場合にのみ、歩行動作が行われていると判断することにより、歩行動作が開始されていないにも拘わらず、意に反して前記アクチュエータユニット100が作動することを有効に防止することができる。
前記歩行動作タイミング算出手段560は、大腿位相角φと歩行周期における歩行動作タイミングとの関係を規定した位相パターン関数を有しており、前記大腿位相角算出手段550から送られてくる一のサンプリングタイミングでの大腿位相角φを前記位相パターン関数に適用して前記一のサンプリングタイミングが歩行周期中のどの歩行動作タイミングにあたるかを算出する。
さらに、前記歩行動作タイミング算出手段560は、歩行周期が完了する毎に、当該完了した歩行周期における大腿位相角φと前記大腿位相角に対応した歩行動作タイミングとが関連付けられた最新位相角データと、その時点で記憶している過去位相角データとを含む有効位相角データに対して最小二乗法によって最新の位相パターン関数を算出し、算出した最新の位相パターン関数を上書き保存する。
詳しくは、図11に示すように、前記歩行動作タイミング算出手段560には、初期状態において、前記位相パターン関数として、初期位相パターン関数φ(α)(C0)が保存されている。
この初期位相パターン関数φ(α)(C0)はユーザー毎に作成され、予め前記歩行動作タイミング算出手段560に記憶されている。
この初期位相パターン関数φ(α)(C0)はユーザー毎に作成され、予め前記歩行動作タイミング算出手段560に記憶されている。
例えば、第1回目の歩行周期C1中において、前記大腿位相角算出手段550が一のサンプリングタイミングSkでの大腿位相角としてφkを算出し、前記歩行動作タイミング算出手段560に送信したとする。
この時点では第1回目の歩行周期C1が完了していないから、前記歩行動作タイミング算出手段560は、前記位相パターン関数として、前記初期位相パターン関数φ(α)(C0)を有している。
従って、前記歩行動作タイミング算出手段560は、図11に示すように、前記大腿位相角算出手段550から送られてきた大腿位相角φkを前記初期位相パターン関数φ(α)(C0)に適用して、前記一のサンプリングタイミングkに対応した保存周期歩行動作タイミングtkを算出し、前記補助トルク算出手段570に送信する。
前記歩行動作タイミング算出手段560は、斯かる処理を第1回目の歩行周期C1が完了するまで繰り返す。
なお、一歩行周期の完了は、例えば、推定股関節角度θハット及び推定股関節角速度θドットハットによって画される大腿位相角φが予め設定されている歩行周期基準角に戻ったか否かによって判断することができる。
なお、一歩行周期の完了は、例えば、推定股関節角度θハット及び推定股関節角速度θドットハットによって画される大腿位相角φが予め設定されている歩行周期基準角に戻ったか否かによって判断することができる。
前記歩行動作タイミング算出手段560は、第1回目の歩行周期C1が完了すると、当該完了した第1回目の歩行周期C1中において前記大腿位相角算出手段550から受信した大腿位相角と前記大腿位相角に対応した歩行動作タイミングとが関連付けられた状態の最新位相角データを、その時点で記憶している過去位相角データ(この例においては、初期位相パターン関数φ(α)(C0)によって生成される位相角データ)に加えて、その時点で有効な有効位相角データを生成し、前記有効位相角データに対して最小二乗法を用いて、最新位相角パターン関数(この例においては、第1歩行周期完了時位相パターン関数φ(α)(C1))を算出し、前記最新位相角パターン関数を上書き保存する。
具体的には、前記歩行動作タイミング算出手段560は、第1歩行周期C1が完了すると、その時点で有効な前記有効位相角データに対し最小二乗法によって、
φ(α)(C1)=a0(1)+a1(1)α+a2(1)α2+・・・+am(1)αm
の係数パラメータを算出し、前記φ(α)(C1)を大腿位相角の位相パターン関数として保存する。上式において、mは正の整数である。
φ(α)(C1)=a0(1)+a1(1)α+a2(1)α2+・・・+am(1)αm
の係数パラメータを算出し、前記φ(α)(C1)を大腿位相角の位相パターン関数として保存する。上式において、mは正の整数である。
そして、前記歩行動作タイミング算出手段560は、第2歩行周期C2中においては、その時点で記憶している第1歩行周期完了時位相パターン関数φ(α)(C1)を用いて、保存周期歩行動作タイミングtkを算出する。
第2歩行周期C2が完了すると、前記歩行動作タイミング算出手段560は、その時点で有効な前記有効位相角データに対し最小二乗法によって、
φ(α)(C2)=a0(2)+a1(2)α+a2(2)α2+・・・+am(2)αm
の係数パラメータを算出し、前記φ(α)(C2)を大腿位相角の位相パターン関数として上書き保存する。
φ(α)(C2)=a0(2)+a1(2)α+a2(2)α2+・・・+am(2)αm
の係数パラメータを算出し、前記φ(α)(C2)を大腿位相角の位相パターン関数として上書き保存する。
そして、前記歩行動作タイミング算出手段560は、第3歩行周期C3中においては、その時点で記憶している第2歩行周期完了時位相パターン関数φ(α)(C2)を用いて、保存周期歩行動作タイミングを算出する。
前記歩行動作タイミング算出手段560は斯かる処理を繰り返す。
なお、前記有効位相角データは、その時点で完了している全ての歩行周期における位相角データを含むものとすることも可能であるし、これに代えて、前記歩行動作タイミング算出手段560における記憶容量に応じて、直近の所定回数(例えば、100回)の歩行周期における位相角データだけに制限することも可能である。
なお、前記有効位相角データは、その時点で完了している全ての歩行周期における位相角データを含むものとすることも可能であるし、これに代えて、前記歩行動作タイミング算出手段560における記憶容量に応じて、直近の所定回数(例えば、100回)の歩行周期における位相角データだけに制限することも可能である。
本実施の形態においては、前記歩行動作タイミング算出手段560は下記構成を備えることによって、異常な位相角データが位相角パターン関数の算出時の有効位相角データに含まれることを防止している。
即ち、前記歩行動作タイミング算出手段560は、前記大腿位相角算出手段550から受け取った一のサンプリングタイミングkでの大腿位相角φkに基づき算出される現在周期歩行動作タイミングTkと、前記大腿位相角φnをその時点で記憶している前記位相パターン関数φ(α)に適用して算出される保存周期歩行動作タイミングtkとの差異ΔTを算出する。
ここで、前記現在周期歩行動作タイミングTkは、
Tk=(φk/2π)×100(%)
によって算出される。
Tk=(φk/2π)×100(%)
によって算出される。
前記差異ΔTの絶対値が所定閾値以下の場合には、前記歩行動作タイミング算出手段560は、歩行周期完了時において新たな位相パターン関数φ(α)を算出する際に用いる有効位相角データとして、前記現在周期歩行動作タイミングTkを記憶する。
即ち、前記差異ΔTの絶対値が所定閾値以下の場合には、前記歩行動作タイミング算出手段560は、一の歩行周期完了時に最新位相パターン関数を算出する際に、当該一の歩行周期において前記大腿位相角算出手段550から受信した大腿位相角φに関連付ける歩行動作タイミングとして、前記現在周期歩行動作タイミングTkを記憶する。
これに対し、前記差異ΔTの絶対値が所定閾値を越える場合には、前記歩行動作タイミング算出手段560は、歩行周期完了時において最新位相パターン関数を算出する際に用いる有効位相角データとして、前記保存周期歩行動作タイミングtkを記憶する。
即ち、前記差異ΔTの絶対値が所定閾値を越える場合には、前記歩行動作タイミング算出手段560は、一の歩行周期完了時に最新位相パターン関数を算出する際に、当該一の歩行周期において前記大腿位相角算出手段550から受信した大腿位相角φに関連付ける歩行動作タイミングとして、前記保存周期歩行動作タイミングtkを記憶する。
斯かる構成を備えることにより、何らかの理由によって異常値となった現在周期歩行動作タイミングTkが位相パターン関数算出時の対象データ(有効位相角データ)に含まれることを有効に防止することができる。
前記補助トルク算出手段570は、歩行動作タイミングと出力すべきトルク値との関係を規定した出力トルクパターンを有しており、前記歩行動作タイミング算出手段560から送られてくる歩行動作タイミングを前記出力トルクパターンに適用して当該サンプリングタイミングSnにおいて出力すべきトルク値を算出する。
前記出力トルクパターンはユーザー毎に作成され、予め、前記補助トルク算出手段570に記憶される。
前記出力トルクパターンはユーザー毎に作成され、予め、前記補助トルク算出手段570に記憶される。
前記作動制御手段580は、前記補助トルク算出手段570によって算出されたトルク値の補助力を出力するように、前記アクチュエータユニット100の作動制御を実行する。
このように、本実施の形態に係る歩行動作補助装置1は、大腿位相角φに基づいて歩行周期中の歩行状態(歩行動作タイミング)を把握し、前記歩行状態に応じた補助力を出力するように構成されている。
従って、歩行状態(歩行動作タイミング)を正確に認識し、歩行状態に適した補助力を出力することができる。
従って、歩行状態(歩行動作タイミング)を正確に認識し、歩行状態に適した補助力を出力することができる。
また、本実施の形態に係る歩行動作補助装置1は、大腿位相角φをその時点で記憶されている位相パターン関数に適用して、歩行状態(歩行動作タイミング)を算出するように構成されている。
従って、歩行周期中にイレギュラーな歩行動作が生じたとしても、修正された状態の補助力を出力することができる。
従って、歩行周期中にイレギュラーな歩行動作が生じたとしても、修正された状態の補助力を出力することができる。
また、本実施の形態に係る歩行動作補助装置1においては、前記大腿位相角算出手段550は、推定股関節角度θハット及び推定股関節角速度θドットハットによって画されるトラジェクトリ線図上のプロット点のベクトル長が所定の閾値を越えている場合にのみ、推定股関節角度θハット及び推定股関節角速度θドットハットに基づく大腿位相角φを算出して、大腿位相角φを前記歩行動作タイミング算出手段に送信する一方で、前記ベクトル長が所定の閾値以下の場合には、アクチュエータ作動禁止信号を出力する。
従って、前記歩行動作補助装置1を装着したユーザーが意に反して姿勢変動を起こした場合に、歩行動作を開始していないにも拘わらず、前記アクチュエータユニット100が歩行補助力を出力することを有効に防止することができる。
さらに、本実施の形態に係る歩行動作補助装置1は、前述の通り、大腿位相角φに基づき一の歩行周期中における歩行状態を認識した上で、前記アクチュエータユニット100によって下腿に対して歩行補助力を付与するように構成されている。
従って、脳卒中等によって片麻痺を有するユーザーに対しても的確な歩行補助力を供給することができる。
従って、脳卒中等によって片麻痺を有するユーザーに対しても的確な歩行補助力を供給することができる。
即ち、アクチュエータユニットによって歩行補助力を付与するように構成された従来の歩行補助装置は、前記アクチュエータユニットによって補助力が付与される制御対象部位の動きを検出し、その検出結果に基づき前記アクチュエータユニットの作動制御を行うように構成されている。
例えば、大腿に対して歩行補助力を供給する従来の歩行補助装置においては、大腿の動きの検出結果に基づき、大腿に対して歩行補助力を付与するアクチュエータの作動制御を行うものとされている。
また、下腿に対して歩行補助力を供給する従来の歩行補助装置においては、下腿の動きの検出結果に基づき、下腿に対して歩行補助力を付与するアクチュエータの作動制御を行うものとされている。
また、下腿に対して歩行補助力を供給する従来の歩行補助装置においては、下腿の動きの検出結果に基づき、下腿に対して歩行補助力を付与するアクチュエータの作動制御を行うものとされている。
しかしながら、脳卒中等の為に片麻痺を有する患者の場合、大腿の歩行動作(股関節回りの前後揺動動作)は比較的正常に行えるものの、下腿の歩行動作(膝関節回りの前後揺動動作)は正常に行えないことが多い。
このような患者に対して下腿への歩行補助力を付与しようとすると、前記従来の歩行補助装置においては、正常な歩行動作を行えない下腿の動きに基づいて、下腿に対して歩行補助力を提供するアクチュエータの作動制御を行うことになり、的確な歩行補助力を提供することができないおそれがある。
これに対し、本実施の形態に係る前記歩行動作補助装置1は、前述の通り、大腿位相角φに基づいて、下腿に対して歩行補助力を付与する前記アクチュエータユニット100の作動制御を行うように構成されている。
従って、ユーザーが脳卒中等によって片麻痺を有する場合であっても、下腿に対して的確な歩行補助力を供給することができる。
従って、ユーザーが脳卒中等によって片麻痺を有する場合であっても、下腿に対して的確な歩行補助力を供給することができる。
ここで、歩行動作に必要な歩行補助力について説明する。
図12に、一歩行周期中に変化する歩行状態の模式図を示す。
図12に示すように、一歩行周期は、鉛直軸より前方側で踵を接地させるヒールコンタクト時点を含むヒールコンタクト期(踏み出した足が接床する前後の期間)X1と、ヒールコンタクト後に当該ヒールコンタクトした脚を接地させた状態で後方側へ相対移動させる立脚期(接床した下肢が身体に対して相対的に後方に移動する期間)X2と、立脚期X2の終了時点から立脚していた脚を引き上げて前方側へ相対移動させる遊脚期X3とを含んでいる。
図12に、一歩行周期中に変化する歩行状態の模式図を示す。
図12に示すように、一歩行周期は、鉛直軸より前方側で踵を接地させるヒールコンタクト時点を含むヒールコンタクト期(踏み出した足が接床する前後の期間)X1と、ヒールコンタクト後に当該ヒールコンタクトした脚を接地させた状態で後方側へ相対移動させる立脚期(接床した下肢が身体に対して相対的に後方に移動する期間)X2と、立脚期X2の終了時点から立脚していた脚を引き上げて前方側へ相対移動させる遊脚期X3とを含んでいる。
図13(a)に、前記出力トルクパターンによって画される補助力の変化パターンの一例を示す。
図13(a)に示す一例においては、前記出力トルクパターンは、前記ヒールコンタクト期X1において、前記下腿側装具30を膝関節回り膝伸展方向へ回動させて膝折れを防止する為の第1トルクパターンY1と、前記立脚期X2において、前記下腿側装具30を膝関節回り膝伸展方向へ回動させて膝折れを防止する為の第2トルクパターンY2と、立脚期X2の終了時点から立脚していた脚を引き上げて前方側へ相対移動させる遊脚期X2の初期段階X3aにおいて、前記下腿側装具30を膝関節回り膝屈曲方向へ回動させて脚の引き上げを補助する為の第3トルクパターンY3と、前記遊脚期X3の後期段階X3bにおいて、前記下腿側装具30を膝関節回り膝伸展方向へ回動させる第4トルクパターンY4とを含んでいる。
図13(a)に示す一例においては、前記出力トルクパターンは、前記ヒールコンタクト期X1において、前記下腿側装具30を膝関節回り膝伸展方向へ回動させて膝折れを防止する為の第1トルクパターンY1と、前記立脚期X2において、前記下腿側装具30を膝関節回り膝伸展方向へ回動させて膝折れを防止する為の第2トルクパターンY2と、立脚期X2の終了時点から立脚していた脚を引き上げて前方側へ相対移動させる遊脚期X2の初期段階X3aにおいて、前記下腿側装具30を膝関節回り膝屈曲方向へ回動させて脚の引き上げを補助する為の第3トルクパターンY3と、前記遊脚期X3の後期段階X3bにおいて、前記下腿側装具30を膝関節回り膝伸展方向へ回動させる第4トルクパターンY4とを含んでいる。
図13(b)に、前記出力トルクパターンによって画される補助力の変化パターンの他例を示す。
図13(b)に示す例においては、前記出力トルクパターンは、前記第3トルクパターンY3及び前記第4トルクパターンY4のみを含んでいる。
図13(b)に示す例においては、前記出力トルクパターンは、前記第3トルクパターンY3及び前記第4トルクパターンY4のみを含んでいる。
このように、歩行周期中の歩行状態(歩行動作タイミング)と歩行補助力との関係を表す前記出力トルクパターンを用いて前記アクチュエータユニット100の作動制御を行うことにより、ユーザーに合わせた適切な歩行補助を行うことができる。
図13(a)及び(b)に示す例においては、ヒールコンタクトが歩行周期基準タイミングとして設定されている。
このように、ヒールコンタクトを歩行周期基準タイミングとすることによって、歩行周期中における歩行補助力が必要なタイミングを正確に把握することができる。
このように、ヒールコンタクトを歩行周期基準タイミングとすることによって、歩行周期中における歩行補助力が必要なタイミングを正確に把握することができる。
ヒールコンタクトのタイミングは、種々の方法によって認識することができる。
例えば、鉛直軸を基準として大腿が前方側及び後方側へ向けて揺動している際の股関節角速度をそれぞれ正及び負とした場合に、前記制御装置500が、算出される股関節角速度が正値からゼロへ移行したタイミング(図10中のP)から所定位相角Δαだけ進行した時点をヒールコンタクト時点として認識するように構成することができる。
例えば、鉛直軸を基準として大腿が前方側及び後方側へ向けて揺動している際の股関節角速度をそれぞれ正及び負とした場合に、前記制御装置500が、算出される股関節角速度が正値からゼロへ移行したタイミング(図10中のP)から所定位相角Δαだけ進行した時点をヒールコンタクト時点として認識するように構成することができる。
これに代えて、前記歩行動作補助装置1にヒールコンタクトを検出するヒールコンタクト検出手段を備え、前記大腿位相角検出手段は、前記ヒールコンタクト検出手段によって検出されたタイミングをヒールコンタクト時点として認識し、そのタイミングでの大腿位相角φをヒールコンタクト位相角として認識するように構成することも可能である。
本実施の形態に係る歩行動作補助装置1におけるように、前記加速度センサ515が備えられている場合には、前記加速度センサ515を前記ヒールコンタクト検出手段として兼用することができる。
これに代えて、踵の接地を検出可能な圧力センサを別途に備え、前記圧力センサを前記ヒールコンタクト検出手段として作用させることも可能である。
これに代えて、踵の接地を検出可能な圧力センサを別途に備え、前記圧力センサを前記ヒールコンタクト検出手段として作用させることも可能である。
図14に、前記歩行動作補助装置1におけるアクチュエータ作動制御モードのフローを示す。
起動信号入力に応じて前記制御装置500が前記アクチュエータ作動制御モードを起動する。
起動信号は、例えば、スタートボタン等の人為操作部材へのユーザーによる人為操作に応じて入力される。
起動信号は、例えば、スタートボタン等の人為操作部材へのユーザーによる人為操作に応じて入力される。
前記アクチュエータ作動制御モードが起動されると、前記大腿位相角検出手段550は、前記大腿姿勢検出手段510からの一のサンプリングタイミングkでの角度関連信号に基づき、当該一のサンプリングタイミングkでの測定股関節角度θkを認識する(ステップS11)。
前記大腿位相角検出手段550は、股関節角度θkに対して回転中心補正処理を行い、補正股関節角度θkを算出する(ステップS12)。
なお、過去揺動中心が認識されていない段階においては、ステップ12においては、ゼロ補正(補正無し)とされる。
なお、過去揺動中心が認識されていない段階においては、ステップ12においては、ゼロ補正(補正無し)とされる。
前記大腿位相角検出手段550は、ユーザーの脚部の動きを近似する棒状剛体600の振り子動作の運動方程式に対して設計された状態推定器(本実施の形態においてはカルマンフィルタ)を用いてサンプリングタイミングkでの推定股関節角度θドットk及び推定股関節角速度θドットハットkを算出する(ステップS13)。
前記大腿位相角検出手段550は、推定股関節角度θハットk及び推定股関節角速度θドットハットkに基づきトラジェクトリ線図を作成し(ステップS14)、トラジェクトリ線図上のプロット点のベクトル長(プロット点と原点との距離)が閾値を越えているか否かを判断する(ステップS15)。
前記ステップS15がNOの場合、前記大腿位相角検出手段550は、歩行動作が開始されていないと判断して、アクチュエータ作動禁止信号を出力する(ステップ30)。
この場合、前記アクチュエータ作動制御モードは、ステップS11に戻る
この場合、前記アクチュエータ作動制御モードは、ステップS11に戻る
前記ステップS15がYESの場合には、前記大腿位相角検出手段550は、歩行動作が行われていると判断して、推定股関節角度θハットk及び推定股関節角速度θドットハットkに基づき大腿位相角φkを算出し、前記歩行動作タイミング算出手段560に送信する(ステップS16)。
前記歩行動作タイミング算出手段560は、前記大腿位相角検出手段550からの大腿位相角φkを、その時点において有効な位相パターン関数φ(α)に適用して、保存周期歩行動作タイミングtkを算出し、前記補助トルク算出手段570に送信する(ステップS17)。
同時に、前記歩行動作タイミング算出手段560は、位相パターン関数作成処理を実行する。位相パターン関数作成処理については後述する。
同時に、前記歩行動作タイミング算出手段560は、位相パターン関数作成処理を実行する。位相パターン関数作成処理については後述する。
前記補助トルク算出手段570は、前記歩行動作タイミング算出手段560からの保存周期歩行動作タイミングtkを、記憶する出力トルクパターンに適用して、このタイミング(サンプリングタイミングk)において前記アクチュエータユニット100が出力すべき歩行補助力の大きさ及び方向を取得し、前記作動制御手段580に送信する(ステップS18)。
前記作動制御手段580は、前記補助トルク算出手段570によって算出された大きさ及び方向の歩行補助力が出力されるように前記アクチュエータユニット100の作動制御を行う(ステップS19)。
ここで、前記位相パターン関数作成処理について図15を参照しつつ説明する。
前記位相パターン関数作成処理は、サンプリングタイミングkでの歩行動作が正常か否かを判断して、以降の歩行周期において使用する位相パターン関数の算出に際し用いるべき有効位相角データの選別を行い、歩行周期完了時に前記有効位相角データを用いて新たな位相パターン関数を作成するように構成されている。
前記位相パターン関数作成処理は、サンプリングタイミングkでの歩行動作が正常か否かを判断して、以降の歩行周期において使用する位相パターン関数の算出に際し用いるべき有効位相角データの選別を行い、歩行周期完了時に前記有効位相角データを用いて新たな位相パターン関数を作成するように構成されている。
具体的には、ステップS40において、前記歩行動作タイミング算出手段560は、(φk/2π)×100(%)によって算出される現在周期歩行動作タイミングTkと、前記ステップS17において算出した保存周期歩行動作タイミングtkとの差異ΔTが所定閾値以下か否かを判断する。
前記ステップS40がYESの場合、即ち、前記差異ΔTが所定閾値以下の場合には、前記歩行動作タイミング算出手段560は、サンプリングタイミングkでの歩行動作が正常であると判断して、大腿位相角φk及び現在周期歩行動作タイミングTkを位相角データとして記憶する(ステップS41)。
一方、前記ステップS40がNOの場合、即ち、前記差異ΔTが所定閾値を越える場合には、前記歩行動作タイミング算出手段560は、サンプリングタイミングkでの歩行動作が異常であると判断して、大腿位相角φk及び保存周期歩行動作タイミングtkを位相角データとして記憶する(ステップS42)。
その後、前記歩行動作タイミング算出手段560は、一歩行周期が終了したか否かを判断し(ステップS43)、一歩行周期が終了した時点で、当該歩行周期における位相角データとその時点で記憶されている過去の保存歩行周期における位相角データとを含む有効位相角データに基づき、最小二乗法を用いて新たな位相パターン関数を算出し、上書き保存する(ステップS44)。
一歩行周期が終了してない場合には、ステップS44はバイパスされる。
一歩行周期が終了してない場合には、ステップS44はバイパスされる。
前記位相パターン関数処理を備えることにより、異常歩行動作のデータが位相パターン関数に含まれることを有効に防止することができる。
ステップS20において、前記制御装置500は、前記アクチュエータ作動制御モードの終了信号が入力されているか否かを判断し、終了信号の入力が無い場合にはステップS11へ戻り、終了信号が入力された場合には当該制御モードを終了する。
なお、終了信号は例えば、終了ボタン等の人為操作部材へのユーザーによる人為操作に応じて入力される。
なお、終了信号は例えば、終了ボタン等の人為操作部材へのユーザーによる人為操作に応じて入力される。
なお、本実施の形態に係る歩行動作補助装置1は、大腿位相角φに基づいて歩行動作状態(歩行動作タイミング)を把握し、その歩行動作状態に適した歩行補助力を下腿に付与するように構成されているが、本発明は斯かる形態に限定されるものでは無く、大腿位相角φに基づいて把握された歩行動作状態に適した歩行補助力を大腿に付与するように構成することも可能である。
1 歩行動作補助装置
10 大腿側装具
30 下腿側装具
100 アクチュエータユニット
500 制御装置
510 大腿姿勢検出手段
550 大腿位相角算出手段
560 歩行動作タイミング算出手段
570 補助トルク算出手段
580 作動制御手段
10 大腿側装具
30 下腿側装具
100 アクチュエータユニット
500 制御装置
510 大腿姿勢検出手段
550 大腿位相角算出手段
560 歩行動作タイミング算出手段
570 補助トルク算出手段
580 作動制御手段
Claims (4)
- ユーザーの歩行動作に対して補助力を付与するアクチュエータと、
サンプリングタイミング毎にユーザーの大腿の前後揺動角度である股関節角度に関連する股関節角度関連信号を検出する大腿姿勢検出手段と、
一のサンプリングタイミングkでの大腿位相角を算出する大腿位相角算出手段と、
大腿位相角と前記アクチュエータが出力すべきトルク値との関係が直接又は間接的に規定された出力パターンデータを有し、前記大腿位相角算出手段によって算出された大腿位相角を前記出力パターンデータに適用して前記一のサンプリングタイミングkにおいて出力すべきトルク値を算出する補助トルク算出手段と、
前記補助トルク算出手段によって算出されたトルク値の補助力を出力するように、前記アクチュエータの作動制御を司る作動制御手段とを備え、
前記大腿位相角算出手段は、歩行時におけるユーザーの大腿及び下腿を含む脚部の股関節回りの動きを、先端部に所定質量mの質点が取り付けられた所定長さ?の棒状剛体が基端部を揺動中心として振り子動作する動きで近似し、前記質点の揺動軌跡に沿った円の接線方向における運動方程式に基づいて近似算出される前記大腿の股関節角度及び股関節角速度を、サンプリングタイミングkにおいて前記大腿姿勢検出手段から入力される角度関連信号を観測値として用いた状態推定器によって推定し、この推定股関節角度及び推定股関節角速度を用いてサンプリングタイミングkでの大腿位相角を算出することを特徴とする歩行動作補助装置。 - 前記状態推定器はカルマンフィルタとされており、
前記大腿位相角算出手段は、前記運動方程式に基づく式(1)及び前記大腿姿勢検出手段から入力される角度関連信号を観測値とする式(1b)と前記カルマンフィルタによる式(2a)~(2e)とを用いて、前記推定揺動角度及び前記推定揺動角速度を算出することを特徴とする請求項1に記載の歩行動作補助装置。
θドット:股関節角速度
g:重力加速度
μ:歩行時に股関節回りに働く股関節トルク
γ:未知外乱
v:観測雑音
xハット[k|k]:サンプリングタイミングkでの事後推定値
xハット[k|k-1]: サンプリングタイミングkでの事前推定値
K[k]:サンプリングタイミングkでのカルマンゲイン
P[k|k]:サンプリングタイミングkでの事後誤差共分散行列
P[k|k-1]:サンプリングタイミングkでの事前誤差共分散行列
y[k]:サンプリングタイミングkでの大腿姿勢検出手段の観測値(計測値)
C:観測行列
Q:未知外乱γの共分散行列
R:観測雑音vの共分散行列 - 前記大腿位相角算出手段は、完了している過去の歩行周期における推定股関節角度の揺動中心点と股関節角度ゼロ点との偏差を算出し、現時点の歩行周期中において前記大腿姿勢検出手段から入力される角度関連信号に対して前記偏差に応じた補正を行い、補正後の角度関連信号を前記状態推定器の観測値として用いることを特徴とする請求項1又は2に記載の歩行動作補助装置。
- ユーザーの大腿に装着される大腿側装具と、ユーザーの下腿に装着され且つ前記大腿側装具に対してユーザーの膝関節回り回動可能に連結された下腿側装具とを備え、
前記アクチュエータは前記大腿側装具に装着され、前記下腿側装具に対して膝関節回りの補助力を付与可能とされていることを特徴とする請求項1から3の何れかに記載の歩行動作補助装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP18870071.0A EP3692972B1 (en) | 2017-10-23 | 2018-10-19 | Walking motion assist device |
CN201880068748.1A CN111246830B (zh) | 2017-10-23 | 2018-10-19 | 步行动作辅助装置 |
US16/756,136 US11504292B2 (en) | 2017-10-23 | 2018-10-19 | Gait motion assisting device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017204357A JP6925231B2 (ja) | 2017-10-23 | 2017-10-23 | 歩行動作補助装置 |
JP2017-204357 | 2017-10-23 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019082802A1 true WO2019082802A1 (ja) | 2019-05-02 |
Family
ID=66246422
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/038974 WO2019082802A1 (ja) | 2017-10-23 | 2018-10-19 | 歩行動作補助装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11504292B2 (ja) |
EP (1) | EP3692972B1 (ja) |
JP (1) | JP6925231B2 (ja) |
CN (1) | CN111246830B (ja) |
WO (1) | WO2019082802A1 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
USD947388S1 (en) * | 2018-12-10 | 2022-03-29 | Jtekt Corporation | Motion assisting device |
KR20210050268A (ko) * | 2019-10-28 | 2021-05-07 | 삼성전자주식회사 | 착용형 장치 및 이의 동작 방법 |
CN112220650B (zh) * | 2020-12-09 | 2021-04-16 | 南京伟思医疗科技股份有限公司 | 一种外骨骼机器人对侧训练用在线步态生成控制系统 |
CN112618283B (zh) * | 2020-12-21 | 2022-12-27 | 南京伟思医疗科技股份有限公司 | 一种外骨骼机器人主动训练用步态协调助力控制系统 |
CN116869521B (zh) * | 2023-09-07 | 2023-11-14 | 贵州航天控制技术有限公司 | 一种下肢助力外骨骼系统的人体运动模式实时识别方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5724312B2 (ja) | 1973-06-28 | 1982-05-24 | ||
JP2003220584A (ja) * | 2002-01-28 | 2003-08-05 | Honda Motor Co Ltd | 二足歩行移動体の床反力作用点推定方法 |
JP2007260389A (ja) * | 2006-03-01 | 2007-10-11 | Shinshu Univ | 転倒推知装置および転倒用プロテクタ |
JP5386253B2 (ja) | 2009-07-15 | 2014-01-15 | サンコールエンジニアリング株式会社 | 歩行診断支援システム、歩行パターン生成装置、歩行パターン生成プログラム、及び歩行パターン生成方法 |
JP2014073227A (ja) * | 2012-10-04 | 2014-04-24 | Toyota Motor Corp | 歩行支援装置及びその制御方法 |
JP5799608B2 (ja) | 2011-06-23 | 2015-10-28 | トヨタ自動車株式会社 | 歩行補助装置 |
JP2016002408A (ja) | 2014-06-19 | 2016-01-12 | 本田技研工業株式会社 | 歩行補助装置および歩行制御プログラム |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5724312B2 (ja) | 2010-11-15 | 2015-05-27 | トヨタ自動車株式会社 | リハビリ補助装置 |
US9687377B2 (en) * | 2011-01-21 | 2017-06-27 | Bionx Medical Technologies, Inc. | Terrain adaptive powered joint orthosis |
IN2014KN02945A (ja) * | 2012-06-15 | 2015-05-08 | Univ Vanderbilt | |
US9603724B2 (en) * | 2013-08-27 | 2017-03-28 | Carnegie Mellon University, A Pennsylvania Non-Profit Corporation | Robust swing leg controller under large disturbances |
KR102186859B1 (ko) * | 2014-01-09 | 2020-12-04 | 삼성전자주식회사 | 보행 보조 기구 및 보행 보조 기구의 제어 방법 |
JP6414664B2 (ja) * | 2014-06-13 | 2018-10-31 | 国立大学法人 筑波大学 | 義肢装着式動作補助装置 |
JP5938124B1 (ja) * | 2015-05-19 | 2016-06-22 | 本田技研工業株式会社 | 歩行補助装置 |
JP6148766B1 (ja) | 2016-06-01 | 2017-06-14 | サンコール株式会社 | アクチュエータ付き長下肢装具 |
US11801153B2 (en) * | 2016-07-29 | 2023-10-31 | The United States Of America, As Represented By The Secretary, Department Of Health And Human Services | Powered gait assistance systems |
-
2017
- 2017-10-23 JP JP2017204357A patent/JP6925231B2/ja active Active
-
2018
- 2018-10-19 US US16/756,136 patent/US11504292B2/en active Active
- 2018-10-19 EP EP18870071.0A patent/EP3692972B1/en active Active
- 2018-10-19 CN CN201880068748.1A patent/CN111246830B/zh active Active
- 2018-10-19 WO PCT/JP2018/038974 patent/WO2019082802A1/ja unknown
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5724312B2 (ja) | 1973-06-28 | 1982-05-24 | ||
JP2003220584A (ja) * | 2002-01-28 | 2003-08-05 | Honda Motor Co Ltd | 二足歩行移動体の床反力作用点推定方法 |
JP2007260389A (ja) * | 2006-03-01 | 2007-10-11 | Shinshu Univ | 転倒推知装置および転倒用プロテクタ |
JP5386253B2 (ja) | 2009-07-15 | 2014-01-15 | サンコールエンジニアリング株式会社 | 歩行診断支援システム、歩行パターン生成装置、歩行パターン生成プログラム、及び歩行パターン生成方法 |
JP5799608B2 (ja) | 2011-06-23 | 2015-10-28 | トヨタ自動車株式会社 | 歩行補助装置 |
JP2014073227A (ja) * | 2012-10-04 | 2014-04-24 | Toyota Motor Corp | 歩行支援装置及びその制御方法 |
JP2016002408A (ja) | 2014-06-19 | 2016-01-12 | 本田技研工業株式会社 | 歩行補助装置および歩行制御プログラム |
Non-Patent Citations (1)
Title |
---|
See also references of EP3692972A4 |
Also Published As
Publication number | Publication date |
---|---|
US20200297571A1 (en) | 2020-09-24 |
CN111246830A (zh) | 2020-06-05 |
JP6925231B2 (ja) | 2021-08-25 |
EP3692972B1 (en) | 2024-06-12 |
CN111246830B (zh) | 2023-02-28 |
EP3692972A1 (en) | 2020-08-12 |
JP2019076294A (ja) | 2019-05-23 |
US11504292B2 (en) | 2022-11-22 |
EP3692972A4 (en) | 2021-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2019082802A1 (ja) | 歩行動作補助装置 | |
JP6148766B1 (ja) | アクチュエータ付き長下肢装具 | |
JP7111463B2 (ja) | 歩行動作補助装置 | |
JP2017213347A (ja) | アクチュエータ付き長下肢装具 | |
JP2018050881A (ja) | 歩行動作補助装置 | |
WO2020217690A1 (ja) | 歩行動作補助装置 | |
WO2020153025A1 (ja) | 歩行動作補助装置 | |
JP2017213337A (ja) | アクチュエータ付き長下肢装具 | |
JP2018050882A (ja) | 歩行動作補助装置 | |
JP6717766B2 (ja) | アクチュエータ付き長下肢装具 | |
WO2020195446A1 (ja) | 歩行動作補助装置 | |
JP2020156556A5 (ja) | ||
JP6785906B2 (ja) | 歩行動作補助装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18870071 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2018870071 Country of ref document: EP Effective date: 20200507 |