JP6697768B2 - 歩行支援ロボット及び歩行支援方法 - Google Patents

歩行支援ロボット及び歩行支援方法 Download PDF

Info

Publication number
JP6697768B2
JP6697768B2 JP2016129237A JP2016129237A JP6697768B2 JP 6697768 B2 JP6697768 B2 JP 6697768B2 JP 2016129237 A JP2016129237 A JP 2016129237A JP 2016129237 A JP2016129237 A JP 2016129237A JP 6697768 B2 JP6697768 B2 JP 6697768B2
Authority
JP
Japan
Prior art keywords
load
user
mode
unit
robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2016129237A
Other languages
English (en)
Other versions
JP2018000382A (ja
Inventor
真悠 横矢
真悠 横矢
山田 和範
山田  和範
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Intellectual Property Management Co Ltd
Original Assignee
Panasonic Intellectual Property Management Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Panasonic Intellectual Property Management Co Ltd filed Critical Panasonic Intellectual Property Management Co Ltd
Priority to JP2016129237A priority Critical patent/JP6697768B2/ja
Priority to CN201710300467.1A priority patent/CN107544489B/zh
Priority to US15/619,569 priority patent/US10086890B2/en
Priority to EP17176583.7A priority patent/EP3284453B1/en
Publication of JP2018000382A publication Critical patent/JP2018000382A/ja
Application granted granted Critical
Publication of JP6697768B2 publication Critical patent/JP6697768B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Appliances for aiding patients or disabled persons to walk about
    • A61H3/04Wheeled walking aids for patients or disabled persons
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/022Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members consisting of members having both rotational and walking movements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/028Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members having wheels and mechanical legs
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Appliances for aiding patients or disabled persons to walk about
    • A61H3/04Wheeled walking aids for patients or disabled persons
    • A61H2003/043Wheeled walking aids for patients or disabled persons with a drive mechanism
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/12Driving means
    • A61H2201/1207Driving means with electric or magnetic drive
    • A61H2201/1215Rotary drive
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/16Physical interface with patient
    • A61H2201/1602Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
    • A61H2201/1635Hand or arm, e.g. handle
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50Control means thereof
    • A61H2201/5023Interfaces to the user
    • A61H2201/5025Activation means
    • A61H2201/503Inertia activation, i.e. activated by movement
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50Control means thereof
    • A61H2201/5058Sensors or detectors
    • A61H2201/5061Force sensors
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50Control means thereof
    • A61H2201/5058Sensors or detectors
    • A61H2201/5064Position sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0227Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
    • G05D1/0229Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area in combination with fixed guiding means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Health & Medical Sciences (AREA)
  • Physical Education & Sports Medicine (AREA)
  • Rehabilitation Therapy (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Animal Behavior & Ethology (AREA)
  • Pain & Pain Management (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Epidemiology (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Rehabilitation Tools (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本開示は、ユーザの歩行を支援する歩行支援ロボット及び歩行支援方法に関する。
先進国における少子高齢化が進む近年、高齢者の見守りや生活支援の必要性が増している。特に、高齢者は加齢に伴う身体能力の低下から宅内生活のQOL(Quality of Life)を維持することが難しくなる傾向にある。高齢者のサルコペニアなどを予防し、身体能力を維持するためには一定以上の運動を続けることで筋肉量を維持することが重要である。しかしながら、身体能力の低下により外出が困難となり、宅内に引きこもりがちな高齢者の場合は、一定の運動量を維持することが難しく、より筋肉量が減衰していくという悪循環に陥ってしまう。近年、このような背景のもと、高齢者などのユーザを目的地まで誘導する歩行支援ロボットが提案されている。
特許文献1には、ユーザの入力に基づいて移動速度を算出し、ユーザの手を引いて目的地までユーザを案内する案内用移動ロボットが開示されている。
特開2010−271911号公報
特許文献1のロボットでは、より快適なユーザの歩行支援を行うという観点では、未だ改善の余地がある。
本開示は、前記課題を解決するもので、より快適なユーザの歩行支援を行うことができる歩行支援ロボット及び歩行支援方法を提供する。
本開示の一態様に係る歩行支援ロボットは、
ユーザの歩行を支援する歩行支援ロボットであって、
本体部と、
前記本体部に設けられ、前記ユーザが把持可能なハンドル部と、
前記ハンドル部にかかる荷重を検知する検知部と、
回転体を有し、前記回転体の回転を制御して当該歩行支援ロボットを移動させる移動装置と、
ユーザの歩行を支援する支援モードを切り替えるモード切替部と、
を備え、
前記支援モードは、当該歩行支援ロボットが自律的に移動を行なって前記ユーザの歩行を誘導する第1モードと、前記検知部において検知した第1荷重に応じて、当該歩行支援ロボットが移動する第2モードと、を含み、
前記モード切替部は、当該歩行支援ロボットが前記第1モードで移動しているときに前記検知部において検知した第2荷重に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替える。
本開示の一態様に係る歩行支援方法は、
自律的に移動を行なってユーザの歩行を誘導する第1モードと、ハンドル部にかかる第1荷重に応じて移動する第2モードと、を含む支援モードで動作する歩行支援ロボットを用いた歩行支援方法であって、
前記歩行支援ロボットが前記第1モードで移動しているとき、前記歩行支援ロボットのハンドル部にかかる第2荷重を、検知部によって検知するステップ、
検知した前記第2荷重に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替えるステップ、
を含む。
以上のように、本開示の歩行支援ロボット及び歩行支援方法によれば、より快適なユーザの歩行支援を行うことができる。
図1は、本開示の実施の形態1に係る歩行支援ロボットの外観図である。 図2は、本開示の実施の形態1に係る歩行支援ロボットによる歩行支援を受けてユーザが歩行している様子を示す図である。 図3は、本開示の実施の形態1における検知部で検知するハンドル荷重の検知方向を示す図である。 図4は、本開示の実施の形態1に係る歩行支援ロボットにおける主要な制御構成を示す制御ブロック図である。 図5は、本開示の実施の形態1に係る歩行支援ロボットの歩行支援の制御構成を示す制御ブロック図である。 図6は、本開示の実施の形態1における荷重傾向マップを示す図である。 図7は、本開示の実施の形態1に係る歩行支援ロボットの荷重傾向データの生成処理の例示的なフローチャートである。 図8は、ハンドル荷重の入力波形情報の一例である。 図9Aは、誘導モードにおけるユーザの直進動作時のFz方向の荷重データの波形情報の一例を示す図である。 図9Bは、図9Aに示すFz方向の荷重データの周波数成分を示す図である。 図10Aは、誘導モードにおけるユーザの直進動作時のMy方向の荷重データの波形情報の一例を示す図である。 図10Bは、図10Aに示すMy方向の荷重データの周波数成分を示す図である。 図11Aは、誘導モードにおけるユーザの右方向旋回時におけるFz方向の荷重データの波形情報の一例を示す図である。 図11Bは、図11Aに示すFz方向における荷重データの周波数成分を示す図である。 図12は、本開示の実施の形態1に係る歩行支援ロボットの移動意図算出処理の例示的なフローチャートである。 図13Aは、手動モードにおけるユーザの直進動作時のFz方向における荷重データの波形情報の一例を示す図である。 図13Bは、図13Aに示すFz方向における荷重データの波形情報から揺らぎ周波数成分をフィルタリングした波形情報を示す図である。 図14Aは、手動モードにおけるユーザの直進動作時のMy方向における荷重データの波形情報の一例を示す図である。 図14Bは、図14Aに示すMy方向における荷重データの波形情報から揺らぎ周波数成分をフィルタリングした波形情報を示す図である。 図15は、本開示の実施の形態1に係る歩行支援ロボットの誘導/手動モード切替判定処理の例示的なフローチャートである。 図16は、本開示の実施の形態1に係る歩行支援ロボットの誘導経路算出処理の例示的なフローチャートである。 図17は、本開示の実施の形態1に係る歩行支援ロボットの駆動力算出処理の例示的なフローチャートである。 図18は、本開示の実施の形態1に係る歩行支援ロボットにおける歩行支援の制御構成を示す別の制御ブロック図である。 図19は、本開示の実施の形態1に係る歩行支援ロボットの誘導/手動モード切替判定処理の例示的なフローチャートである。 図20は、本開示の実施の形態2における荷重傾向マップを示す図である。 図21は、本開示の実施の形態2に係る歩行支援ロボットの荷重傾向データの生成処理の例示的なフローチャートである。 図22は、本開示の実施の形態2に係る歩行支援ロボットの移動意図推定処理の例示的なフローチャートである。 図23Aは、ユーザの直進動作時のMz方向における現在の荷重データの波形情報の一例を示す図である。 図23Bは、Mz方向における過去の荷重データの平均荷重値を示す図である。 図23Cは、本開示の実施の形態2において、補正された荷重データの波形情報の一例を示す図である。 図24Aは、ユーザの直進動作時のMz方向における過去の荷重データの波形情報の一例を示す図である。 図24Bは、図24Aに示すMz方向における過去の荷重データの平均荷重値を示す図である。 図25Aは、ユーザの直進動作時のMz方向における現在の荷重データの波形情報の一例を示す図である。 図25Bは、図25Aに示すMz方向における現在の荷重データの平均荷重値を示す図である。 図26は、本開示の実施の形態2において、補正された荷重データの波形情報の一例を示す図である。
(本開示に至った経緯)
近年、ユーザの歩行を支援するモードとして、歩行支援ロボットが自律的に移動することによりユーザを目的地まで誘導する誘導モードと、歩行支援ロボットがユーザの入力に基づいて移動する手動モードと、を有する歩行支援ロボットが開発されている。この歩行支援ロボットにおいて、誘導モードで動作しているときに、例えば、ユーザが誘導経路から外れて目的地とは別の場所に移動したい場合、ユーザは歩行支援ロボットの支援モードを誘導モードから手動モードに切り替える必要がある。
本発明者らは、ユーザが支援モードを容易に切り替えることができるように、歩行支援ロボットのハンドルにかかる荷重に基づいて、支援モードを誘導モードから手動モードに切り替えることを見出し、本開示に至った。歩行支援ロボットにおいて、ハンドルにかかる荷重に基づいて支援モードを切り替えるという点は、発明者が当該分野において新たに見出した知見である。
また、このような歩行支援ロボットにおいて、ユーザの歩行時にハンドルにかける荷重の傾向が、ユーザ毎に異なっている。例えば、身体能力の低い高齢者は、身体の重心が安定せずに左右に揺れている場合がある。この場合、左右方向のハンドル荷重の値が大きくなるため、歩行支援ロボットは、ユーザが左方向又は右方向に移動しようとしていると判断する場合がある。このため、歩行支援ロボットは、ユーザが誘導経路から外れて移動しようとしていると判断し、支援モードを誘導モードから手動モードに切り替えてしまう。その結果、ユーザは目的地まで誘導してもらいたいと思っているにも関わらず、歩行支援ロボットが手動モードに切り替わってしまう。このように、ハンドル荷重に基づく支援モードの切替においては、ユーザ毎にハンドルにかける荷重の傾向が異なるため、適切な支援モードの切替が困難である。
そこで、本発明者らは、過去に取得したユーザの荷重データに基づいて、誘導モードのときにハンドルにかかる荷重の値を補正することによって、支援モードの切替の判断を行うことを見出し、本開示に至った。
本開示の一態様に係る歩行支援ロボットは、
ユーザの歩行を支援する歩行支援ロボットであって、
本体部と、
前記本体部に設けられ、前記ユーザが把持可能なハンドル部と、
前記ハンドル部にかかる荷重を検知する検知部と、
回転体を有し、前記回転体の回転を制御して当該歩行支援ロボットを移動させる移動装置と、
ユーザの歩行を支援する支援モードを切り替えるモード切替部と、
を備え、
前記支援モードは、当該歩行支援ロボットが自律的に移動を行なって前記ユーザの歩行を誘導する第1モードと、前記検知部において検知した第1荷重に応じて、当該歩行支援ロボットが移動する第2モードと、を含み、
前記モード切替部は、当該歩行支援ロボットが前記第1モードで移動しているときに前記検知部において検知した第2荷重に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替える。
このような構成により、より快適なユーザの歩行支援を行うことができる。
当該歩行支援ロボットの移動中に取得した前記ハンドル部にかかった過去の荷重データに基づいて、前記ハンドル部にかかる荷重の傾向を示す荷重傾向データを生成する荷重傾向データ生成部と、
前記荷重傾向データに基づいて、前記第2荷重の値を補正する荷重補正部と、
を備え、
前記モード切替部は、前記荷重補正部で補正された前記第2荷重の値に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替えてもよい。
このような構成により、荷重傾向データに基づいて荷重の値を補正することができるため、ユーザの身体能力に応じた快適な歩行支援を行うことができる。
前記モード切替部は、前記荷重補正部で補正された前記第2荷重の値が所定の閾値より大きい場合、前記支援モードを前記第1モードから前記第2モードへ切り替えてもよい。
このような構成により、荷重傾向データに基づいて荷重の値を補正することができるため、更にユーザの身体能力に応じた快適な歩行支援を行うことができる。
前記荷重傾向データ生成部は、当該歩行支援ロボットの移動動作毎の荷重傾向データを生成し、
前記荷重補正部は、前記第2荷重が検知された際の当該歩行支援ロボットの移動動作に対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正してもよい。
このような構成により、移動動作毎に荷重傾向データを生成することができるため、より正確にユーザの荷重傾向を把握することができる。これにより、更に、ユーザの歩行を快適に支援することができる。
前記移動動作は、当該歩行支援ロボットの直進動作、後退動作、左右旋回動作を含んでもよい。
このような構成により、歩行支援ロボットの移動動作毎に荷重傾向データを生成することができるため、ユーザの歩行をより快適に支援することができる。
前記荷重補正部は、当該歩行支援ロボットの移動動作に対応する前記荷重傾向データが所定の閾値以上になった場合、前記荷重傾向データに基づいて、前記第2荷重の値を補正してもよい。
このような構成により、歩行支援ロボットの移動動作に対応する荷重傾向データが所定の閾値以上になった場合に、荷重の値を補正することができるため、ユーザの歩行をより快適に支援することができる。
前記荷重傾向データ生成部は、当該歩行支援ロボットの支援モード毎の荷重傾向データを生成し、
前記荷重補正部は、前記第2荷重が検知された際の当該歩行支援ロボットの支援モードに対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正してもよい。
このような構成により、支援モード毎に荷重傾向データを生成し、支援モード毎のユーザの荷重傾向に基づいて荷重を補正することができる。これにより、更に、ユーザの歩行を快適に支援することができる。
前記荷重傾向データは、前記過去の荷重データから算出された揺らぎの周波数であり、
前記荷重補正部は、前記第2荷重から前記揺らぎの周波数成分をフィルタリングすることによって前記第2荷重の値を補正してもよい。
このような構成により、荷重傾向データとして揺らぎ周波数を用いることによって、凹凸の小さい揺らぎから凹凸の大きい揺らぎまで広い範囲でユーザの荷重傾向データを取得して荷重の値を補正することができる。そのため、ユーザの身体能力に応じたより快適な歩行支援を行うことができる。
前記荷重傾向データは、前記過去の荷重データから算出された平均荷重値であり、
前記荷重補正部は、前記平均荷重値に基づいて前記荷重の値を補正してもよい。
このような構成により、荷重傾向データとして平均荷重値を用いることによって、ユーザ毎の定常的に加わる荷重を荷重傾向データとして取得して荷重の値を補正することができるため、ユーザの身体能力に応じたより快適な歩行支援を行うことができる。
前記荷重補正部は、前記検知部で検知された荷重から前記平均荷重値を減算することによって前記荷重の値を補正してもよい。
このような構成により、検知部で検知された荷重から平均荷重値を減算することで、ユーザ毎の定常的に加わる荷重を減らすことができるため、より快適なユーザの歩行支援を行うことができる。
前記モード切替部は、当該歩行支援ロボットの使用状況に応じて、前記所定の閾値を変更してもよい。
このような構成により、歩行支援ロボットの使用状況に応じて支援モードの切替を行うことができるため、ユーザの身体能力に応じた快適な歩行支援を行うことができる。
前記使用状況は、当該歩行支援ロボットが使用される場所、時間のいずれかを含んでもよい。
このような構成により、よりユーザの身体能力に応じた快適な歩行支援を行うことができる。
前記荷重傾向データは、当該歩行支援ロボットの移動動作毎に生成され、
前記荷重補正部は、前記第2荷重が検知された際の当該歩行支援ロボットの移動動作に対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正してもよい。
当該歩行支援ロボットが前記第1モードで前記ユーザを誘導するための誘導経路を示す経路情報を格納する記憶部、を備え、
前記荷重傾向データ生成部は、前記記憶部に格納された前記経路情報が示す前記誘導経路毎に前記荷重傾向データを生成し、
前記荷重補正部は、前記第2荷重が検知された際に当該歩行支援ロボットが移動している前記誘導経路に対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正してもよい。
このような構成により、誘導経路毎にユーザの荷重傾向データを生成することができるため、ユーザの歩行をより快適に支援することができる。
前記第1モードにおける当該歩行支援ロボットの誘導意図を算出する誘導意図算出部、
前記第2荷重の値に基づいてユーザ移動意図を推定するユーザ移動意図推定部、
を備え、
前記モード切替部は、前記誘導意図算出部で算出された前記誘導意図と、前記ユーザ移動意図推定部で推定されたユーザ移動意図と、の差分に基づいて、前記支援モードの切替を行ってもよい。
このような構成により、ユーザ移動意図と歩行支援ロボットの誘導意図との差分に基づいて、支援モードの切替を行うことができるため、ユーザの意図を把握し易い。これにより、更に、ユーザの歩行を快適に支援することができる。
前記検知部は、前記ハンドル部にかかる複数の軸方向の荷重を検知し、
前記荷重傾向データは、前記複数の軸方向それぞれにおける荷重の傾向を示してもよい。
このような構成により、複数の軸方向にかかる荷重を検知することにより、ハンドル荷重にかかる荷重をより正確に検知することができる。このため、ユーザの荷重傾向をより正確に把握することができる。
本開示の一態様に係る歩行支援方法は、
自律的に移動を行なってユーザの歩行を誘導する第1モードと、ハンドル部にかかる第1荷重に応じて移動する第2モードと、を含む支援モードで動作する歩行支援ロボットを用いた歩行支援方法であって、
前記歩行支援ロボットが前記第1モードで移動しているとき、前記歩行支援ロボットのハンドル部にかかる第2荷重を、検知部によって検知するステップ、
検知した前記第2荷重に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替えるステップ、
を含む。
このような構成により、より快適なユーザの歩行支援を行うことができる。
以下、本開示の実施形態について、添付の図面を参照しながら説明する。また、各図においては、説明を容易なものとするため、各要素を誇張して示している。
(実施の形態1)
[全体構成]
図1は、実施の形態1に係る歩行支援ロボット1(以下、「ロボット1」と称する)の外観図を示す。図2は、ロボット1による歩行支援を受けてユーザが歩行している様子を示す。
図1及び図2に示すように、ロボット1は、本体部11と、ハンドル部12と、検知部13と、本体部11を移動させる移動装置14と、荷重傾向データ生成部15と、モード切替部16と、を備える。
ロボット1は、ユーザの歩行を支援する支援モードとして、ユーザを誘導経路に沿って目的地まで誘導する誘導モード(第1モード)と、ユーザの入力に基づいて移動する手動モード(第2モード)とを有する。なお、本明細書において、誘導経路とは、出発地から目的地までの経路を意味する。
誘導モードとは、ロボット1が自律的に移動を行ってユーザの歩行を誘導するモードである。即ち、誘導モードにおいては、ロボット1がユーザの手をひいて、誘導経路に沿ってユーザを目的地まで誘導する。
手動モードとは、ロボット1がユーザの入力に基づいて移動するモードである。即ち、手動モードでは、ロボット1は、ユーザの入力に基づいてユーザの移動方向及び移動速度を推定し、ユーザが安定して歩行できるように支援する。実施の形態1において、ユーザの入力は、ハンドル部12にかかる荷重であり、検知部13によって検知される。
ハンドル部12は、本体部11の上部に設けられており、歩行中のユーザの両手により把持しやすい形状及び高さ位置に設けられている。
検知部13は、ハンドル部12をユーザが把持することにより、ユーザがハンドル部12にかける荷重(ハンドル荷重)を検知する。具体的には、ユーザがハンドル部12を把持して歩行するときに、ユーザはハンドル部12にハンドル荷重をかける。検知部13は、ユーザがハンドル部12にかけるハンドル荷重の向き及び大きさを検知する。
図3は、検知部13で検知するハンドル荷重の検知方向を示す。図3に示すように、検知部13は、互いに直交する三軸方向にかかる力、及び三軸の軸回りのモーメントをそれぞれ検出可能な六軸力センサである。互いに直交する三軸とは、ロボット1の左右方向に延在するx軸、ロボット1の前後方向に延在するy軸、及びロボット1の高さ方向に延在するz軸である。三軸方向にかかる力とは、x軸方向にかかる力Fx、y軸方向にかかる力Fy、及びz軸方向にかかる力Fzである。実施の形態1では、Fxのうち右方向にかかる力をFxとし、左方向にかかる力をFxとしている。Fyのうち前方向にかかる力をFyとし、後方向にかかる力をFyとしている。Fz方向のうち歩行面に対して鉛直下方向にかかる力をFzとし、歩行面に対して鉛直上方向にかかる力をFzとしている。三軸の軸回りのモーメントとは、x軸の軸回りのモーメントMx、y軸の軸回りのモーメントMy、及びz軸の軸回りのモーメントMzである。
移動装置14は、本体部11を移動させる。手動モード時において、移動装置14は、検知部13で検知されたハンドル荷重(力及びモーメント)の大きさ及び向きに基づいて、本体部11を移動させる。実施の形態1では、手動モード時において、移動装置14は、以下のような制御を行っている。なお、本明細書においては、Fx、Fy、Fz、Mx、My、Mzを荷重と称する場合がある。
<前進動作>
移動装置14は、検知部13でFyの力が検知された場合、本体部11を前方向に移動させる。即ち、検知部13でFyの力が検知された場合、ロボット1は前進動作を行う。ロボット1が前進動作を行っている間、検知部13で検知されるFyの力が大きくなると、移動装置14は、ロボット1の前方向への移動の速度を上げる。一方、ロボット1が前進動作を行っている間、検知部13で検知されるFyの力が小さくなると、移動装置14は、ロボット1の前方向への移動速度を下げる。
<後退動作>
移動装置14は、検知部13でFyの力が検知された場合、本体部11を後方向に移動させる。即ち、検知部13でFyの力が検知された場合、ロボット1は後退動作を行う。ロボット1が後退動作を行っている間、検知部13で検知されるFyの力が大きくなると、移動装置14は、ロボット1の後方向への移動の速度を上げる。一方、ロボット1が後退動作を行っている間、検知部13で検知されるFyの力が小さくなると、移動装置14は、ロボット1の後方向への移動速度を下げる。
<右旋回動作>
移動装置14は、検知部13でFyの力とMzのモーメントとが検知された場合、本体部11を右方向に旋回移動させる。即ち、検知部13でFyの力とMzのモーメントが検知された場合、ロボット1は右旋回動作を行う。ロボット1が右旋回動作を行っている間、検知部13で検知されるMzのモーメントが大きくなると、ロボット1の旋回半径が小さくなる。また、ロボット1が右旋回動作を行っている間、検知部13で検知されるFyの力が大きくなると、旋回速度が大きくなる。
<左旋回動作>
移動装置14は、検知部13でFyの力とMzのモーメントとが検知された場合、本体部11を左方向に旋回移動させる。即ち、検知部13でFyの力とMzのモーメントが検知された場合、ロボット1は左旋回動作を行う。ロボット1が左旋回動作を行っている間、検知部13で検知されるMzのモーメントが大きくなると、ロボット1の旋回半径が小さくなる。また、ロボット1が左旋回動作を行っている間、検知部13で検知されるFyの力が大きくなると、旋回速度が大きくなる。
なお、手動モード時における移動装置14の制御は、上述した例に限定されない。移動装置14は、例えば、Fy及びFzの力に基づいて、ロボット1の前進動作及び後退動作を制御してもよい。また、移動装置14は、例えば、Mx又はMyのモーメントに基づいて、ロボット1の旋回動作を制御してもよい。
なお、実施の形態1では、検知部13は、六軸力センサである例を説明したが、これに限定されない。検知部13は、例えば、三軸センサ、又は歪みセンサ等を用いてもよい。
誘導モード時において、移動装置14は、誘導経路に沿って本体部11を自律的に移動させる。具体的には、移動装置14は、誘導モード時において、誘導経路に沿ってユーザを目的地まで誘導するように本体部11を移動させる。実施の形態1では、誘導モード時において、移動装置14は、ユーザが入力するハンドル荷重に応じて移動速度を制御している。また、移動装置14は、ユーザのハンドル荷重±αの値に基づいて移動速度を算出してもよい。例えば、±αの値は、固定値、ユーザ毎に設定された値、ユーザが入力した値、誘導モード時における移動速度が手動モード時における移動速度と同等の速度になるように設定された値、又は誘導モードにおける移動速度が手動モード時における移動速度から加速又は減速した速度になるように設定された値であってもよい。実施の形態1では、誘導モードにおける移動速度を算出するために用いるハンドル荷重は、誘導方向と同じ方向の荷重である。また、誘導モードにおける移動速度を算出するために用いるハンドル荷重は、前方向(Fy)の荷重、又は下方向(Fz)の荷重であってもよい。あるいは、誘導モードにおける移動速度を算出するために用いるハンドル荷重は、誘導方向と同じ方向の荷重、前方向(Fy)の荷重、及び下方向(Fz)の荷重を組み合わせた荷重であってもよい。
移動装置14は、本体部11の下部に設けられた回転体である車輪17と、車輪17を駆動制御する駆動部18と、を備える。
車輪17は、本体部11を自立させた状態で支持し、駆動部18により回転駆動されることにより、自立させた姿勢を保った状態で、例えば、本体部11を図2に示す矢印の方向(前方向または後方向)に移動させる。なお、実施の形態1において、移動装置14が2つの車輪17を用いた移動機構を備える場合を例としたが、車輪以外の回転体(走行ベルト、ローラなど)が用いられるような場合であってもよい。
駆動部18は、荷重補正部19と、ユーザ移動意図推定部20と、駆動力算出部21と、アクチュエータ制御部22と、アクチュエータ23と、を備える。
荷重補正部19は、ユーザの荷重傾向に基づいて、検知部13で検知されたハンドル荷重を補正する。具体的には、荷重補正部19は、荷重傾向データ生成部15で生成された荷重傾向データに基づいて、検知部13で検知されたハンドル荷重の値を補正する。実施の形態1では、ユーザの歩行時の過去のハンドル荷重データから揺らぎ周波数を算出し、検知部13で検知されたハンドル荷重から揺らぎ周波数をフィルタリングすることによって、ハンドル荷重の補正を行う。また、荷重補正部19は、ロボット1の使用場所、使用時間、及びユーザの体調などに基づいて、ハンドル荷重の値を補正してもよい。
ユーザ移動意図推定部20は、荷重補正部19で補正されたハンドル荷重(以下、「補正ハンドル荷重」と称する)に基づいてユーザの移動意図を推定する。ユーザの移動意図とは、ユーザの意図によって移動するロボット1の移動方向及び移動速度を含む。実施の形態1において、ユーザ移動意図推定部20は、各移動方向における補正ハンドル荷重の値から、ユーザの移動意図を推定する。例えば、検知部13で検知されるFyの力が所定の第1閾値以上の値であり、Myの力が所定の第2閾値未満の値である場合、ユーザ移動意図推定部20は、ユーザの移動意図が直進動作であると推定してもよい。また、ユーザ移動意図推定部20は、Fz方向における補正ハンドル荷重の値に基づいて、移動速度を推定してもよい。一方、検知部13で検知されるFyの力が所定の第3閾値以上の値であり、Myの力が所定の第2閾値以上の値である場合、ユーザ移動意図推定部20は、ユーザの移動意図が右旋回動作であると推定してもよい。また、ユーザ移動意図推定部20は、Fz方向における補正ハンドル荷重の値に基づいて旋回速度を推定し、My方向における補正ハンドル荷重の値に基づいて旋回半径を推定してもよい。
駆動力算出部21は、手動モード及び誘導モードのそれぞれのモードにおける駆動力を算出する。手動モードでは、駆動力算出部21は、補正ハンドル荷重の情報から推定されたユーザの移動意図、即ちユーザの移動方向及び移動速度に基づいて、駆動力を算出する。例えば、ユーザの移動意図が前進動作又は後退動作である場合、2つの車輪17の回転量が均等になるように駆動力を算出する。ユーザの移動意図が右旋回動作である場合、2つの車輪17のうち右側の車輪17の回転量を左側の車輪17の回転量よりも大きくなるように駆動力を算出する。また、ユーザの移動速度に応じて、駆動力の大きさを算出する。誘導モードでは、駆動力算出部21は、モード切替部16で算出されたロボット1の誘導意図、即ちロボット1が自律的に移動してユーザを誘導する誘導方向及び誘導速度に基づいて駆動力を算出する。誘導意図に基づく駆動力の算出は、ユーザ移動意図に基づく駆動力の算出と同様であるため、説明を省略する。
アクチュエータ制御部22は、駆動力算出部21で算出された駆動力の情報に基づいて、アクチュエータ23の駆動制御を行う。また、アクチュエータ制御部22は、アクチュエータ23から車輪17の回転量の情報を取得し、駆動力算出部21及びユーザ荷重傾向抽出部30に車輪17の回転量の情報を送信することができる。
アクチュエータ23は、例えば、車輪17を回転駆動させるモータ等である。アクチュエータ23は、歯車機構又はプーリー機構等を介して車輪17と接続されている。アクチュエータ23は、アクチュエータ制御部22によって駆動制御されることによって、車輪17を回転駆動している。
荷重傾向データ生成部15は、過去に検知したハンドル荷重の情報に基づいて、ユーザの荷重傾向データを生成する。荷重傾向データとは、所定の動作におけるユーザのハンドル荷重の傾向を示すデータである。所定の動作とは、例えば、直進動作、後退動作、及び旋回動作等を意味する。例えば、腰の曲がったユーザは、ハンドル部12を把持した場合、ロボット1に寄りかかってしまうため、ロボット1が移動する道の歩行面に対して鉛直下方向へのハンドル荷重、即ちFzの力が大きくなる傾向がある。また、左右に揺れて歩行するユーザは、ハンドル部12を把持した場合、前進動作を行っているにも関わらず、左右方向へのハンドル荷重、即ちMyのモーメントが大きくなる傾向がある。このように、荷重傾向データ生成部15では、所定の動作毎のユーザの荷重傾向を過去の荷重データから生成している。
荷重傾向データ生成部15は、誘導モードにおける過去の荷重データ及び手動モードにおける過去の荷重データに基づいて、それぞれの支援モード毎に荷重傾向データを生成している。実施の形態1では、荷重傾向データ生成部15は、誘導モードにおける過去の荷重傾向データに基づいて、誘導モード時における荷重傾向データを生成している。誘導モードにおける過去の荷重傾向データは、ユーザがロボット1により誘導されているときの荷重データであるため、ユーザが意図的にハンドルに荷重をかけていない。したがって、誘導モードにおける過去の荷重傾向データからユーザの荷重傾向を把握しやすいというメリットがある。なお、誘導モードにおける荷重傾向データは、誘導モードにおける過去の荷重データ及び手動モードにおける過去の荷重データに基づいて生成されてもよい。あるいは、誘導モード時における荷重傾向データは、手動モードにおける過去の荷重傾向データに基づいて生成されてもよい。
モード切替部16は、ロボット1が誘導モードで移動しているときに、検知部13で検知したハンドル荷重に基づいて、支援モードを誘導モードから手動モードへ切り替える。例えば、誘導モードにおいて、ロボット1がユーザを直進方向(Fy方向)へ誘導しているとき、検知部13で右旋回方向(Mz方向)へのハンドル荷重を検知する。このとき、右旋回方向へのハンドル荷重の値が所定の閾値より大きい場合、ロボット1はユーザが誘導経路から外れて右旋回を行おうとしていると判断し、支援モードを誘導モードから手動モードに切り替える。なお、ロボット1において、支援モードの切替判定を行うために用いるハンドル荷重は、過去の荷重データに基づいて補正されたハンドル荷重である。ハンドル荷重の補正については、後述する。
[歩行支援ロボットの制御構成]
このような構成を有する歩行支援ロボット1において、ユーザの歩行支援をするための制御構成について説明する。図4は、ロボット1における主要な制御構成を示す制御ブロック図である。また、図4の制御ブロック図では、それぞれの制御構成と取り扱われる情報との関係についても示している。
モード切替部16の詳細について説明する。
図4に示すように、モード切替部16は、自己位置推定部24と、誘導意図算出部25と、誘導/手動モード切替判定部26と、を備える。
自己位置推定部24は、ロボット1の自己位置を推定する。自己位置推定部24は、例えば、外界センサを用いてロボット1の自己位置を推定する。
誘導意図算出部25は、誘導モードにおけるロボット1の誘導意図を算出する。誘導意図とは、ロボット1が自律的に移動を行ってユーザを誘導する誘導方向及び誘導速度を含む。誘導意図算出部25は、ユーザが入力した行き先情報と、自己位置推定部24で推定された自己位置情報と、ロボット1に格納された地図情報とに基づいて、誘導経路(出発地から目的地までの経路)を算出し、ロボット1の誘導意図(誘導方向、誘導速度)を算出する。
誘導/手動モード切替判定部26は、誘導モードにおいて、検知されたハンドル荷重に基づいて、支援モードを誘導モードから手動モードに切り替えるか否かを判定する。具体的には、誘導/手動モード切替判定部26は、誘導モードにおいて、荷重補正部19で補正されたハンドル荷重の値が所定の閾値より大きい場合に、支援モードを誘導モードから手動モードへの切替を行うことを判定する。
次に、歩行支援ロボットの制御について説明する。
図4に示すように、検知部13は、ハンドル部12にかかるハンドル荷重を検知する。検知部13で検知されたハンドル荷重の情報は、荷重補正部19に送信される。また、荷重補正部19は、現在の支援モードが誘導モードであるか手動モードであるかを示す誘導/手動モードの情報を、誘導/手動モード切替判定部26から取得する。荷重補正部19は、現在の支援モードの情報と荷重傾向データ生成部15で生成された荷重傾向データとに基づいて、検知部13で検知されたハンドル荷重の値を補正する。
ロボット1が手動モードで動作している場合、補正されたハンドル荷重(補正ハンドル荷重)の情報は、ユーザ移動意図推定部20に送信される。ユーザ移動意図推定部20は、補正ハンドル荷重の情報に基づいて、ユーザの移動意図(移動方向及び移動速度)を推定する。推定されたユーザの移動意図の情報は、駆動力算出部21へ送信される。
ロボット1が誘導モードで動作している場合、補正ハンドル荷重の情報は、誘導/手動モード切替判定部26に送信される。誘導/手動モード切替判定部26は、補正ハンドル荷重の情報に基づいて、支援モードを誘導モードから手動モードに切り替えるか否かの判定を行う。
誘導/手動モード切替判定部26において、支援モードを手動モードに切り替えた場合、ユーザ移動意図推定部20で推定されたユーザ移動意図の情報が、駆動力算出部21に送信される。駆動力算出部21は、推定されたユーザの移動意図の情報に基づいて、駆動力を算出する。
一方、誘導/手動モード切替判定部26において、誘導モードを維持した場合、誘導意図算出部25で算出されたロボット1の誘導意図の情報が、駆動力算出部21に送信される。駆動力算出部21は、算出された誘導意図の情報に基づいて、駆動力を算出する。
なお、誘導意図の情報は、ユーザにより入力される行き先情報と、自己位置推定部24により推定された自己位置情報と、地図情報とに基づいて誘導意図算出部25によって算出される。
算出された駆動力の情報は、アクチュエータ制御部22に送信される。アクチュエータ制御部22は、駆動力算出部21で算出された駆動力の情報に基づいてアクチュエータ23の駆動制御を行う。アクチュエータ23は、アクチュエータ制御部22に駆動制御されることによって、車輪17を回転駆動し、本体部11を移動させる。
また、図4に示すように、検知部13で検知されたハンドル荷重の情報は、荷重傾向データ生成部15にも送信される。検知部13で検知されたハンドル荷重の情報は、荷重傾向データを生成及び更新するためにも使用される。実施の形態1では、荷重傾向データ生成部15は、誘導モード及び手動モードのそれぞれの支援モードにおいて荷重傾向データを生成している。
ロボット1の歩行支援の詳細な制御について、図5を用いて説明する。図5は、ロボット1の歩行支援の詳細な制御構成を示す制御ブロック図である。
図5に示すように、ロボット1は、外界情報を取得する外界センサ27と、行き先情報を入力するインタラクション部28と、地図情報を記憶する記憶部29と、を備える。
外界センサ27は、外界情報を取得するセンサである。外界センサ27は、例えば、LRF(Laser Range Finder)、LIDAR(Laser Imaging Detection and Ranging)、カメラ、深度カメラ、ステレオカメラ、ソナー、RADARなどのセンサ、もしくはこれらの組合せによって構成され得る。外界センサ27で取得された情報は、自己位置推定部24に送信され、ロボット1の自己位置を推定するために使用される。
インタラクション部28は、ロボット1の誘導モードにおいて、ユーザが誘導して欲しい行き先情報を入力する部分である。インタラクション部28は、例えば、音声入力、タッチパネルなどで構成され得る。インタラクション部28で入力された行き先情報は、誘導意図算出部25に送信され、誘導経路及び誘導意図を算出するために使用される。なお、行き先情報とは、例えば、目的地、到着時間、誘導経路、及び目的(例えば、食事、就寝など)などを含む。
記憶部29は、地図情報を記憶する部分である。記憶部29は、誘導モードにおいてユーザを誘導するための誘導経路を示す経路情報を格納している。記憶部29に記憶されている地図情報は、予め入力されていてもよいし、外界センサ27を用いて作成されてもよい。なお、地図情報の作成は、SLAM技術を用いて行うことができる。記憶部29に記憶されている地図情報は、誘導意図算出部25に送信され、誘導意図を算出するために使用される。また、記憶部29に記憶されている地図情報は、荷重傾向データ生成部15へ送信される。
誘導モードに設定する場合のモード切替部16の制御について説明する。
インタラクション部28は、ユーザが入力した行き先情報を取得し、誘導意図算出部25に行き先情報を送信する。次に、自己位置推定部24が外界センサ27から取得した外界情報に基づいて、ロボット1の自己位置を推定する。自己位置推定部24は、推定した自己位置情報を誘導意図算出部25に送信する。
誘導意図算出部25は、記憶部29から地図情報を読み出す。誘導意図算出部25は、ユーザの入力した行き先情報と、ロボット1の自己位置情報と、記憶部29から読み出された地図情報とに基づいて、誘導経路を算出し、且つ誘導意図(誘導方向及び誘導速度)を算出する。誘導意図算出部25は、算出した誘導意図の情報を駆動力算出部21に送信する。
駆動力算出部21は、誘導意図に基づいて駆動力を算出する。次に、算出された駆動力に基づいて、アクチュエータ制御部22がアクチュエータ23を制御することによって、回転体(車輪)17を回転駆動する。
次に、荷重傾向データ生成部15の詳細について説明する。
荷重傾向データ生成部15は、ユーザの荷重傾向を抽出するユーザ荷重傾向抽出部30と、ユーザの荷重傾向データを記憶した荷重傾向マップ31と、を備える。
ユーザ荷重傾向抽出部30は、ユーザの移動方向/誘導方向に対応するユーザの荷重傾向を抽出する。具体的には、ユーザ荷重傾向抽出部30は、ユーザの移動方向/誘導方向に対応するユーザの荷重傾向データを荷重傾向マップ31から抽出する。例えば、手動モードにおいて、ユーザの移動方向が前方向前進である場合、ユーザ荷重傾向抽出部30は、荷重傾向マップ31から手動モードにおける前方向直進に対応するユーザの荷重傾向を抽出する。あるいは、誘導モードにおいて、ロボット1の誘導方向が前方向直進である場合、ユーザ荷重傾向抽出部30は、荷重傾向マップ31から誘導モードにおける前方向直進に対応するユーザの荷重傾向を抽出する。ユーザ荷重傾向抽出部30は、荷重傾向マップ31から抽出した荷重傾向データを荷重補正部19に送信する。
また、ユーザ荷重傾向抽出部30は、検知部13で検知されたハンドル荷重の情報とアクチュエータ制御部22で取得された車輪17の回転量の情報とに基づいて、ユーザの荷重傾向データを生成する。生成された荷重傾向データは、荷重傾向マップ31に送信される。これにより、荷重傾向マップ31の荷重傾向データが更新される。実施の形態1では、荷重傾向データは、誘導モードと手動モードとにそれぞれ分けて生成される。
荷重傾向マップ31は、支援モード毎のユーザ移動方向/誘導方向におけるユーザの荷重傾向データを記憶しているデータベースである。即ち、荷重傾向マップ31は、誘導モード及び手動モードにおける前方向直進、後方向直進、右方向旋回などの移動動作毎に荷重傾向データを記憶している。図6は、荷重傾向マップ31を示す。図6に示すように、実施の形態1では、荷重傾向マップ31は、ユーザの荷重傾向データとして、歩行時の移動方向/誘導方向の揺らぎ周波数及び歩行時の重心の偏り方向の揺らぎ周波数を記憶している。また、荷重傾向マップ31は、過去に算出した揺らぎ周波数のデータを記憶していてもよい。
図6には図示していないが、荷重傾向マップ31は、ロボット1の使用場所、使用時間、及びユーザの体調などのデータを記憶していてもよい。また、荷重傾向マップ31は、出発地、目的地、誘導経路、誘導時間などの過去のデータを記録していてもよい。これらのデータは、ハンドル荷重の補正の計算、又は誘導モードから手動モードに切り替える所定の閾値の設定などに使用されてもよい。
[荷重傾向データの生成]
荷重傾向データの生成について、図7を用いて説明する。図7は、荷重傾向データの生成処理の例示的なフローチャートを示す。
図7に示すように、ステップST1において、検知部13によりハンドル荷重を検知したか否かを判定する。ステップST1では、ユーザがハンドル部12を把持しているか否かを判定している。検知部13でハンドル荷重を検知した場合、ステップST2へ進む。検知部13でハンドル荷重を検知しない場合、ステップST1を繰り返す。
ステップST2において、ユーザ荷重傾向抽出部30が誘導/手動モード切替判定部26から現在の支援モードの情報を取得する。具体的には、ユーザ荷重傾向抽出部30は、ロボット1の現在の支援モードが、誘導モードであるか手動モードであるかを判定する。
ステップST3において、ユーザ荷重傾向抽出部30は、現在の支援モードの情報と、車輪17の回転量の情報とに基づいてユーザの移動方向を推定する、又は誘導方向を算出する。具体的には、ステップST1でハンドル荷重の変化が検知されると、ユーザ荷重傾向抽出部30は、誘導/手動モード切替判定部26から現在の支援モードの情報を取得する。これにより、ユーザ荷重傾向抽出部30は、現在の支援モードが誘導モードであるか、手動モードであるかを判定する。次に、アクチュエータ制御部22が車輪17の回転量の情報を取得する。アクチュエータ制御部22で取得された回転量の情報は、ユーザ荷重傾向抽出部30に送信される。ユーザ荷重傾向抽出部30は、車輪17の回転量の情報、即ち車輪の回転方向及び回転数に基づいて、手動モードであればユーザの移動方向を推定し、誘導モードであれば誘導方向を算出する。
実施の形態1では、ユーザ荷重傾向抽出部30は、左右に配置される2つの車輪17の回転量に基づいて、ユーザの移動方向を推定する。例えば、ユーザ荷重傾向抽出部30は、右側の車輪17の回転量が左側の車輪17の回転量よりも多い場合、ユーザが左方向に旋回していると推定してもよい。また、ユーザ荷重傾向抽出部30は、左右の車輪17の回転数が同じであり、前方向に回転している場合、ロボット1が直進動作を行っていると推定してもよい。なお、誘導方向については、誘導意図算出部25又は自己位置推定部24から算出してもよい。
ステップST4において、ユーザ荷重傾向抽出部30は、推定したユーザの移動方向/算出した誘導方向におけるハンドル荷重の波形情報を取得する。ユーザの移動方向におけるハンドル荷重の波形情報とは、特に限定されないが、例えば、ユーザの移動方向がFy方向である場合、Fz方向のハンドル荷重の波形情報又はMy方向のモーメントの波形情報などであってもよい。
ステップST5において、ユーザ荷重傾向抽出部30は、取得したハンドル荷重の波形情報と、過去のハンドル荷重の波形情報とを合算する。例えば、過去の波形情報は、荷重傾向マップ31に記憶されている。ユーザ荷重傾向抽出部30は、荷重傾向マップ31から過去の波形情報を読み出し、取得した現在の波形情報を過去の波形情報に加算する。図8は、ハンドル荷重の入力波形情報の一例を示す。図8に示すように、これまでに検知したハンドル荷重の波形情報が、荷重傾向マップ31に格納される。
ステップST6において、ユーザ荷重傾向抽出部30は、合算した波形情報に基づいて揺らぎ周波数を算出する。具体的には、ユーザ荷重傾向抽出部30は、推定したユーザの移動方向/算出した誘導方向におけるハンドル荷重の周波数解析を行うことにより、揺らぎ周波数を算出する。
一例として、誘導モードにおいて身体能力の低いユーザが前方向に誘導されている場合の揺らぎ周波数の算出について説明する。図9Aは、誘導モードにおいてユーザの直進動作時のFz方向における荷重データの波形情報の一例を示す。図9Bは、図9Aに示すFz方向の荷重データの周波数成分を示す。図10Aは、誘導モードにおいてユーザの直進動作時のMy方向における荷重データの波形情報の一例を示す。図10Bは、図10Aに示すMy方向における荷重データの周波数成分を示す。なお、図9Aは3歩分の荷重データの波形であるが、実際は10数歩分の荷重データの波形に対し周波数解析するものである。
身体能力の低いユーザは、左右に揺れながら歩行するため、ロボット1が一定の速度で前方向に直進移動していても、ハンドル荷重が安定しない。そのため、図9Aに示すように、ロボット1の高さ方向、即ちFz方向における荷重データの波形情報に揺らぎが生じる。揺らぎとは、波形情報が変動して安定していない成分を意味し、具体的には、荷重データの平均値からの変動を意味する。
この場合、ユーザは前方向直進を意図しているにもかかわらず、ロボット1が左右方向に移動するため、ユーザは細かく進行方向を左右に調整しながら歩行することになる。実施の形態1では、ユーザ荷重傾向抽出部30は、左右に揺れながら歩行するユーザであると推定し、ハンドル荷重を補正するために、荷重の揺らぎ成分を荷重傾向データとして使用する。以下、ユーザ荷重傾向抽出部30の処理の例について説明する。
ユーザ荷重傾向抽出部30は、図9Aに示すFz方向における荷重データの波形情報に対して周波数解析を行い、図9Bに示すような荷重データの周波数成分を算出する。これにより、ユーザ荷重傾向抽出部30は、誘導モードにおいてユーザが前方向直進している時、図9Bに示すように、Fz方向に2Hzの揺らぎ周波数があることを特定することができる。
また、図10Aに示すように、身体能力の低いユーザのMy方向における荷重データの波形情報にも揺らぎが生じる。ユーザ荷重傾向抽出部30は、図10Aに示すMy方向における荷重データに対して周波数解析を行い、図10Bに示すような荷重データの周波数成分を算出する。これにより、ユーザ荷重傾向抽出部30は、誘導モードにおいてユーザが前方向に誘導されている時、図10Bに示すように、My方向に2Hzの揺らぎ周波数があることを特定することができる。
別の例として、身体能力の低いユーザの右方向旋回時における揺らぎ周波数の算出について説明する。図11Aは、誘導モードにおいてユーザの右方向旋回時のFz方向における荷重データの波形情報の一例を示す。図11Bは、図11Aに示すFz方向における荷重データの周波数成分を示す。
図11Aに示すように、誘導モードにおいて身体能力の低いユーザが右方向に旋回しているときも、Fz方向における荷重データの波形情報に揺らぎが生じている。ユーザ荷重傾向抽出部30は、図11Aに示すFz方向における荷重データに対して周波数解析を行い、図11Bに示すような荷重データの周波数成分を算出する。ユーザ荷重傾向抽出部30は、誘導モードにおいてユーザが右方向旋回をしている時、図11Bに示すように、Fz方向に6Hzの揺らぎ周波数があることを特定することができる。
このように、ステップST6において、ユーザ荷重傾向抽出部30は、推定したユーザの移動方向/算出した誘導方向における合算したハンドル荷重の波形情報から揺らぎ周波数を算出する。
図7に戻って、ステップST7において、ユーザ荷重傾向抽出部30は、ステップST6で算出した揺らぎ周波数を荷重傾向データとして設定する。具体的には、ユーザ荷重傾向抽出部30は、荷重傾向マップ31のユーザの荷重傾向データをステップST6で算出した揺らぎ周波数に更新する。
このように、実施の形態1では、ステップST1〜ST7の処理を行うことによって、ユーザのハンドル荷重の揺らぎ周波数を算出し、揺らぎ周波数を荷重傾向データとして使用することができる。また、実施の形態1では、移動動作毎に荷重傾向データの生成を行うことができる。
なお、ステップST5及びST6において、取得したハンドル荷重の波形情報と、過去のハンドル荷重の波形情報とを合算した波形情報に基づいて算出された揺らぎ周波数を荷重傾向データとして設定する例について説明したが、これに限定されない。例えば、過去の波形情報に基づいて算出された揺らぎ周波数に、取得したハンドル荷重の波形情報に基づいて算出された揺らぎ周波数を加算した後、平均計算を行い、算出された揺らぎ周波数の平均値を荷重傾向データとして使用してもよい。また、取得したハンドル荷重の波形情報から算出した揺らぎ周波数と、過去の揺らぎ周波数と、に基づいて揺らぎ周波数の中央値又は最頻値を算出し、揺らぎ周波数の中央値又は最頻値を荷重傾向データとして使用してもよい。また、揺らぎ周波数の平均値、中央値、及び最頻値を組み合わせて、荷重傾向データとして使用してもよい。あるいは、直近で算出した揺らぎ周波数を荷重傾向データとして使用してもよい。上述した荷重傾向データは、状況や目的に応じて使い分けてもよい。例えば、荷重傾向マップ31に記憶されている過去の揺らぎ周波数のデータが少ないユーザに対しては、直近で算出した揺らぎ周波数を荷重傾向データとして使用してもよい。反対に、荷重傾向マップ31に記憶されている過去の揺らぎ周波数のデータが多いユーザに対しては、揺らぎ周波数の平均値、中央値、又は最頻値を荷重傾向データとして使用してもよい。
[ユーザの移動意図の推定]
ユーザの移動意図の推定について、図12を用いて説明する。図12は、ユーザの移動意図の推定処理の例示的なフローチャートを示す。
図12に示すように、ステップST11において、荷重補正部19が、検知部13で検知されたハンドル荷重の情報を取得する。
ステップST12において、ユーザ荷重傾向抽出部30が、誘導/手動モード切替判定部26から誘導/手動モードの情報を取得する。具体的には、ユーザ荷重傾向抽出部30は、誘導/手動モード切替判定部26から現在の支援モードの情報を取得する。
ステップST13において、現在の支援モードが手動モードであるか否かを判定する。ステップST13では、ロボット1が誘導モードで動作している場合に、手動モードに切替するか否かの判定を行う。現在の支援モードが手動モードである場合、ステップST13へ進む。現在の支援モードが手動モードでない場合、即ち誘導モードを維持する場合、ステップST11へ戻る。なお、誘導モードから手動モードへの切替の判定処理については、後述する。
ステップST14において、ユーザ荷重傾向抽出部30が、荷重傾向マップ31からユーザの荷重傾向データを取得する。具体的には、ユーザ荷重傾向抽出部30が、ユーザの現在の移動方向の対象となる揺らぎ周波数を荷重傾向マップ31から取得する。ユーザ荷重傾向抽出部30は、揺らぎ周波数の情報を荷重傾向データとして荷重補正部19へ送信する。なお、ユーザの現在の移動方向は、アクチュエータ制御部22から車輪17の回転量の情報を取得することによって推定することができる。
ステップST15において、荷重補正部19は、ステップST11で取得したハンドル荷重から、ステップST13で取得した揺らぎ周波数成分をフィルタリングする。これにより、荷重補正部19は、検知部13で検知したハンドル荷重の値を補正する。荷重補正部19で得られた補正ハンドル荷重の情報は、ユーザ移動意図推定部20に送信される。なお、荷重補正部19は、誘導モード及び手動モードのうち少なくとも一方のモードにおける荷重傾向データを用いてハンドル荷重を補正してもよい。また、荷重補正部19は、誘導モード及び手動モードの荷重傾向データを組み合わせてハンドル荷重を補正してもよい。
また、荷重補正部19は、ロボット1の使用場所、使用時間、及びユーザの体調に基づいて、ハンドル荷重の値を補正してもよい。この場合、ユーザ荷重傾向抽出部30が、荷重傾向マップ31からロボット1の使用場所、使用時間、及びユーザの体調に関するデータを抽出し、これらのデータを荷重補正部19へ送信する。例えば、荷重補正部19は、ロボット1を廊下で使用する場合やユーザの体調が良い場合のハンドル荷重に比べて、ロボット1をリビングで使用する場合やユーザの体調が悪い場合のハンドル荷重を小さくなるようにハンドル荷重の補正を行ってもよい。
ステップST16において、ユーザ移動意図推定部20は、ステップST15で取得した補正ハンドル荷重に基づいて、ユーザの移動意図を推定する。具体的には、ユーザ移動意図推定部20は、補正ハンドル荷重のFx、Fy、Fz、Mx、My、Mz方向の力の大きさに基づいて、ユーザの移動方向及び移動速度を推定する。
このように、実施の形態1では、ステップST11〜ST16の処理を行うことによって、ユーザのハンドル荷重の波形情報から揺らぎ周波数成分をフィルタリングし、得られた補正ハンドル荷重の情報に基づいてユーザの移動意図を推定している。なお、誘導モードにおいて、ユーザの移動意図を推定してもよい。この場合、ステップST13を省略してもよい。
実施の形態1において、フィルタリングとして、揺らぎ成分を全て除去するように揺らぎ部分に該当する周波数成分を全てカットするような補正を行ってもよいし、歩行時の荷重データに対して、揺らぎ成分の割合を減らすような補正を行ってもよい。
また、荷重補正部19は、ユーザの荷重傾向データだけで補正をするのではなく、ユーザの荷重傾向データと、複数ユーザの平均の荷重傾向データとを比較し、差分部分を低減するように補正の割合を変化させてもよい。複数ユーザの平均の算出方法としては、年代、性別、場所、歩行能力(歩行速度、歩行率、歩幅、立位姿勢、左右の揺れ)等の組み合わせで分類されたグループ毎に作成してもよい。
一例として、身体能力の低いユーザの移動意図の推定処理について説明する。図13Aは、手動モードにおけるユーザの直進動作時のFz方向における荷重データの波形情報の一例を示す。図13Bは、図13Aに示すFz方向における荷重データの波形情報から揺らぎ周波数成分をフィルタリングした波形情報を示す。図14Aは、手動モードにおけるユーザの直進動作時のMy方向における荷重データの波形情報の一例を示す。図14Bは、図14Aに示すMy方向における荷重データの波形情報から揺らぎ周波数成分をフィルタリングした波形情報を示す。なお、図13A及び図14Aに示す波形情報は、ステップST11で取得したハンドル荷重の波形情報である。図13B及び図14Bに示す波形情報は、ステップST14で揺らぎ周波数成分をフィルタリングして得られた補正ハンドル荷重の波形情報である。
図13Aに示すように、身体能力の低いユーザは、歩行が安定しないため、直進動作時のFz方向における荷重データの波形情報に揺らぎが生じている。即ち、ユーザの直進動作時において、検知部13で検知されるFz方向におけるハンドル荷重の値は、変動している。荷重補正部19は、検知部13で取得したFz方向のハンドル荷重の波形情報から、揺らぎ周波数成分をフィルタリングする。これにより、図13Bに示すように、直進動作時のFz方向におけるハンドル荷重の波形情報の揺らぎをカットすることができる。こえにより、ユーザ移動意図推定部20は、この補正されたハンドル荷重に基づいて、ユーザの移動意図が直進動作であることを容易に推定することができる。
また、図14Aに示すように、手動モードにおける身体能力の低いユーザの直進動作時のMy方向における荷重データの波形情報にも揺らぎが生じている。即ち、ユーザの直進動作時において、検知部13で検知されるMy方向におけるハンドル荷重の値は、変動している。荷重補正部19は、検知部13で取得したMy方向のハンドル荷重の波形情報から、揺らぎ周波数成分をフィルタリングする。これにより、図14Bに示すように、手動モードにおける直進動作時のMy方向におけるハンドル荷重の波形情報の揺らぎをカットすることができる。これにより、ユーザ移動意図推定部20は、この補正されたハンドル荷重に基づいて、ユーザの移動意図が直進動作であることを容易に推定することができる。
また、ユーザ移動意図推定部20は、旋回時における旋回半径を推定してもよい。例えば、足腰の弱いユーザに対しては、旋回半径を通常よりも大きくとることによって、ロボット1が緩やかに旋回してもよい。反対に、足腰の強いユーザに対しては、旋回半径を通常よりも小さくして急旋回してもよい。旋回半径の推定は、例えば、補正ハンドル荷重の値から推定する。
また、ユーザ移動意図推定部20は、アクチュエータ制御部22から車輪17の回転量の情報を取得し、回転量の情報と補正ハンドル荷重の情報とに基づいて、ユーザの移動意図を推定してもよい。
[誘導/手動モード切替判定処理]
ロボット1の誘導/手動モード切替判定処理について、図15を用いて説明する。図15は、誘導/手動モード切替判定処理の例示的なフローチャートを示す。
図15に示すように、ステップST21において、誘導/手動モード切替判定部26は、誘導意図算出部25から誘導経路を取得したか否かを判定する。具体的には、誘導/手動モード切替判定部26は、ロボット1が誘導経路上に位置しているかを判定する。誘導/手動モード切替判定部26が誘導経路を取得した場合、ステップST22へ進む。誘導/手動モード切替判定部26が誘導経路を取得していない場合、ステップST25へ進み、手動モードに切り替える。即ち、誘導/手動モード切替判定部26が誘導経路を取得していない場合、ロボット1が誘導経路に沿ってユーザを目的地に誘導していないと判断し、手動モードに切り替える。
ステップST22において、検知部13がハンドル荷重情報を取得する。
ステップST23において、荷重補正部19が、検知部13で取得したハンドル荷重の値を補正する。ハンドル荷重の補正は、ステップST24とステップST25とを行う。
ステップST24において、ユーザ荷重傾向抽出部30が、現在の誘導方向の対象となる揺らぎ周波数を荷重傾向マップ31から取得する。ユーザ荷重傾向抽出部30は、揺らぎ周波数の情報を荷重傾向データとして荷重補正部19へ送信する。なお、現在の誘導方向は、アクチュエータ制御部22から車輪17の回転量の情報を取得することによって推定することができる。
ステップST25において、荷重補正部19は、ステップST22で取得したハンドル荷重から、ステップST24で取得した揺らぎ周波数成分をフィルタリングする。これにより、荷重補正部19は、検知部13で検知したハンドル荷重の値を補正する。荷重補正部19で得られた補正ハンドル荷重の情報は、誘導/手動モード切替判定部26に送信される。
また、荷重補正部19は、ロボット1の使用場所、使用時間、及びユーザの体調に基づいて、ハンドル荷重の値を補正してもよい。この場合、ユーザ荷重傾向抽出部30が、荷重傾向マップ31からロボット1の使用場所、使用時間、及びユーザの体調に関するデータを抽出し、これらのデータを荷重補正部19へ送信する。例えば、荷重補正部19は、ロボット1を廊下で使用する場合やユーザの体調が良い場合のハンドル荷重に比べて、ロボット1をリビングで使用する場合やユーザの体調が悪い場合のハンドル荷重を小さくなるようにハンドル荷重の補正を行ってもよい。
ステップST26において、誘導/手動モード切替判定部26は、ステップST23で補正したハンドル荷重の値が所定の閾値より大きいか否かを判定する。補正したハンドル荷重の値が所定の閾値より大きい場合、ステップST27へ進み、支援モードを誘導モードから支援モードに切り替える。一方、補正したハンドル荷重の値が所定の閾値以下の場合、ステップST28へ進み、誘導モードを維持する。
また、支援モード切替のための所定の閾値は、ロボット1の使用状況、使用時間、使用場所に応じて変更してもよい。例えば、ユーザが誘導モードを利用して廊下を移動しているとき、ユーザがトイレに頻繁に寄る傾向がある場合、廊下における所定の閾値を低くしておくことで、手動モードに容易に切り替え可能にしてもよい。また、誘導に従いやすいユーザの所定の閾値を低くし、誘導に従いにくいユーザの所定の閾値を高くしてもよい。
なお、ステップST26においては、補正ハンドル荷重の値が所定の閾値より大きい状態が所定の時間継続している場合に支援モードの切替を行ってもよい。このような構成により支援モードの切替をより適切に行うことができる。例えば、ユーザが意図せずに瞬間的にハンドルに荷重をかけた場合に、誘導モードを維持することができる。
[ロボットの誘導経路及び誘導意図の算出]
ロボット1の誘導経路及び誘導意図の算出について、図16を用いて説明する。図16は、ロボット1の誘導経路の算出処理の例示的なフローチャートを示す。
図16に示すように、ステップST31において、誘導意図算出部25は、インタラクション部28から、ユーザの行き先情報を取得したか否かを判定する。具合的には、誘導意図算出部25は、ユーザが行き先情報をインタラクション部28に入力したか否かを判定する。誘導意図算出部25が行き先情報を取得した場合、ステップST32へ進む。誘導意図算出部25が行き先情報を取得していない場合、ステップST31を繰り返す。
ステップST32において、誘導意図算出部25は、自己位置推定部24から、ロボット1の自己位置情報を取得したか否かを判定する。誘導意図算出部25が自己位置情報を取得した場合、ステップST33へ進む。誘導意図算出部25が自己位置情報を取得していない場合、ステップST32を繰り返す。
ステップST33において、誘導意図算出部25は、ステップST31で取得した行き先情報と、ステップST32で取得した自己位置情報と、記憶部29に格納された地図情報とに基づいて、誘導経路(出発地から目的地までの経路)を算出し、誘導意図(誘導方向、誘導速度)を算出する。
[駆動力の算出]
駆動力の算出について、図17を用いて説明する。図17は、駆動力の算出処理の例示的なフローチャートを示す。
図17に示すように、ステップST41において、駆動力算出部21は、誘導/手動モード切替判定部26から誘導/手動モード情報を取得する。
ステップST42において、駆動力算出部21は、ロボット1の支援モードが誘導モードであるか否かを判定する。支援モードが誘導モードである場合、ステップST43へ進む。一方、支援モードが誘導モードではない場合、即ち手動モードである場合、ステップST46へ進む。
ステップST43において、駆動力算出部21は、誘導意図算出部25から誘導意図の情報を取得する。
ステップST44において、駆動力算出部21は、アクチュエータ制御部22から車輪17の回転量の情報を取得する。
ステップST45において、駆動力算出部21は、ステップST43で取得した誘導意図の情報と車輪17の回転量の情報とに基づいて駆動力を算出する。具体的には、駆動力算出部21は、車輪17の回転量の情報から算出された現在の移動方向及び移動速度と、誘導意図の情報から推定された誘導方向及び誘導速度との差分に基づき、車輪17の回転量を算出する。
ステップST46において、駆動力算出部21は、ユーザ移動意図推定部20からユーザ移動意図の情報を取得する。
ステップST47において、駆動力算出部21は、アクチュエータ制御部22から車輪17の回転量の情報を取得する。
ステップST48において、駆動力算出部21は、ステップST46で取得したユーザ移動意図の情報と車輪17の回転量の情報とに基づいて駆動力を算出する。具体的には、駆動力算出部21は、車輪17の回転量の情報から算出された現在の移動方向及び移動速度と、ユーザ移動意図の情報から推定された移動方向及び移動速度との差分に基づき、車輪17の回転量を算出する。
一例として、手動モードにおいて、ロボット1が前進方向に71cm/sの移動速度で移動している状態のとき、ユーザがFyの力を大きくして移動速度を77cm/sまで加速させる場合の駆動力算出部21の動作を説明する。駆動力算出部21は、前進方向に速度71cm/sで移動している状態において、左右両方の車輪17の回転量が2000rpmであることを示す情報を取得する。次に、駆動力算出部21は、ロボット1の移動速度を77cm/sにするために、左右両方の車輪17の回転量が2500rpm必要であることを算出する。駆動力算出部21は、左右の車輪17の回転量を500rpm大きくするように駆動力を算出する。
なお、実施の形態1では、駆動力算出部21は、ユーザの移動意図又は誘導意図の情報とアクチュエータ制御部22から取得した車輪17の回転量の情報とに基づいて、駆動力を算出する例について説明したが、これに限定されない。例えば、駆動力算出部21は、ユーザの移動意図又は誘導意図の情報のみから駆動力を算出してもよい。即ち、駆動力の算出処理において、ステップST44及びステップST47を含まなくてもよい。
また、駆動力算出部21は、ハンドル荷重と車輪17の回転量との対応関係を示す制御テーブルに基づいて、駆動力を算出してもよい。具体的には、駆動力算出部21は、ハンドル荷重と車輪17の回転量との対応関係を示す制御テーブルを格納する記憶部を備えてもよい。駆動力算出部21は、この記憶部に格納された制御テーブルを用いて、検知部13で検知されたハンドル荷重の値に対応する車輪17の回転量を算出してもよい。また、制御テーブルは、ユーザ荷重傾向抽出部30から抽出した荷重傾向データに基づいて、制御テーブルにおけるハンドル荷重の値を修正することによって更新されてもよい。
[効果]
実施の形態1に係る歩行支援ロボット1によれば、以下の効果を奏することができる。
実施の形態1に係る歩行支援ロボット1によれば、ハンドル荷重値を用いて支援モードの切替を行うことができるため、より快適なユーザの歩行支援を実現することができる。
ロボット1によれば、ユーザの荷重傾向データに基づいて、ハンドル荷重の値を補正することができる。このような構成により、ロボット1は、ユーザの荷重傾向に応じてハンドル荷重の値を補正することができる。このため、ロボット1によれば、ユーザの身体能力に応じて支援モードの切替を適切に行うことができる。
例えば、左右に揺れて歩行する傾向があるユーザに対しては、ハンドル荷重から左右の揺れに起因する揺らぎの周波数をカットすることによって、ハンドル荷重の値を補正する。このように、ユーザの身体能力に応じて、ハンドル荷重の値を補正することができる。これにより、ユーザの身体能力に応じて、ロボット1の支援モードの切替を行うことができるため、より快適なユーザの歩行支援を実現することができる。
実施の形態1では、荷重傾向データとしてハンドル荷重の揺らぎ周波数を使用している。揺らぎ周波数を用いることによって、ロボット1は、ハンドル荷重の波形情報に表れる凹凸の小さい揺らぎから凹凸の大きい揺らぎまで広い範囲でユーザの荷重傾向データを取得して、ハンドル荷重を補正することができる。これにより、ロボット1は、よりユーザの身体能力に応じた歩行支援を行うことができる。
なお、実施の形態1において、荷重傾向データ生成部15、荷重補正部19、ユーザ移動意図推定部20、駆動力算出部21、及びアクチュエータ制御部22、自己位置推定部24、誘導意図算出部25、誘導/手動モード切替判定部26は、例えば、これらの要素を機能させるプログラムを記憶したメモリ(図示せず)と、CPU(Central Processing Unit)などのプロセッサに対応する処理回路(図示せず)を備え、プロセッサがプログラムを実行することでこれらの要素として機能してもよい。あるいは、荷重傾向データ生成部15、荷重補正部19、ユーザ移動意図推定部20、駆動力算出部21、及びアクチュエータ制御部22、自己位置推定部24、誘導意図算出部25、誘導/手動モード切替判定部26は、これらの要素を機能させる集積回路を用いて構成してもよい。
実施の形態1では、歩行支援ロボット1の動作を主として説明したが、これらの動作は、歩行支援方法として実行することもできる。
実施の形態1では、移動方向/誘導方向及びモーメント方向において、それぞれ揺らぎ周波数を設定する例について説明したが、これに限定されない。例えば、すべての方向において、共通の揺らぎ周波数を設定してもよい。これにより、簡易的にハンドル荷重を補正することができる。
実施の形態1では、2つの車輪17の回転量をそれぞれ設定することにより、ロボット1の前進動作、後退動作、右旋回動作、左旋回動作などを制御する例について説明したが、これに限定されない。例えば、ブレーキ機構などによって、車輪17の回転量を制御し、ロボット1の動作を制御してもよい。
実施の形態1では、誘導/手動モード切替判定部26は、補正ハンドル荷重を所定の閾値と比較することによって、支援モードの切替判定を行う例について説明したが、これに限定されない。例えば、ステップST22で取得したハンドル荷重と、所定の閾値とを比較することによって、支援モードの切替判定を行ってもよい。即ち、ロボット1は、検知部13で取得したハンドル荷重を補正せずに、取得したハンドル荷重と所定の閾値とを比較することにより、支援モードの切替判定を行ってもよい。
また、誘導/手動モード切替判定部26は、ロボットの誘導意図に対して異なる歩行意図の荷重値が入力された場合に支援モードを切り替えてもよい。また、誘導/手動モード切替判定部26は、ロボットの誘導意図に対して異なる歩行意図の荷重値が一定時間以上入力された場合に支援モードを切り替えてもよい。
実施の形態1では、荷重補正部19は、ロボット1の移動動作に対応する荷重傾向データが所定の閾値以上になった場合、荷重傾向データに基づいて検知部13で検知されたハンドル荷重の値を補正(フィルタリング)してもよい。例えば、ロボット1の直進動作(Fy方向に前進動作)において、Mz方向の荷重傾向データ(揺らぎ周波数)が0Hzの閾値以上になった場合、ロボット1の直進動作に対応する荷重データを荷重傾向データに基づいて補正してもよい。このような構成により、ロボット1の直進動作において不要なMz方向の揺らぎ周波数をフィルタリングすることができる。なお、所定の閾値は、ユーザの身体能力などに応じて変更してもよい。例えば、所定の閾値は、健常者では揺らぎ周波数が1Hzで生じるという情報をもとに1Hzに変更してもよい。また、ロボット1の移動動作に対応する荷重傾向データとは、ロボット1の移動方向と同じ方向の荷重傾向データであってもよいし、ロボット1の移動方向と異なる方向の荷重傾向データであってもよい。例えば、他のユーザの荷重傾向データを所定の閾値とした場合、ロボット1の移動動作に対応する移動方向と同一の移動方向において、ユーザの荷重傾向データと、他のユーザの荷重傾向データとを比較してもよい。
実施の形態1では、誘導/手動モード切替判定部26が、誘導モードにおいて、荷重補正部19で補正されたハンドル荷重の値が所定の閾値より大きい場合に、支援モードを誘導モードから手動モードへの切替を行うことを判定する例について説明したが、これに限定されない。例えば、誘導/手動モード切替判定部26は、ユーザの移動意図と、ロボットの誘導意図とに基づいて支援モードの切替を判定してもよい。以下、実施の形態1の誘導/手動モード切替判定処理の別の例について説明する。
[誘導/手動モード切替判定処理の別の例]
図18は、歩行支援ロボットの歩行支援の別の制御構成を示す制御ブロック図である。図18に示すように、誘導/手動モード切替判定部26は、ユーザ移動意図推定部20で推定されたユーザ移動意図(移動速度、移動方向)と、誘導意図算出部25で算出された誘導意図(誘導速度、誘導方向)と、に基づいて、支援モードの切替を判定してもよい。具体的には、誘導/手動モード切替判定部26は、ユーザ移動意図と誘導意図との差分が所定の閾値を超えたか否かに基づいて、支援モードの切替を判定してもよい。
図19は、誘導/手動モード切替判定処理の例示的な別のフローチャートである。図19に示すように、ステップST21aにおいて、誘導/手動モード切替判定部26は、誘導意図算出部25から誘導経路を取得したか否かを判定する。具体的には、誘導/手動モード切替判定部26は、ロボット1が誘導経路上に位置しているかを判定する。誘導/手動モード切替判定部26が誘導経路を取得した場合、ステップST22aへ進む。誘導/手動モード切替判定部26が誘導経路を取得していない場合、ステップST25aへ進み、手動モードに切り替える。即ち、誘導/手動モード切替判定部26が誘導経路を取得していない場合、ロボット1が誘導経路に沿ってユーザを目的地に誘導していないと判断し、手動モードに切り替える。
ステップST22aにおいて、誘導/手動モード切替判定部26は、ユーザ移動意図推定部20からユーザ移動意図(移動速度、移動方向)を取得する。
ステップST23aにおいて、誘導/手動モード切替判定部26は、誘導意図算出部25から誘導意図(誘導速度、誘導方向)を取得する。
ステップST24aにおいて、誘導/手動モード切替判定部26は、ステップST22aで取得したユーザ移動意図とステップST23aで取得した誘導意図との差分が、所定の閾値より大きいか否かを判定する。差分が所定の閾値より大きい場合、ステップST25aへ進み、支援モードを誘導モードから支援モードに切り替える。一方、差分が所定の閾値以下の場合、ステップST26aへ進み、誘導モードを維持する。
ユーザ移動意図と誘導意図との差分とは、例えば、ユーザの移動速度とロボットの誘導速度との差分、ユーザの移動方向とロボットの誘導方向との差分などを含む。なお、差分は、これらに限定されず、ユーザ移動意図とロボットの誘導意図とが同じであるか否かがわかるパラメータであればよい。
実施の形態1において、移動動作毎、誘導、手動のモード毎の荷重傾向データを用いて補正を行う場合、誘導モード時の荷重値を手動モード時の荷重傾向データで補正を行ってもよい。誘導モード時の荷重値を、誘導モード時の荷重傾向データで補正を行ってもよい。手動モード時の荷重値を、手動モード時の荷重傾向データで補正を行ってもよい。手動モード時の荷重値を、誘導モード時の荷重傾向データで補正を行ってもよい。また、同一移動動作における手動モードと誘導モードとの荷重傾向データの差分が、他の移動動作における手動モードと誘導モードとの荷重の差分と同程度であると仮定して、同一移動動作における手動モードと誘導モードとの荷重傾向データの差分を用いて、荷重値の補正を行ってもよい。
実施の形態1において、ハンドル荷重に基づいて支援モードを誘導モードから手動モードに切り替える例について説明したが、これに限定されない。例えば、ハンドル荷重に基づいて支援モードを手動モードから誘導モードに切り替えてもよい。例えば、ハンドル荷重が所定の閾値以下の状態が所定の期間継続した場合に、手動モードから誘導モードに切り替えてもよい。このような構成により、例えば、障害物を避けるために、誘導モードから手動モードに切り替えたとしても、簡単に手動モードから誘導モードに切り替えることができるため、ユーザはより快適に歩行をすることができる。このような構成においても、前述したユーザ荷重傾向データを用いて、ハンドル荷重の値を補正することができる。
また、手動モード時に声掛けやディスプレイ上で誘導モードに戻ることを通知し、ユーザが手動で誘導モードを選択することで誘導に戻ることもできる。
(実施の形態2)
本開示の実施の形態2に係る歩行支援ロボットについて説明する。なお、実施の形態2では、主に実施の形態1と異なる点について説明する。実施の形態2においては、実施の形態1と同一又は同等の構成については同じ符号を付して説明する。また、実施の形態2では、実施の形態1と重複する記載は省略する。
実施の形態2では、荷重傾向データとして平均荷重値を用いている点が実施の形態1と異なる。なお、実施の形態2に係る歩行支援ロボットは、実施の形態1に係る歩行支援ロボット1と同様の構成要素を有しており、図1、図2及び図4中の符号「51」で示される。
図20は、実施の形態2における荷重傾向マップ31を示す。図20に示すように、荷重傾向マップ31は、支援モード毎に、歩行時の移動方向/誘導方向の平均荷重値と歩行時の重心の偏り方向の平均荷重値とを、荷重傾向データとして記憶している。
[荷重傾向データの生成]
荷重傾向データの生成について、図21を用いて説明する。図21は、歩行支援ロボット51(以下、「ロボット51」と称する)の荷重傾向データの生成処理の例示的なフローチャートを示す。
図21に示すように、ステップST51において、ステップST51において、検知部13によりハンドル荷重を検知したか否かを判定する。ステップST51では、ユーザがハンドル部12を把持しているか否かを判定している。検知部13でハンドル荷重を検知した場合、ステップST52へ進む。検知部13でハンドル荷重を検知しない場合、ステップST51を繰り返す。
ステップST52において、ユーザ荷重傾向抽出部30が誘導/手動モード切替判定部26から現在の支援モードの情報を取得する。具体的には、ユーザ荷重傾向抽出部30は、ロボット1の現在の支援モードが、誘導モードであるか手動モードであるかを判定する。
ステップST53において、ユーザ荷重傾向抽出部30は、現在の支援モードの情報と、車輪17の回転量の情報とに基づいてユーザの移動方向を推定する、又は誘導方向を算出する。具体的には、ステップST51でハンドル荷重の変化が検知されると、アクチュエータ制御部22が車輪17の回転量の情報を取得する。アクチュエータ制御部22で取得された回転量の情報は、ユーザ荷重傾向抽出部30に送信される。例えば、ユーザ荷重傾向抽出部30は、左右に配置される2つの車輪17の回転量に基づいて、ユーザの移動方向を推定する、又は誘導方向を算出する。
ステップST54において、ユーザ荷重傾向抽出部30は、推定したユーザの移動方向/誘導方向における過去の荷重データに、ステップST51で検知したハンドル荷重を加算する。具体的には、ユーザ荷重傾向抽出部30は、荷重傾向マップ31に記憶されている過去の荷重データを読み出し、読み出した過去の荷重データに、ステップST51で検知したハンドル荷重を加算する。過去の荷重データとは、これまでに検知した全ての荷重データを意味する。
ステップST55において、ユーザ荷重傾向抽出部30は、ユーザの歩行時の移動方向/誘導方向の平均荷重値と偏り方向の平均荷重値とを算出する。
ステップST56において、ユーザ荷重傾向抽出部30は、算出したユーザの歩行時の移動方向/誘導方向の平均荷重値と偏り方向の平均荷重値とを荷重傾向データとして設定する。具体的には、ユーザ荷重傾向抽出部30は、算出した平均荷重値の情報を荷重傾向マップ31に送信し、荷重傾向マップ31のユーザの歩行時の移動方向/誘導方向の平均荷重値と偏り方向の平均荷重値とを更新する。
[誘導/手動モード切替判定処理]
誘導/手動モード切替判定処理について、図22を用いて説明する。図22は、誘導/手動モード切替判定処理の例示的なフローチャートを示す。
図22に示すように、ステップST61において、誘導/手動モード切替判定部26は、誘導意図算出部25から誘導経路を取得したか否か判定する。具体的には、誘導/手動モード切替判定部26は、ロボット1が誘導経路上に位置しているかを判定する。誘導/手動モード切替判定部26が誘導経路を取得した場合、ステップST62へ進む。誘導/手動モード切替判定部26が誘導経路を取得していない場合、ステップST69へ進み、手動モードに切り替える。即ち、誘導/手動モード切替判定部26が誘導経路を取得していない場合、ロボット1が誘導経路に沿ってユーザを目的地に誘導していないと判断し、手動モードに切り替える。
ステップST62において、検知部13がハンドル荷重情報を取得する。
ステップST63において、荷重補正部19が、検知部13で取得したハンドル荷重の値を補正する。ハンドル荷重の補正は、ステップST64及びST65を行う。
ステップST64において、ユーザ荷重傾向抽出部30は、ユーザの荷重傾向データを読み出す。具体的には、ユーザ荷重傾向抽出部30は、荷重傾向マップ31から過去の平均荷重値を読み出し、過去の平均荷重値を荷重補正部19へ送信する。
ステップST65において、荷重補正部19は現在の荷重データから過去の平均荷重値を減算する。これにより、荷重補正部19は、ハンドル荷重の値を補正する。
ステップST66において、誘導/手動モード切替判定部26は、ステップST63で補正したハンドル荷重の値が所定の閾値より大きいか否かを判定する。補正したハンドル荷重の値が所定の閾値より大きい場合、ステップST67へ進み、支援モードを誘導モードから支援モードに切り替える。一方、補正したハンドル荷重の値が所定の閾値以下の場合、ステップST68へ進み、誘導モードを維持する。
一例として、実施の形態2におけるハンドル荷重の補正について詳細に説明する。ここでは、重心が右方向に偏った状態で歩行するユーザについてのハンドル荷重の補正について説明する。
[平均荷重値を用いたハンドル荷重の補正]
図23Aは、ユーザの直進動作時のMz方向における現在の荷重データの波形情報の一例を示す。図23Aに示すように、ユーザは右方向へ重心が偏っているため、直進動作時においても、検知部13でMz方向への荷重(モーメント)が検知される。
図23Bは、Mz方向における過去の荷重データの平均荷重値を示す。ユーザ荷重傾向抽出部30は、過去の荷重データの波形情報に対して平均計算を行うことにより、図23Bに示すような過去の荷重データの平均荷重値を算出する。図23Bの場合、過去の平均荷重値は、Mz方向に1.0Nmである。実施の形態2では、図23Bに示す平均荷重値を荷重傾向データとして使用する。
次に、荷重補正部19は、荷重傾向データに基づいて現在の荷重データを補正する。具体的には、荷重補正部19は、Mz方向において、図23Aに示す現在の荷重データの波形情報から図23Bに示す過去の平均荷重値1.0Nmを減算する。図23Cは、荷重傾向データを用いて補正したMz方向における現在の荷重データの波形情報を示す。図23Cに示すように、現在の荷重データから過去の平均荷重値を減算することで、Mz方向にかかる荷重が全体的に削減される。これにより、荷重補正部19は、定常的な右方向への荷重の偏りを補正することができる。
誘導/手動モード切替判定部26は、この補正されたハンドル荷重の情報に基づいて、誘導/手動モード切替判定を行っている。
なお、上記補正の例は、右方向へ重心が偏って歩行するユーザを例として説明したが、これに限定されない。例えば、腰が曲がったユーザなどは、下方向へ荷重が偏っている場合がある。この場合は、Fz方向の平均荷重値を用いて、ハンドル荷重の値を補正してもよい。
また、ロボット51の前進動作がFy方向及びFz方向のハンドル荷重の値に基づいて行われる場合、荷重傾向データとしてFy方向及びFz方向の平均荷重値を用いてもよい。即ち、ロボット51の前進動作時において、Fy方向及びFz方向の平均荷重値を用いて、ハンドル荷重の値を補正してもよい。また、ロボット51の旋回動作がMz方向の荷重(モーメント)に基づいて行われる場合、荷重傾向データとしてMz方向の平均荷重値を用いてもよい。即ち、ロボット51の旋回動作時において、Mz方向の平均荷重値を用いて、ハンドル荷重の値を補正してもよい。また、Fx,Fy,Fz,Mx,My,Mzの全て方向の平均荷重値を算出し、全て方向の平均荷重値を用いてハンドル荷重の値を補正してもよい。このように、複数の方向における平均荷重値を用いてハンドル荷重を補正することによって、ユーザの荷重傾向をより正確に把握することができるため、更にユーザの身体能力に適したロボット51の動作が可能になる。なお、ハンドル荷重の補正では、ロボット51の移動制御に応じて、Fx,Fy,Fz,Mx,My,Mz方向のうち少なくとも1つの平均荷重値を算出し、算出した平均荷重値を用いてハンドル荷重を補正すればよい。
また、実施の形態2におけるユーザ移動意図推定部20においても、上述したハンドル荷重の補正を行うことにより、ユーザ移動意図を推定する。
[効果]
実施の形態2に係る歩行支援ロボット51によれば、以下の効果を奏することができる。
実施の形態2に係る歩行支援ロボット51によれば、ユーザの荷重傾向データとしてハンドル荷重の平均荷重値を使用している。このような構成により、ユーザ毎の定常的に加わる荷重を荷重傾向データとして取得して荷重の値を補正することができるため、よりユーザの身体能力に適した歩行支援を行うことが可能となる。また、ユーザの荷重傾向データとしてハンドル荷重の平均荷重値を使用することにより、ユーザの荷重傾向の抽出の誤差を少なくすることができる。
なお、実施の形態2では、荷重傾向データを算出する際に、過去の荷重データとして、過去に検知した全てのハンドル荷重を使用する例について説明したが、これに限定されない。荷重傾向データを算出する際に使用する過去の荷重データは、例えば、所定の期間内の荷重データであってもよい。例えば、荷重傾向データを算出する際に使用する過去の荷重データは、所定の期間(例えば、1年)以内に検知した過去の荷重データなどであってもよい。このように、比較的新しい荷重データのみを使用することにより、ユーザの現在の荷重傾向を抽出しやすくなる。
実施の形態2では、荷重傾向マップ31は、安定歩行時の荷重傾向データを記憶していてもよい。ユーザ荷重傾向抽出部30は、荷重傾向データを荷重傾向マップ31から取得し、安定歩行時の荷重傾向データを荷重補正部19に送信してもよい。荷重補正部19が、安定歩行時の荷重傾向データと、現在のユーザの荷重データとを比較し、両者のデータが異なっている場合にハンドル荷重の値を補正してもよい。例えば、過去の荷重傾向において、ユーザの直進動作の安定歩行時のFz方向の荷重が10Nである場合、ユーザが前傾姿勢で歩行してFz方向のハンドル荷重が20Nとなると、荷重補正部19は、Fz方向のハンドル荷重を安定歩行時のFz方向のハンドル荷重の値に補正してもよい。即ち、荷重補正部19は、Fz方向の20Nの荷重を1/2に補正してもよい。
実施の形態2では、荷重補正部19は、現在の荷重データから過去の平均荷重値を減算することによって現在の荷重データを補正する例について説明したが、これに限定されない。例えば、荷重補正部19は、ロボット51の使用場所、使用時間、及びユーザの体調などに応じてハンドル荷重を補正できるように、別のパラメータを考慮してもよい。
また、ロボット1がFz値とFy値の合算値で移動制御を行っている場合は、Fz値とFy値の合算値で制御を行っている場合は、FzとFy値の合算する際の割合を変更してもよい。例えば、Fz:Fy=8:2で制御していたのを、Fz:Fy=6:4に変更してもよい。また、ユーザの荷重傾向データだけで補正をするのではなく、ユーザの荷重傾向データと、複数ユーザの平均の荷重傾向データを比較し、差分部分を低減するように補正の割合を変更してもよい。複数ユーザの平均の算出方法としては、年代、性別、場所、歩行能力(歩行速度、歩行率、歩幅、立位姿勢、左右の揺れ)等の組み合わせで分類されたグループ毎に作成してもよい。
また、荷重補正部19は、現在の荷重データに過去の荷重傾向データから算出された補正係数を乗算することによって、ハンドル荷重を補正してもよい。以下、補正係数を用いたハンドル荷重の補正の例について説明する。
[補正係数を用いたハンドル荷重の補正]
図24Aは、ユーザの直進動作時のMz方向における過去の荷重データの波形情報の一例を示す。図24Bは、図24Aに示すMz方向における過去の荷重データの平均荷重値を示す。ユーザ荷重傾向抽出部30は、図24Aに示す過去の荷重データの波形情報に対して平均計算を行う。これにより、荷重傾向データとして、図24Bに示すような過去の荷重データの平均荷重値を算出している。図24Bの場合、過去の平均荷重値は、Mz方向に−1.0Nmである。
次に、現在の荷重データから平均荷重値を算出する。図25Aは、ユーザの直進動作時のMz方向における現在の荷重データの波形情報の一例を示す。図25Bは、図25Aに示すMz方向における現在の荷重データの平均荷重値を示す。
荷重補正部19は、図25Aに示す現在の荷重データの波形情報に対して平均計算を行う。これにより、図25Bに示すような現在の荷重データの平均荷重値を算出する。図25Bの場合、現在の平均荷重値は、Mz方向に−2.0Nmである。
荷重補正部19は、過去の平均荷重値を現在の平均荷重値で除算することよって、補正係数を算出する。この場合、補正係数は、(−1.0Nm/−2.0Nm)=0.5となる。荷重補正部19は、この補正係数を現在の荷重データの波形情報に乗算することによって、ハンドル荷重を補正する。即ち、図25Aに示す現在の荷重データの波形情報に対して、補正係数0.5を乗算することによって、検知部13で検知されたMz方向のハンドル荷重の値を補正する。
図26は、補正された荷重データの波形情報の一例を示す。図26に示すように、検知部13で検知されたハンドル荷重(図25Aの波形情報参照)が補正係数の乗算によって補正されている。このように、荷重補正部19は、現在の荷重データに、過去の荷重傾向データに基づいて算出された補正係数を乗算することによって、現在のハンドル荷重を補正してもよい。
本開示をある程度の詳細さをもって各実施形態において説明したが、これらの実施形態の開示内容は構成の細部において変化してしかるべきものである。また、各実施形態における要素の組合せや順序の変化は、本開示の範囲及び思想を逸脱することなく実現し得るものである。
なお、実施の形態1及び2において説明した荷重傾向データに基づくハンドル荷重の補正は、例示であって、これらに限定されるものではない。荷重傾向データに基づくハンドル荷重の補正としては、周知の様々な補正方法を採用してもよい。補正方法としては、例えば、重心方向の揺らぎに関して、揺らぎ度合に応じた移動平均での平滑化を行う方法、メディアンフィルタでの平滑化を行うことで揺らぎを除去する方法、周波数解析を行うことで特定周波数をカット、低減する方法を採用してもよい。
本開示は、より快適なユーザの歩行支援を行う歩行支援ロボット及び歩行支援方法に適用可能である。
1、51 歩行支援ロボット
11 本体部
12 ハンドル部
13 検知部
14 移動装置
15 荷重傾向データ生成部
16 モード切替部
17 回転体
18 駆動部
19 荷重補正部
20 ユーザ移動意図推定部
21 駆動力算出部
22 アクチュエータ制御部
23 アクチュエータ
24 自己位置推定部
25 誘導意図算出部
26 誘導/手動モード切替判定部
27 外界センサ
28 インタラクション部
29 記憶部
30 ユーザ荷重傾向抽出部
31 荷重傾向マップ

Claims (14)

  1. ユーザの歩行を支援する歩行支援ロボットであって、
    本体部と、
    前記本体部に設けられ、前記ユーザが把持可能なハンドル部と、
    前記ハンドル部にかかる荷重を検知する検知部と、
    回転体を有し、前記回転体の回転を制御して当該歩行支援ロボットを移動させる移動装置と、
    ユーザの歩行を支援する支援モードを切り替えるモード切替部と、
    当該歩行支援ロボットの移動中に取得した前記ハンドル部にかかった過去の荷重データに基づいて、前記ハンドル部にかかる荷重の傾向を示す荷重傾向データを生成する荷重傾向データ生成部と、
    前記荷重傾向データに基づいて、前記検知部において検知した荷重の値を補正する荷重補正部と、
    を備え、
    前記支援モードは、当該歩行支援ロボットが自律的に移動を行なって前記ユーザの手をひいて誘導経路に沿って前記ユーザを目的地まで誘導する第1モードと、前記ユーザが前記ハンドル部にかける荷重であって前記検知部において検知した第1荷重に基づいて前記ユーザの移動方向及び移動速度を推定し、前記ユーザが安定して歩行できるように当該歩行支援ロボットが移動する第2モードと、を含み、
    前記荷重傾向データ生成部は、当該歩行支援ロボットの支援モード毎の荷重傾向データを生成し、
    前記荷重補正部は、前記第1モード時の荷重傾向データまたは前記第2モード時の荷重傾向データに基づいて、当該歩行支援ロボットが前記第1モードで移動しているときに前記検知部において検知した第2荷重の値を補正し、
    前記モード切替部は、前記荷重補正部で補正された前記第2荷重の値に基づいて、前記支援モードを前記第1モードから前記第2モードへ切り替える、
    歩行支援ロボット。
  2. 前記モード切替部は、前記荷重補正部で補正された前記第2荷重の値が所定の閾値より大きい場合、前記支援モードを前記第1モードから前記第2モードへ切り替える、
    請求項に記載の歩行支援ロボット。
  3. 前記荷重傾向データ生成部は、当該歩行支援ロボットの移動動作毎の荷重傾向データを生成し、
    前記荷重補正部は、前記第2荷重が検知された際の当該歩行支援ロボットの移動動作に対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正する、
    請求項又はに記載の歩行支援ロボット。
  4. 前記移動動作は、当該歩行支援ロボットの直進動作、後退動作、左右旋回動作を含む、
    請求項に記載の歩行支援ロボット。
  5. 前記荷重補正部は、当該歩行支援ロボットの移動動作に対応する前記荷重傾向データが所定の閾値以上になった場合、前記荷重傾向データに基づいて、前記第2荷重の値を補正する、
    請求項又はに記載の歩行支援ロボット。
  6. 前記荷重傾向データは、前記過去の荷重データから算出された揺らぎの周波数であり、
    前記荷重補正部は、前記第2荷重から前記揺らぎの周波数成分をフィルタリングすることによって前記第2荷重の値を補正する、
    請求項のいずれか一項に記載の歩行支援ロボット。
  7. 前記荷重傾向データは、前記過去の荷重データから算出された平均荷重値であり、
    前記荷重補正部は、前記平均荷重値に基づいて前記荷重の値を補正する、
    請求項のいずれか一項に記載の歩行支援ロボット。
  8. 前記荷重補正部は、前記検知部で検知された荷重から前記平均荷重値を減算することによって前記荷重の値を補正する、
    請求項に記載の歩行支援ロボット。
  9. 前記モード切替部は、当該歩行支援ロボットの使用状況に応じて、前記所定の閾値を変更する、
    請求項に記載の歩行支援ロボット。
  10. 前記使用状況は、当該歩行支援ロボットが使用される場所、時間のいずれかを含む、
    請求項に記載の歩行支援ロボット。
  11. 更に、
    当該歩行支援ロボットが前記第1モードで前記ユーザを誘導するための誘導経路を示す経路情報を格納する記憶部、を備え、
    前記荷重傾向データ生成部は、前記記憶部に格納された前記経路情報が示す前記誘導経路毎に前記荷重傾向データを生成し、
    前記荷重補正部は、前記第2荷重が検知された際に当該歩行支援ロボットが移動している前記誘導経路に対応する前記荷重傾向データに基づいて、前記第2荷重の値を補正する、
    請求項10のいずれか一項に記載の歩行支援ロボット。
  12. 更に、
    前記第1モードにおける当該歩行支援ロボットの誘導意図を算出する誘導意図算出部、
    前記第2荷重の値に基づいてユーザ移動意図を推定するユーザ移動意図推定部、
    を備え、
    前記モード切替部は、前記誘導意図算出部で算出された前記誘導意図と、前記ユーザ移動意図推定部で推定されたユーザ移動意図と、の差分に基づいて、前記支援モードの切替を行う、
    請求項1に記載の歩行支援ロボット。
  13. 前記検知部は、前記ハンドル部にかかる複数の軸方向の荷重を検知し、
    前記荷重傾向データは、前記複数の軸方向それぞれにおける荷重の傾向を示す、
    請求項10のいずれか一項に記載の歩行支援ロボット。
  14. ユーザの手をひいて誘導経路に沿って前記ユーザを目的地まで誘導する第1モードと、前記ユーザがハンドル部にかける荷重であって検知部において検知した第1荷重に基づいて前記ユーザの移動方向及び移動速度を推定し、前記ユーザが安定して歩行できるように移動する第2モードと、を含む支援モードで動作する歩行支援ロボットを用いた歩行支援方法であって、
    当該歩行支援ロボットの移動中に取得した前記ハンドル部にかかった過去の荷重データに基づいて、前記ハンドル部にかかる荷重の傾向を示す荷重傾向データを当該歩行支援ロボットの支援モード毎に生成するステップ、
    前記歩行支援ロボットが前記第1モードで移動しているときに前記ハンドル部にかかる第2荷重を、検知部によって検知するステップ、
    前記第1モード時の荷重傾向データまたは前記第2モード時の荷重傾向データに基づいて、前記第2荷重の値を補正するステップ、
    補正された前記第2荷重の値に基づいて、前記歩行支援ロボットの支援モードを、前記第1モードから前記第2モードへ切り替えるステップ、
    を含む、歩行支援方法。
JP2016129237A 2016-06-29 2016-06-29 歩行支援ロボット及び歩行支援方法 Active JP6697768B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2016129237A JP6697768B2 (ja) 2016-06-29 2016-06-29 歩行支援ロボット及び歩行支援方法
CN201710300467.1A CN107544489B (zh) 2016-06-29 2017-05-02 行走辅助机器人及行走辅助方法
US15/619,569 US10086890B2 (en) 2016-06-29 2017-06-12 Robot and method for use of robot
EP17176583.7A EP3284453B1 (en) 2016-06-29 2017-06-19 Robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016129237A JP6697768B2 (ja) 2016-06-29 2016-06-29 歩行支援ロボット及び歩行支援方法

Publications (2)

Publication Number Publication Date
JP2018000382A JP2018000382A (ja) 2018-01-11
JP6697768B2 true JP6697768B2 (ja) 2020-05-27

Family

ID=59101289

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016129237A Active JP6697768B2 (ja) 2016-06-29 2016-06-29 歩行支援ロボット及び歩行支援方法

Country Status (4)

Country Link
US (1) US10086890B2 (ja)
EP (1) EP3284453B1 (ja)
JP (1) JP6697768B2 (ja)
CN (1) CN107544489B (ja)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106092091B (zh) * 2016-08-10 2019-07-02 京东方科技集团股份有限公司 电子机器设备
TWI657812B (zh) * 2017-11-14 2019-05-01 緯創資通股份有限公司 助行裝置
DE102018203500A1 (de) * 2018-03-08 2019-09-12 Robert Bosch Gmbh Transportvorrichtung, insbesondere Kinderwagen, mit einer elektrischen Antriebseinheit
CN108490947A (zh) * 2018-04-17 2018-09-04 西安交通大学 一种自动跟随避障方法及其装置
JP7075822B2 (ja) 2018-06-04 2022-05-26 パナソニックホールディングス株式会社 マップ情報更新システム
CN109157381B (zh) * 2018-07-24 2020-08-04 华中科技大学 一种扶手式智能跌倒防护助行康复机器人
KR20200069913A (ko) * 2018-12-07 2020-06-17 현대자동차주식회사 다목적 이동장치의 제어방법
WO2020141639A1 (ko) * 2019-01-03 2020-07-09 엘지전자 주식회사 로봇의 제어 방법
WO2021086471A1 (en) * 2019-10-28 2021-05-06 Ambulatus Robotics LLC Autonomous robotic mobile support system for the mobility-impaired
CN110667725A (zh) * 2019-11-11 2020-01-10 路邦科技授权有限公司 一种全地形移动机器人的平衡系统及其控制方法
CN112999026B (zh) * 2019-12-19 2023-02-03 沈阳新松机器人自动化股份有限公司 一种应用于康复助行机器人的自适应控制方法
CN113454557A (zh) * 2020-05-20 2021-09-28 深圳市大疆创新科技有限公司 无人机及其控制方法和装置、遥控终端、无人机系统
CN111984008B (zh) * 2020-07-30 2024-08-13 深圳优地科技有限公司 一种机器人控制方法、装置、终端和存储介质
US20230168679A1 (en) * 2021-11-30 2023-06-01 Robust AI, Inc. Robotic Cart
CN116225031B (zh) * 2023-05-09 2024-05-28 南京泛美利机器人科技有限公司 一种面向人机协作场景的三体协同智能避障方法和系统

Family Cites Families (46)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4815190A (en) * 1987-08-20 1989-03-28 Gmf Robotics Corporation Method for automated assembly of assemblies such as automotive assemblies
JPH11286280A (ja) * 1998-04-03 1999-10-19 Mitsubishi Electric Corp 車両の自動走行制御装置
US6666831B1 (en) * 1999-08-20 2003-12-23 The Regents Of The University Of California Method, apparatus and system for automation of body weight support training (bwst) of biped locomotion over a treadmill using a programmable stepper device (psd) operating like an exoskeleton drive system from a fixed base
JP4119149B2 (ja) * 2002-04-03 2008-07-16 株式会社日立製作所 歩行補助装置
CN1747866A (zh) * 2003-02-17 2006-03-15 三洋电机株式会社 力输入操纵器、移动物体、手推车和扶车
TWM241033U (en) * 2003-08-15 2004-08-21 Ji Yi Jiun Structure of device for assisting walking
US7544172B2 (en) * 2004-06-29 2009-06-09 Rehabilitation Institute Of Chicago Enterprises Walking and balance exercise device
JP2006034440A (ja) * 2004-07-23 2006-02-09 Robotopia:Kk 歩行支援装置
JP2006306190A (ja) * 2005-04-27 2006-11-09 Sanyo Electric Co Ltd 力入力操作装置及びこれを有する移動体
US20060254630A1 (en) * 2005-04-29 2006-11-16 Larry Mulholland Assistive walking device
KR100717397B1 (ko) * 2006-07-19 2007-05-11 한국산업기술대학교산학협력단 로드셀을 이용한 노약자의 보행보조로봇에 장착되는보행의지파악 시스템
JP2008052362A (ja) * 2006-08-22 2008-03-06 Toshiba Corp 自律移動装置
JPWO2008129847A1 (ja) * 2007-04-12 2010-07-22 パナソニック株式会社 移乗支援装置
US8752658B2 (en) * 2009-02-05 2014-06-17 Gary KUREK Motorized walker
JP4821865B2 (ja) * 2009-02-18 2011-11-24 ソニー株式会社 ロボット装置及びその制御方法、並びにコンピューター・プログラム
JP5423142B2 (ja) 2009-05-21 2014-02-19 日本精工株式会社 案内用ロボット及びその制御方法
JP5421019B2 (ja) * 2009-08-03 2014-02-19 トヨタ自動車株式会社 車両の走行支援装置
WO2011017668A2 (en) * 2009-08-06 2011-02-10 The Regents Of The University Of California Multimodal dynamic robotic systems
US8627909B2 (en) * 2010-07-20 2014-01-14 Lg Electronics Inc. Walking-assistant device
ES2636946T3 (es) * 2010-09-27 2017-10-10 Vanderbilt University Dispositivo de asistencia al movimiento
JP5618767B2 (ja) * 2010-10-29 2014-11-05 アイシン精機株式会社 車両の横方向運動制御装置
KR101689430B1 (ko) * 2011-02-23 2016-12-23 가부시키가이샤 무라타 세이사쿠쇼 보행 보조차
CN102551994B (zh) * 2011-12-20 2013-09-04 华中科技大学 一种康复助行机器人及其控制系统
JP5981158B2 (ja) * 2012-02-10 2016-08-31 富士機械製造株式会社 立ち座り動作支援ロボットおよび動作設定方法
DE102012202614C5 (de) * 2012-02-21 2018-11-08 Karlsruher Institut Für Technologie (Kit) Häusliche Hilfsvorrichtung
US9605952B2 (en) * 2012-03-08 2017-03-28 Quality Manufacturing Inc. Touch sensitive robotic gripper
KR101352681B1 (ko) * 2012-04-17 2014-01-17 주식회사 청우메디칼 휠체어 겸용 전동식 보행 보조기의 속도제어장치
US8695736B1 (en) * 2012-08-30 2014-04-15 Devindranath Samaroo Bin moving assembly
WO2014119359A1 (ja) * 2013-01-29 2014-08-07 日本精工株式会社 電動パワーステアリング装置
US9770377B2 (en) * 2013-02-07 2017-09-26 Fuji Machine Mfg. Co., Ltd. Movement assistance robot
CN103126858A (zh) * 2013-03-19 2013-06-05 哈尔滨工业大学 一种智能助行机器人
JP2014230681A (ja) * 2013-05-30 2014-12-11 船井電機株式会社 パワーアシスト装置及び歩行補助車
US9637150B1 (en) * 2013-06-27 2017-05-02 Amazon Technologies, Inc. Transport handle for low profile displacement
DE202014011052U1 (de) * 2013-07-12 2017-07-24 Dorel Home Furnishings, Inc. Lastenträger mit Moduswechsler
WO2015041128A1 (ja) * 2013-09-17 2015-03-26 株式会社村田製作所 手押し車
KR102112546B1 (ko) * 2013-10-01 2020-05-19 삼성전자 주식회사 보청기 착용자의 귓속 기압 조정을 위한 장치 및 방법
KR102172954B1 (ko) * 2013-11-08 2020-11-02 삼성전자주식회사 보행 보조 로봇 및 보행 보조 로봇의 제어 방법
WO2015073521A2 (en) * 2013-11-18 2015-05-21 New York Institute Of Technology Motorized walker
KR102122856B1 (ko) * 2013-12-17 2020-06-15 삼성전자주식회사 보행 보조 장치 및 그 제어 방법
JP5949814B2 (ja) * 2014-03-06 2016-07-13 トヨタ自動車株式会社 自律移動ロボット、及びその制御方法
JP6319687B2 (ja) * 2014-05-26 2018-05-09 パナソニックIpマネジメント株式会社 プラズマ処理装置及び方法
US9365226B1 (en) * 2014-06-12 2016-06-14 Amazon Technologies, Inc. Transport dolly
JP6299475B2 (ja) * 2014-06-20 2018-03-28 船井電機株式会社 歩行アシストカート
DE102015000270A1 (de) * 2014-11-11 2016-05-12 Bow2Go Gmbh Mobile Geh- und Transporthilfe-Vorrichtung
CN204766382U (zh) * 2015-05-29 2015-11-18 嵊州领航信息科技有限公司 一种多功能辅助步行训练器
CN105511469B (zh) * 2015-12-18 2018-06-15 北京联合大学 一种无人智能巡逻电动车及巡逻系统

Also Published As

Publication number Publication date
JP2018000382A (ja) 2018-01-11
US20180001946A1 (en) 2018-01-04
CN107544489B (zh) 2022-03-08
EP3284453A1 (en) 2018-02-21
US10086890B2 (en) 2018-10-02
EP3284453B1 (en) 2021-12-29
CN107544489A (zh) 2018-01-05

Similar Documents

Publication Publication Date Title
JP6697768B2 (ja) 歩行支援ロボット及び歩行支援方法
CN107536698B (zh) 行走辅助机器人以及行走辅助方法
JP6815891B2 (ja) 歩行支援ロボット及び歩行支援システム
JP6945176B2 (ja) 歩行支援ロボット及び歩行支援方法
JP6887274B2 (ja) 歩行支援ロボット及び歩行支援方法
CN107536697B (zh) 行走辅助机器人和行走辅助方法
KR101242460B1 (ko) 경사로/장애물 구간에서 편리하고 안전한 진행을 유도하는 보행 보조기
JP2017214062A (ja) 電動アシスト自転車の押し歩きアシストのために電動機を制御する制御方法及び装置
Yu et al. An interactive robotic walker for assisting elderly mobility in senior care unit
JP2007202924A (ja) 身体状態判定システム及び運動状態判定システム並びにこれらシステムを備える移動台車
JP2007090019A (ja) 歩行支援システム
CN108095985B (zh) 多模式步行训练之电动步行辅具及该辅具之控制方法
CN110522614A (zh) 行走训练机器人
JP2019211961A (ja) マップ情報更新システム
Hirata et al. Motion control of intelligent walker based on renew of estimation parameters for user state
Tang et al. Motion control of walking assistant robot based on comfort
CN106335567B (zh) 用于控制可穿戴机器人的行走的方法和系统
KR101476507B1 (ko) 휠체어 제어방법 및 이를 이용한 이동과 재활을 위한 부하 선택형 휠체어
US20220000701A1 (en) Assist device
JP7104638B2 (ja) 歩行訓練ロボット
Hirata et al. Standing up and sitting down support using intelligent walker based on estimation of user states
CN115551456A (zh) 移动辅助装置、移动辅助方法以及程序
JP2006298012A (ja) 運転者支援装置
JP2012090914A (ja) 可動式椅子
CN110430853B (zh) 步行支援系统、步行支援方法及程序

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190108

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20191029

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20191025

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191126

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20200407

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200414

R151 Written notification of patent or utility model registration

Ref document number: 6697768

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151