JP2022088770A - 運動訓練装置 - Google Patents

運動訓練装置 Download PDF

Info

Publication number
JP2022088770A
JP2022088770A JP2020200786A JP2020200786A JP2022088770A JP 2022088770 A JP2022088770 A JP 2022088770A JP 2020200786 A JP2020200786 A JP 2020200786A JP 2020200786 A JP2020200786 A JP 2020200786A JP 2022088770 A JP2022088770 A JP 2022088770A
Authority
JP
Japan
Prior art keywords
operation unit
force
axis
axis direction
magnitude
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.)
Pending
Application number
JP2020200786A
Other languages
English (en)
Inventor
善之 野田
Yoshiyuki Noda
達也 大森
Tatsuya Omori
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.)
Canon Finetech Nisca Inc
University of Yamanashi NUC
Original Assignee
Canon Finetech Nisca Inc
University of Yamanashi NUC
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 Canon Finetech Nisca Inc, University of Yamanashi NUC filed Critical Canon Finetech Nisca Inc
Priority to JP2020200786A priority Critical patent/JP2022088770A/ja
Priority to US17/537,620 priority patent/US20220175606A1/en
Publication of JP2022088770A publication Critical patent/JP2022088770A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • 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
    • A61H1/00Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02Stretching or bending or torsioning apparatus for exercising
    • A61H1/0274Stretching or bending or torsioning apparatus for exercising for the upper limbs
    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B19/00Teaching not covered by other main groups of this subclass
    • G09B19/003Repetitive work cycles; Sequence of movements
    • 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
    • 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/16Physical interface with patient
    • A61H2201/1657Movement of interface, i.e. force application means
    • A61H2201/1664Movement of interface, i.e. force application means linear
    • A61H2201/1666Movement of interface, i.e. force application means linear multidimensional
    • 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/5007Control means thereof computer controlled
    • 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/5043Displays
    • 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

Abstract

【課題】受動訓練モードで操作部が目標の軌道から外れて移動する状態でも、安全性を確保しつつ、運動訓練を適切に続行し得る運動訓練装置を提供する。【解決手段】運動訓練装置1の制御部70は、XY平面で移動可能な操作部3に作用するX軸およびY軸方向の力Fx,Fyを力センサ51により検出し、その合成力F0の大きさが所定の範囲内の場合には、操作部を所定の目標軌道に沿って移動させるように、合成力F0の大きさが所定の範囲を超える場合には、操作部を現在位置から目標軌道上の次の目標位置に向かわせる大きさの第1速度ベクトルと、合成力F0の大きさに基づいた大きさの第2速度ベクトルとに応じて操作部を移動させるように、X軸およびY軸方向駆動モータを制御する。【選択図】図32

Description

本発明は運動訓練装置に係り、特に、使用者の平面運動を支援可能な運動訓練装置に関
する。
従来、人の運動機能を向上させるために、様々な運動訓練が行われている。例えば、机上を拭くような動作で肩や肘を屈伸させるワイピング訓練や、傾斜したボード上で手を上下方向に滑らせるサンディング訓練が広く行われている。そして、これらの運動訓練を支援するために種々の運動訓練装置が提案されている。
例えば、本願発明者らは、使用者が操作する操作部を、X軸及びY軸方向駆動モータでXY平面に移動可能に駆動し、該操作部に作用するX軸及びY軸方向の力を検出して合成した合成力の大きさに応じて各駆動モータの駆動量を制限するようにした運動訓練装置を提案している(例えば、特許文献1を参照)。このように両駆動モータを制御することによって、操作部に静止摩擦を模擬的に発生させ、使用者が一定以上の力を加えないと、操作部を静止状態から動かせないようにし、動かし始めた後に停止させる際は、仮想静止力を働かせて、操作部が滑らかに停止するという違和感を解消している。
特開2020-89621号公報
特許文献1に記載の運動訓練装置は、使用者に、駆動モータによって自動的に動く操作部の動きに追随して運動させることを目的とした受動訓練モードを備えている。例えば、運動訓練装置の受動訓練モードでの運転中、使用者の運動能力や身体能力に反して、操作部を予め設定した目標の軌道に沿って強制的に移動させようとすると、使用者及び/または駆動モータに過大な負担を掛けることになり、安全性の問題が発生する。
そこで、特許文献1の運動訓練装置は、受動訓練モードで、力覚センサが操作部に作用する所定値以上の負荷を検出すると、駆動モータを制御して操作部の移動を終了させるように構成されている。かかる駆動モータの制御は、使用者及び運動訓練装置に掛かる負担を軽減または解消することができ、使用上安全性の観点から有利である。しかしながら、運動訓練装置の運転が途中で頻繁に停止すると、却って適切な運動訓練の実施に支障を来す虞が生じる。
本発明は、上述した従来技術の問題点に鑑み、受動訓練モードでの運動訓練中に、操作部が予め設定した目標の軌道から外れて移動する状態になっても、使用上の安全性を確保しつつ、運動訓練を適切に続行し得る運動訓練装置を提供することを目的とする。
本発明の運動訓練装置は、
XY平面で移動可能な操作部と、
X軸およびY軸方向駆動モータを有し、前記操作部をXY平面で駆動する駆動部と、
前記操作部を操作する使用者から前記操作部に作用するX軸およびY軸方向の力Fx,Fyを検出する力センサと、
前記X軸およびY軸方向駆動モータを制御する制御部と、
を備え、
前記制御部は、前記力センサにより検出される前記X軸およびY軸方向の力Fx,Fyの合成力F0の大きさが所定の範囲内である場合に、前記操作部を所定の軌道に沿って移動させるように前記X軸およびY軸方向駆動モータを駆動し、前記合成力F0の大きさが前記所定の範囲を超える場合に、前記操作部を現在位置から前記所定の軌道上の次の目標位置に向かわせる大きさの第1速度ベクトルと、前記合成力F0の大きさに基づいた大きさの第2速度ベクトルとに応じて、前記操作部を現在位置から移動させるように前記X軸およびY軸方向駆動モータを制御する、ことを特徴とする。
本発明の運動訓練装置は、操作部を現在位置から所定の軌道上の次の目標位置に向かわせる大きさの第1速度ベクトルと、操作部に作用するX軸およびY軸方向の力Fx,Fyの合成力F0の大きさに基づいた大きさの第2速度ベクトルとに応じて、X軸およびY軸方向駆動モータを制御するので、受動訓練モードでの運動訓練中に、操作部が予め設定した目標の軌道から外れて移動する状態になっても、使用上の安全性を確保しつつ、運動訓練を適切に続行することができる。
本発明が適用可能な実施形態の運動訓練装置の外観斜視図である。 実施形態の運動訓練装置の装置本体の斜視図である。 図2のIII-III線における装置本体の断面図である。 図2のIV-IV線における装置本体の断面図である。 運動訓練装置のアクチュエータ機構の分解斜視図である。 図3におけるY軸方向アクチュエータの部分拡大図である。 図4におけるX軸方向アクチュエータの部分拡大図である。 操作部の可動範囲を示すアクチュエータ機構の平面図である。 操作部がホームポジションに位置するときのアクチュエータ機構の平面図である。 力覚提示エリアおよび安全対策エリアとアクチュエータ機構の駆動モータの制御モードとの関係を示す説明図である。 運動訓練装置の制御部のブロック図である。 制御部で実行されるアドミタンス制御の説明図である。 制御部が行う駆動モータ制御の説明図であり、(A)は駆動モータ制御の概念、(B)は実施形態での駆動モータ制御を示す。 操作部に作用するX軸方向の力、Y軸方向の力、両者の合成力の各ベクトルと静止摩擦エリアとの関係を示す説明図であり、(A)はX軸およびY軸方向の力のベクトルおよび合成力のベクトルがいずれも静止摩擦エリア内にあるとき、(B)はX軸およびY軸方向の力のベクトルが静止摩擦エリア内にあり合成力のベクトルが静止摩擦エリア外にあるとき、(C)はY軸方向の力のベクトルが静止摩擦エリア内にありX軸方向の力のベクトルおよび合成力のベクトルが静止摩擦エリア外にあるときを示す。 制御部のMCUのCPUが実行する軌跡設定ルーチンのフローチャートである。 制御部のMCUのCPUが実行する負荷検出ルーチンのフローチャートである。 制御部のMCUのCPUが実行する運動訓練ルーチンのフローチャートである。 運動訓練ルーチンのステップ322の詳細を示す駆動指令処理サブルーチンのフローチャートである。 運動訓練ルーチンのステップ336の詳細を示す駆動指令処理サブルーチンのフローチャートである。 負荷検出ルーチンで表示装置に表示される軌跡-負荷情報の模式図である。 運動訓練ルーチンで表示装置に表示される運動訓練軌跡-負荷情報の模式図である。 本発明が適用可能な他の実施形態の運動訓練装置の運動訓練ルーチンで表示装置の画面下部に表示される負荷変動のレーダチャートの模式図である。 実施例の条件で試験を行ったときのX軸およびY軸方向における操作部に作用する力、操作部の速度および操作部の位置を時系列で示すグラフである。 実施例の条件で試験を行ったときの操作部3の軌跡である。 比較例1の条件で試験を行ったときのX軸およびY軸方向における操作部に作用する力、操作部の速度および操作部の位置を時系列で示すグラフである。 比較例1の条件で試験を行ったときの操作部3の軌跡である。 比較例2の条件で試験を行ったときのX軸およびY軸方向における操作部に作用する力、操作部の速度および操作部の位置を時系列で示すグラフである。 比較例2の条件で試験を行ったときの操作部3の軌跡である。 運動訓練モードにおいて制御部が設定した操作部の目標軌跡TLと、運動訓練を行う使用者の操作によって操作部が実際に移動する操作軌跡ALとを示す説明図である。 受動訓練モードで実行される運動訓練において制御部が行う操作部の駆動モータ制御を説明するための回路ブロック図である。 図29の軌跡位置LP0において操作部から力センサへの入力値が所定の範囲内の場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 図29の軌跡位置LP0において操作部から力センサへの入力値が所定の範囲を超える場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 図29の軌跡位置LP1において操作部から力センサへの入力値が所定の範囲を超える場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 図29の軌跡位置LP2において操作部から力センサへの入力値が所定の範囲を超える場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 図29の軌跡位置LP2において操作部から力センサへの入力値が所定の範囲を超えかつ所定の値を超える場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードで実行される運動訓練において制御部が行う操作部の駆動モータ制御を説明するための回路ブロック図である。 能動訓練モードの運動訓練開始時において操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードで使用者により操作される操作部の位置が所定の目標領域内にある場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードで使用者により操作される操作部の位置が所定の目標領域から外れた場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードで使用者により操作される操作部の位置が所定の目標領域から外れた後、所定の目標領域内に戻った場合に、操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードの別の実施形態において、所定の目標領域から外れた操作部に作用する力と速度ベクトルとの関係を説明する図である。 能動訓練モードの更に別の実施形態において、所定の目標領域から外れた操作部に作用する力と速度ベクトルとの関係を説明する図である。 図42の実施形態において、所定の目標領域に戻った操作部に作用する力と速度ベクトルとの関係を説明する図である。
以下、図面を参照して本発明が適用可能な実施形態の運動訓練装置について説明する。なお、本実施形態の運動訓練装置は略水平な載置面に載置され、例えば、使用者(運動訓練者)の上肢の運動機能向上を目的として行われる運動訓練に使用される(図1参照)。
1.構成
1.1.機構部
1.1.1.機構部概略
運動訓練装置1は、XY平面で移動可能な操作部3(図1参照)と、X軸方向駆動モータ38およびY軸方向駆動モータ30を有し、操作部3をXY平面で駆動するアクチュエータ機構20(図5参照)と、操作部3に作用するX軸およびY軸方向の力を検出する力センサ51(図5参照)とを備えている。X軸およびY軸方向駆動モータ38,30は、XY平面での操作部3の位置を検出するためのエンコーダ38a,30a(図5参照)と一体に構成されている。操作部3を除くこれらの部材は筺体5内に収容されており、操作部3(のハンドル部材49、図5参照)は筺体5から上方に突出している(図1参照)。
1.1.2.機構部詳細
(1)筺体5
図1および図2に示すように、筺体5は、上部が開口した略箱状のケーシング6と矩形枠状の外側フレーム11とで構成されている。なお、図1では、使用者(運動訓練者)Uが運動訓練装置1の正面に位置し、例えばワイピング訓練を行うために、右腕ARを前方に伸ばして右手HRで操作部3を操作している状態を示している。また、図2は、図1に示す運動訓練装置1からカバー4を取り外した状態の装置本体2を示しており、図中手前側が運動訓練装置1の正面(前面)側、奥側が背面(後面)側である。
A)ケーシング6
ケーシング6は、上下両端部が略コ字状に折り曲げられた正面フレーム6a、背面フレーム6b(図1参照)、右面フレーム6c(図2参照)および左面フレーム6d(図1参照)と、これらのフレーム6a~6dの底面側に配された底面フレーム6e(図2参照)とで構成されている。
ケーシング6は複数の補強部材により補強されている。すなわち、図2~図4に示すように、ケーシング6内には、前後方向に延在する3つの前後補強部材13a~13cが左右方向に離隔して平行に配設されており、それらの両端部はそれぞれケーシング6の内壁(正面フレーム6a、背面フレーム6b)下端部に固定されている。また、前後補強部材13a~13cと直交してケーシング6内に左右方向に延在する2つの左右補強部材14a,14bが前後方向に離隔して平行に配設されており、それらの両端部はそれぞれケーシング6の内壁(右面フレーム6c、左面フレーム6d)下端部に固定されている。
左右補強部材14a,14bは前後補強部材13a~13cの上に配置されており、ねじ締結で一体化されている。なお、前後補強部材13a~13cの位置に対応するケーシング6の底面および外側フレーム11の底面中央部には、運動訓練装置1を載置面に載置するための複数の脚部15が突設されている。
B)外側フレーム11
図2に示すように、外側フレーム11は対角に配置された補強板で補強されている。外側フレーム11の上面には、運動訓練装置1の状態を表示する3つの状態表示ランプと、3つのマニュアル操作ボタンとが配設されている。3つの状態表示ランプは、運動訓練装置1の作動中に点灯する緑色LED9aと、操作部3がホームポジションに移動中に点灯する白色LED9bと、電力投入後の運動訓練装置1の作動停止中に点灯する赤色LED9cとで構成されている。一方、3つのマニュアル操作ボタンは、操作部3の作動を緊急に停止させるための緊急停止ボタン10aと、操作部3の作動を一時的に停止させるための一時停止ボタン10bと、操作部3をホームポジションに位置付けるためのイニシャルボタン10cとで構成されている。
外側フレーム11はケーシング6を構成する右面フレーム6cにねじ締結により複数箇所で固定されており、外側フレーム11およびケーシング6には配線用の連通窓が形成されている。また、図1~図2に示すように、ケーシング6を構成する左面フレーム6dおよび外側フレーム11の外側面には、運動訓練装置1を持ち運ぶための略水平な棒状の取っ手12が取り付けられている。
(2)カバー4
図1に示すように、ケーシング6の上部開口は略全面的にカバー4で覆われており、操作部3はカバー4の上面から突出するように配置されている。カバー4は、左部カバー4a、右部カバー4b、前部カバー4cおよび後部カバー4dで構成されている。カバー4a~4dは、それぞれ操作部3の前後および左右方向に配置されており、操作部3の移動に合わせて伸縮可能なベローズ(蛇腹)構造のシート状部材で構成されている。
図2および図4に示すように、ケーシング6の正面および背面側内壁(正面フレーム6a、背面フレーム6b)には、その上端から少し下がった高さ位置に、左右方向の略全長に亘って一定幅の段差面16a,16bがそれぞれ内側に向けて形成されている。また、ケーシング6の正面および背面内壁は、それぞれ上端部が内側へ直角に折曲され左右方向の略全長に亘って一定幅の折曲板部17a,17bが形成されており、その下方の段差面16a,16bとの間に隙間が画定されている。この隙間には、左部カバー4aおよび右部カバー4bの左右側辺部が前後方向の略全長に亘って挿入され、操作部3が左右方向(X軸方向)に移動するときに、その移動に合わせて蛇腹構造の左部カバー4aおよび右部カバー4bを伸縮させるためのガイドとなる。なお、前部カバー4cおよび後部カバー4dについても同様の構造が採用されているが、その点については後述する。
(3)アクチュエータ機構20
図5に示すように、アクチュエータ機構20は、操作部3をY軸方向(前後方向)に駆動するY軸方向アクチュエータ21と、X軸方向(左右方向)に駆動するX軸方向アクチュエータ22とで構成されている。すなわち、アクチュエータ機構20は2軸直動アクチュエータである。図2に示すように、アクチュエータ機構20は、前後補強部材13a~13cおよび左右補強部材14a,14b上に、X軸方向アクチュエータ22、Y軸方向アクチュエータ21の順で設けられている。
A)Y軸方向アクチュエータ21
図2および図5に示すように、Y軸方向アクチュエータ21は、操作部3をY軸方向に直線状に案内するためのガイド部23と、操作部3をガイド部23に沿って駆動するY軸方向駆動部24とを有している。Y軸方向駆動部24は、ガイド部23の一方の端部(図2および図4に示すように背面側の端部)にガイド部23と一体に設けられている。
図5に示すように、ガイド部23は、上向きに開放された矩形チャネル状のガイドフレーム25と、その内部を長手方向に延在するロッド状の送りねじ26と、スライダブロック27とで構成されている。ガイドフレーム25の長手方向に沿う両側部上面は、その長手方向にスライダブロック27を案内するスライダレールとして機能する。スライダブロック27は、複数の鋼球からなるボールを介して送りねじ26のねじ溝と螺合するナット部を有しており、送りねじと組み合わされてボールねじ構造を構成している。
図4および図5に示すように、Y軸方向駆動部24は、正逆回転可能なY軸方向駆動モータ30と、Y軸方向駆動モータ30のモータ軸と送りねじ26との間に介装された減速ギアユニット31とで構成されている。また、Y軸方向駆動モータ30のモータ軸には、その回転方向および回転量を検出するロータリエンコーダ30aが取り付けられている。本実施形態では、Y軸方向駆動モータ30にDCサーボモータが用いられている。
減速ギアユニット31は、Y軸方向駆動モータ30の回転を減速して送りねじ26に伝達する歯車列からなる。減速ギアユニット31の減速ギア比は、操作部3を介して使用者Uの上肢にY軸方向駆動モータ30の駆動力を伝達するのに十分なトルクを発生し得るように設定されている。なお、減速ギアユニット31の減速ギア比は、Y軸方向駆動モータ30の駆動が停止したときに、送りねじ26側からの逆入力によって容易に回転しないように比較的高く設定することが好ましい。この点は、後述する(X軸アクチュエータ22を構成する)減速ギアユニット39の減速ギア比についても同じである。
図5に示すように、Y軸方向アクチュエータ21は、連結部材53を介してX軸方向アクチュエータ22上に取り付けられている。連結部材53は、矩形の板状部材からなり、ガイドフレーム25の下面に結合され、ガイド部23をX軸方向アクチュエータ22のスライダブロック37上に一体に固定する。Y軸方向アクチュエータ21は、操作部3をX軸方向に移動させたときに、X軸方向アクチュエータ22を構成するガイドフレーム35の直上をその長手方向に沿って走行する。
B)X軸方向アクチュエータ22
図2および図5に示すように、X軸方向アクチュエータ22は、原則的に上述したY軸方向アクチュエータ21と同様に構成されている。すなわち、X軸方向アクチュエータ22は、Y軸方向アクチュエータ21をX軸方向に直線状に案内するためのガイド部33と、Y軸方向アクチュエータ21をガイド部33に沿って駆動するX軸方向駆動部34とを有している。X軸方向駆動部34は、ガイド部33の一方の端部(図2および図3の右側の端部)にガイド部33と一体に設けられている。
図5に示すように、ガイド部33は、上向きに開放された矩形チャネル状のガイドフレーム35と、その内部を長手方向に延在するロッド状の送りねじ36と、スライダブロック37とで構成されている。ガイドフレーム35の長手方向に沿う両側部上面は、その長手方向にスライダブロック37を案内するためのスライダレールとして機能する。スライダブロック37は、複数の鋼球からなるボールを介して送りねじ36のねじ溝と螺合するナット部を有しており、送りねじ36と組み合わされてボールねじ構造を構成している。
図3および図5に示すように、X軸方向駆動部34は、正逆回転可能なX軸方向駆動モータ38と、X軸方向駆動モータ38のモータ軸と送りねじ36との間に介装された減速ギアユニット39とで構成されている。また、X軸方向駆動モータ38のモータ軸には、その回転方向および回転量を検出するロータリエンコーダ38aが取り付けられている。本実施形態では、X軸方向駆動モータ38にDCサーボモータが用いられている。
減速ギアユニット39は、X軸方向駆動モータ38の回転を減速して送りねじ36に伝達する歯車列からなる。減速ギアユニット39の減速ギア比は、Y軸方向アクチュエータ21および操作部3を介して使用者Uの上肢にX軸方向駆動モータ38の駆動力を伝達するのに十分なトルクを発生し得るように設定されている。
(4)可動フレーム41
図2~図4に示すように、Y軸方向アクチュエータ21は、ケーシング6内側のY軸方向の略全長に亘って延在する可動フレーム41と一体化されている。図6に示すように、可動フレーム41は、ガイド部23の長手方向に沿って延在する断面略L字状の一対の可動フレーム部材41a,41bで構成されている。可動フレーム部材41a,41bは、それぞれL字状の内側をガイド部23側に向けてガイドフレーム25の長手方向に沿う両側部にねじ締結されている。これにより、ガイド部23と可動フレーム部材41a,41bとの間には、ガイドフレーム25の側面から側方に延出する一定幅の水平面と、断面矩形の溝状空間Sa,Sbとが画定される。
ガイドフレーム25に固定された可動フレーム部材41a,41bの上端部は、長手方向の全長に亘って内側すなわちガイドフレーム25側に直角に折曲され一定狭幅の折曲板部43a,43bを構成している。可動フレーム部材41a,41bのL字状の垂直な内面には、その上端から少し下がった高さ位置に、該内面からガイドフレーム25側に直角に延出する一定狭幅の突板部44a,44bが、長手方向の両端部を除く略全長に亘って一体に形成されている。これにより、可動フレーム部材41a,41bの上端部内側には、折曲板部43a,43bと突板部44a,44bとの間に隙間が、長手方向の両端部を除く略全長に亘って画定される。この隙間には、前部カバー4cおよび後部カバー4dの前後側辺部が左右方向の略全長に亘って挿入され、操作部3が前後方向(Y軸後方向)に移動するときに、その移動に合わせて蛇腹構造の前部カバー4cおよび後部カバー4dを伸縮させるためのガイドとなる。
図2および図4に示すように、可動フレーム部材41a,41bの長手方向の両端部は、突板部44a,44bより下側の部分が切り欠かれており、切欠残部が長手方向の突出部45a,45bを構成している。突出部45a,45bは、アクチュエータ機構20をケーシング6内に収容したときに、それぞれケーシング6の正面および背面側内壁(正面フレーム6a、背面フレーム6b)の折曲板部17a,17bと段差面16a,16bとで画定された隙間内に余裕をもって挿入される。
(5)操作部3
図5に示すように、操作部3はアクチュエータ機構20の上方に取り付けられている。操作部3は、比較的短い垂直な操作ロッド48と、その上端部に設けられたハンドル部材49とで構成されている。ハンドル部材49は、使用者Uが片手で掴むことができるように、比較的厚いディスク状に形成されている。なお、ハンドル部材49は、本実施形態では、使用者Uが掴んだ手で回すことができるように、操作ロッド48を中心に回動可能に取り付けられているが、固定するようにしてもよい。操作ロッド48は、その下端部側で操作ロッド48に作用する力(ハンドル部材49に作用する力)を検出する力センサ51と一体化されている。
図5および図6に示すように、操作部3は取付プレート52に取り付けられている。取付プレート52は、矩形の板状部材からなり、可動フレーム41の長手方向に直交する幅方向に可動フレーム41の内幅より若干小さい寸法を有する。取付プレート52の、可動フレーム41の長手方向に沿う両側部は、下面側が直角に切除されており、切除残部が折曲板部43a,43bと突板部44a,44bとで画定された隙間の高さ寸法より小さな寸法の側辺部54a,54bを構成している。
取付プレート52は、側辺部54a,54bが折曲板部43a,43bと突板部44a,44bとで画定された隙間内に余裕をもって挿入され、ガイド部23と可動フレーム部材41a,41bとの間に画定された溝状空間Sa,Sbを横断するようにスライダブロック27に取り付けられている。
(6)力センサ51
力センサ51には、検出原理の異なる種々のタイプが知られているが、本実施形態では、力センサ51として歪みゲージを用いた市販の6軸力覚センサが採用されている。歪みゲージは図示を省略した起歪体に貼り付けられている。起歪体は、力とトルクを受けて変形する部材であり、6軸力覚センサの性能を左右する重要な部材である。
一般に、6軸力覚センサは、力とトルク(モーメント)の大きさと方向を3次元空間ベクトルで示すセンサであり、直交するX,Y,Z軸方向の力F(Fx,Fy,Fz)およびこれら3軸周りに作用するトルクT(Tx,Ty,Tz)を検出する。また、演算により接触情報も求め得る有用なセンサである。市販の6軸力覚センサは、通常、固定側の基部と、検出すべき外力を受けるための検知部とを有している。
本実施形態では、6軸力覚センサのX軸およびY軸が、アクチュエータ機構20のX軸方向およびY軸方向とそれぞれ一致するように配置されている。また、図5に示すように、力センサ51は概ね短円柱状の基部とその上面に設けられた検知部とを有している。力センサ51の検知部には、その上面中央に操作ロッド48が垂直に固定されている。力センサ51の基部は、取付プレート52を介してY軸方向アクチュエータ21のスライダブロック27と一体化されている。
力センサ51は、使用者Uの上肢が操作部3を動かしまたは操作部3により動かされるときに、操作ロッド48が使用者Uの上肢から直接受ける力Fおよび各軸周りに作用するトルクTを、(Fx,Fy,Fz,Tx,Ty,Tz)として検出可能に構成されている。なお、本実施形態では、後述するように、力センサ51を、操作部3に作用するX軸方向の力FxおよびY軸方向の力Fy(厳密には、操作部3に作用する力FのX軸方向のベクトル成分FxおよびY軸方向のベクトル成分Fy)、すなわち(Fx,Fy)の検出のみに使用する。
(7)リミットセンサ55a,55b,61a,61b
図2に示すように、運動訓練装置1は、Y軸方向アクチュエータ21による操作部3のY軸方向の可動範囲を制限するために、一対のリミットセンサ55a,55bを有している。リミットセンサ55a,55bは、ガイド部23と一方(図2右側)の可動フレーム部材41bとの間の水平面上に、それぞれケーシング6の正面および背面側内壁の内側に配置されている。
リミットセンサ55a,55bには、アームレバーを水平方向に回動可能にばね付勢した公知の構造が採用されている。図6に示すように、取付プレート52の下面には、リミットセンサ55a,55bのアームレバーを回動させるための作動ブロック56が突設されている。操作部3がY軸方向に移動して作動ブロック56がアームレバーを回動させると、リミットセンサ55a,55bはオン状態となる。
また、運動訓練装置1は、図2に示すように、X軸方向アクチュエータ22によるY軸方向アクチュエータ21のX軸方向の可動範囲を制限するために、一対のリミットセンサ61a,61bを有している。リミットセンサ61a,61bは、背面側の左右補強部材14a上に、それぞれケーシング6の左右側内壁の内側に配置されている。
リミットセンサ61a,61bも、アームレバーを水平方向に回動可能にばね付勢した公知の構造を有している。図7に示すように、一方(図2の左側)の可動フレーム部材41aの下面には、リミットセンサ61a,61bのアームレバーを回動させるための作動ブロック62が取付プレート63を介して突設されている。操作部3がY軸方向アクチュエータ21とともにX軸方向に移動して作動ブロック62がアームレバーを回動させると、リミットセンサ61a,61bはオン状態となる。
図8は、アクチュエータ機構20における操作部3のX軸およびY軸方向の可動範囲を示したものである。また、図10は、XY平面での操作部3の可動範囲とリミットセンサ55a,55b,61a,61bとの関係を示している。
図10に示す破線は、リミットセンサ55a,55b,61a,61bが作動ブロック56,62を検出しリミットセンサ55a,55b,61a,61bがオン状態に移行する位置を示している。この破線の位置から所定距離(後述するD1)内側には斜線で表した領域が設けられている。この斜線で表した操作部3が移動可能なXY平面での中心部を含む領域は、使用者Uの運動訓練が可能な領域であり、本実施形態では表示装置80(図11参照)が操作者Uの運動訓練中または訓練後の操作部3の軌跡や負荷変動を表示(提示)可能な領域でもあることから、以下、この領域を力覚提示エリアAfという。
リミットセンサ55a,55b,61a,61bのアームレバーは、リミットセンサ55a,55b,61a,61bがオン状態に移行した後、なおも回動可能に構成されており、アームレバーの回動限界がX軸およびY軸方向アクチュエータ22,21の機械的動作限界となる。この機械的動作限界の位置をXY平面上で表すと、図10の外枠となる。以下、力覚提示エリアAfの外側かつ図10の外枠内の領域を安全対策エリアAsという。
なお、本実施形態では、リミットセンサ55a,55b,61a,61bがオン状態に移行する位置間の寸法が540[mm](X軸方向)×550[mm](Y軸方向)に設定されている。また、リミットセンサ55a,55b,61a,61bがオン状態に移行する位置から力覚提示エリアAfの境界線までの距離D1がX軸およびY軸方向ともに30[mm]、リミットセンサ55a,55b,61a,61bがオン状態に移行する位置からX軸およびY軸方向アクチュエータ22,21の機械的動作限界までの距離D2がX軸およびY軸方向ともに20[mm]に設定されている。従って、力覚提示エリアAfの寸法は、510[mm](X軸方向)×520[mm](Y軸方向)に設定されている。
(8)ホームポジションセンサ57,64
図2に示すように、運動訓練装置1は、操作部3のX軸方向の初期位置を設定するためのホームポジションセンサ64を有している。ホームポジションセンサ64は、ケーシング6の背面側の左右補強部材14a上に、リミットセンサ61bよりも中央寄りに配置されている。図7に示すように、可動フレーム部材41aの下面には、垂直下向きに突出する板状のセンサフラグ部材65が、操作部3をX軸方向に移動させたときに、ホームポジションセンサ64の投光部と受光部の間隙を通過し得るように、取付プレート63に取り付けられている。
また、運動訓練装置1は、図2に示すように、操作部3をY軸方向の初期位置を設定するためのホームポジションセンサ57を有している。ホームポジションセンサ57は、可動フレーム部材41bとの間の水平面上に、リミットセンサ55aよりも背面寄りに配置されている。取付プレート52には、X軸方向のセンサフラグ部材65と同様に、垂直下向きに突出する板状のセンサフラグ部材(不図示)が、操作部3をY軸方向に移動させたときに、ホームポジションセンサ57の投光部と受光部の間隙を通過し得るように取り付けられている。
ホームポジションセンサ64,57は、小さな隙間をもって対向配置した投光部と受光部とを有する透過一体型センサであり、本実施形態では、受光部に入光するとオフ状態、受光部が遮光されるとオン状態となるものが用いられている。
図9は、操作部3がホームポジションに位置した状態を示している。図9に示すように、操作部3のホームポジションは、X軸およびY軸方向アクチュエータ22,21の交差中央位置を基準としたときに、Y軸方向で正面寄りかつX軸方向で右寄りに設定されている。このため、使用者Uは、図1に示すように運動訓練装置1の正面に位置したときに、右手HRを前に伸ばすと直ぐに操作部3のハンドル部材49に触れることができる。
(9)電気系
さらに、運動訓練装置1は、ケーシング6内に、運動訓練装置1を制御する制御部70(図11参照)と、商業交流電力から上述した機構部および制御部70を駆動/作動させるための直流電力に変換する電源部(不図示)とを備えている。
1.2.制御部
1.2.1.制御部概要
図11に示すように、制御部70は、高速演算を行うCPU、基本制御プログラムおよびプログラムデータを記憶したROM、CPUのワークエリアとして働くとともに種々のデータを一時的に記憶するRAMおよびこれらを接続する内部バスで構成されたMCU71を有している。
MCU71の内部バスは外部バスに接続されている。外部バスには、X軸およびY軸方向駆動モータ38,30の駆動を制御する駆動制御部72、上述した各センサからの信号を処理する信号処理部73、大容量フラッシュメモリやハードディスク等の不揮発性メモリ74、マウスやキーボード等の入力装置79から入力された情報を制御する入力制御部75、ディスプレイ等の表示装置80への表示(描画)を制御する表示制御部76、状態表示ランプ9a~9cを点灯させるランプ点灯回路77およびインターフェース(I/F)81を介してノートパソコン等の外部装置との通信を制御する通信制御部78が接続されている。
1.2.2.制御部詳細
(1)駆動制御部72
駆動制御部72は、X軸方向駆動モータ38の駆動を制御するX軸方向モータドライバと、Y軸方向駆動モータ30の駆動を制御するY軸方向モータドライバとで構成されている。X軸およびY軸方向モータドライバはそれぞれ制御IC(不図示)を有している。各制御ICは、MCU71から指令された電流値(出力電流Ii、デューティ)に従って、X軸またはY軸方向駆動モータ38,30への電力供給を制御する(図13(B)も参照)。
(2)信号処理部73
信号処理部73は、信号処理IC(不図示)で力センサ51から出力された信号を処理しMCU71に出力する。すなわち、6軸力覚センサに設けられた歪みゲージの信号をブリッジ回路で電圧(変化)信号に変換し、ローパスフィルタ(LPF)で高周波ノイズを除去した後、オペアンプ等の増幅回路で微弱な信号を増幅する。次に、増幅された信号をA/Dコンバータでデジタル値に変換し、信号処理ICで歪み-荷重変換行列演算を行って力とトルクの分力(Fx,Fy,Fz,Tx,Ty,Tz)を算出する。
ただし、本実施形態では、MCU71が操作部3に作用するX軸方向の力Fx、Y軸方向の力Fyのみを使用するため、信号処理部73は演算した(Fx,Fy)の値をMCU71に出力する。なお、本実施形態では、上述したA/Dコンバータのサンプリングレートが10[ms]に設定されているため、信号処理部73は10[ms]ごとに(Fx,Fy)の値をMCU71に出力する。
さらに、信号処理部73は、エンコーダ30a,38aから出力されたパルス数をカウントしたカウント値と回転方向のデフォルト値(例えば、X軸またはY軸方向駆動モータ38,30が正転とき0、逆転のとき1)とをMCU71に出力する。
また、信号処理部73は、ホームポジションセンサ57,64がオン状態となったか(ホームポジションを検出したか)、および、リミットセンサ55a,55b,61a,61bがオン状態となったか否かを表すデフォルト値(例えば、オフ状態のときのデフォルト値が0、オン状態のときのデフォルト値が1)をMCU71に出力する。
さらに、信号処理部73は、マニュアル操作ボタン10a~10cが押下された否かを監視して(マニュアル操作ボタン10a~10cの押下を検出する各スイッチング素子の出力がハイレベルとなったか否かを参照して)、デフォルト値(例えば、オフ状態のときのデフォルト値が0、オン状態のときのデフォルト値が1)をMCU71に出力する。なお、各スイッチング素子の出力側と上述した信号処理ICの入力側との間には、信号処理ICの破損を防止するために保護抵抗が挿入されている。
本実施形態では、力センサ51の(Fx,Fy)の値が10[ms]ごとにMCU71に出力されることから、この周期に合わせて以上の信号情報をMCU71に出力する。すなわち、信号処理部73は、例えば、(Fx,Fy,エンコーダ38aのカウント値,X軸方向駆動モータ38の回転方向のデフォルト値,エンコーダ30aのカウント値,Y軸方向駆動モータ30の回転方向のデフォルト値,ホームポジションセンサ57の状態のデフォルト値,ホームポジションセンサ64の状態のデフォルト値,リミットセンサ55aの状態のデフォルト値,リミットセンサ55bの状態のデフォルト値,リミットセンサ61aの状態のデフォルト値,リミットセンサ61bの状態のデフォルト値,緊急停止ボタン10aの状態のデフォルト値,一時停止ボタン10bの状態のデフォルト値,イニシャルボタン10cの状態のデフォルト値)で表される信号情報を10[ms]ごとにMCU71に出力する。
なお、MCU71は、緊急停止ボタン10a、一時停止ボタン10bの状態のデフォルト値が緊急停止ボタン10a、一時停止ボタン10bが押下されたことを表すときには、駆動制御部72を介してX軸およびY軸方向駆動モータ38,30の駆動を停止させるように制御する。この点は、リミットセンサ55a,55b,61a,61bのデフォルト値がオン状態に移行したことを表すデフォルト値の場合も同じである。また、MCU71は、緊急停止ボタン10aが押下されたときおよびリミットセンサ55a,55b,61a,61bがオン状態に移行したときは、後述する軌跡設定ルーチン、負荷検出ルーチンおよび運動訓練ルーチンを直ちに終了する。
また、MCU71は、イニシャルボタン10cの状態を表すデフォルト値がイニシャルボタン10cが押下されたことを表すときには、操作部3をホームポジションに位置付けるため、駆動制御部72を介して予め設定された速度でX軸およびY軸方向駆動モータ38,30を駆動させ、信号処理部73から出力されたホームポジションセンサ57のデフォルト値、ホームポジションセンサ64のデフォルト値がそれぞれホームポジションに位置することを表すデフォルト値となったときに、X軸およびY軸方向駆動モータ38,30の駆動を個別に停止させる。
(3)ランプ点灯回路77
ランプ点灯回路77は、緑色LED9a、白色LED9b、赤色LED9cを点灯させる3つの点灯回路で構成されている。各点灯回路はMOSFET等のスイッチング素子を有しており、MCU71が運動訓練装置1の状態に応じてデジタル信号(ハイレベル信号)をスイッチング素子のゲートに出力することでオン状態となり、緑色LED9a、白色LED9bおよび赤色LED9cを個別に点灯させる。なお、各スイッチング素子のゲートとMCU71との間には、MCU71の破損を防止するために保護抵抗が挿入されている。
(4)その他
不揮発性メモリ74、入力制御部75、表示制御部76および通信制御部78には公知のものを用いることができる。付言すると、不揮発性メモリ74は、使用者Uの個人データや運動訓練履歴等の運動訓練に関するデータを保存する。また、表示制御部76は、MCU71の処理周期(10[ms])が表示装置80の垂直帰線周期と相違することから、垂直帰線周期と一致した1/60[s](16.6[ms])に一度の周期で行われる垂直帰線割込(Vsync)がなされたか否かを判断し、否定判断のときはMCU71から指令された描画情報を追加し、肯定判断のときは現在の描画情報を表示装置80に出力する。
2.動作
次に、本実施形態の運動訓練装置1の動作について説明する。
2.1.動作制御概要
図12に示すように、MCU71は、後述する能動訓練モードにおいて、信号処理部73から出力された操作部3に作用するX軸方向の力FxおよびY軸方向の力Fyから、平面運動における静止摩擦を模擬した仮想モデルIMを介して操作部3に発生させるべきX軸方向の速度vvxおよびY軸方向の速度vvyを算出し、駆動制御部72に出力する。
仮想モデルIMは下記式で表される。
Figure 2022088770000002
式(1)上段は操作部3の静止状態を示し、下段は動作状態を示す。mは操作部3の仮想質量、vviは操作部3の速度、cは粘性減衰係数、μは摩擦係数、Fは(Fx,Fy)の合成力、μは最大静止摩擦力、vvstは操作部3が静止しているとみなす領域であり、vvst<<1として与えられる。また、uは操作部3の速度の大きさを1に正規化したときの各軸方向の分速度であり、(u +u )は1となる。式(4)は例えば力センサ51に対するノイズやMCU71の計算誤差の影響で動摩擦力が過大となることを防ぐために設けられている。
式(1)上段は、図14(A)に示すように、合成力Fが静止摩擦を再現するための円形の静止摩擦エリア90内にあるときの操作部3の速度(vvx,vvy)の計算式となり、下段は、図14(B)(C)に示すように、合成力Fが静止摩擦エリア90外にあるときの操作部3の速度(vvx,vvy)の計算式となる。静止摩擦エリア90は、式(1)上段によりμsおよびvvstの値によって大きさが定まる。μsおよびvvstの値は操作部3に発生させるべき速度(指令速度)の大きさによって決定できるので、静止摩擦エリア90の半径の値は任意の値に設定することができる。
なお、力センサ51が検出するX軸およびY軸方向の力(Fx,Fy)は、X軸およびY軸方向駆動モータ38,30の駆動力により操作部3に発生させるべき力の分力として検出される。
図13(A)に示すように、仮想モデルIMを用いて算出した操作部3の速度(vvx,vvy)を指令速度とし、駆動制御部72によって実際の操作部3の速度(v,v)を指令速度に追随させることで仮想運動環境を具現する。なお、MCU71による具体的制御については後述する。
ここで、X軸およびY軸方向駆動モータ38,30にDCサーボモータを用いることから駆動制御部72(モータドライバ)の制御モードをPID制御に設定することで、指令速度に高精度に追随させることができる。しかし、仮想質量mを小さくして訓練負荷を小さく設定した場合には、PID制御の積分動作による応答遅れが影響し、操作中に操作部3が振動的になることが確認されている。そこで、力覚提示エリアAfにおいて、制御モードを、PID制御から偏差の積分値に比例した出力(電流値)を算出するための積分項を除いたPD制御(またはさらに偏差の微分値に比例した出力を算出するための微分項を除いたP制御)とし比例ゲイン(Kp)を高く設定することで、定常偏差は生じるものの応答性が改善され、操作中に生じる操作部3の振動を抑制する。
一方、指令速度(vvx,vvy)対する定常偏差が大きいと、操作部3の機械的動作限界(図10参照)に対する位置精度が低下することから、操作部3が運動訓練装置1の機械的作動限界に衝突して使用者Uや運動訓練装置1に衝撃に与えるおそれがある。この場合、操作部3の振動を抑制するためにフィルタ等を設けることも考えられるが、同様に応答遅れが影響し位置精度が低下する。このような衝撃を未然に防止するために、機械的動作限界に対して操作部3の力覚提示エリアAfの境界線の設定に大きな余裕をとる必要があるが、その結果、力覚提示エリアAfが極端に狭くなってしまう。そこで、位置精度を重視すべき領域(上述した安全対策エリアAs)では、PID(またはPI)制御とする。
2.2.動作詳細
次に、本実施形態の運動訓練装置1の動作についてMCU71のCPU(以下、CPUという。)を主体として説明する。
運動訓練装置1により使用者Uが運動訓練を行う際には、(1)使用者Uが操作部3を掴みその上から訓練指導者が使用者Uの手をとって使用者Uの上肢状況に応じた動作範囲で操作部3を移動させることで、操作部3が辿る軌跡を設定するための軌跡設定モードと、(2)使用者Uのみが操作部3を掴み軌跡設定モードで設定された軌跡を辿ることで、使用者Uによる操作部3の位置(軌跡)とそのときに操作部3が受ける負荷とを検出するための負荷検出モードと経て、(3)運動訓練モードで行われる。なお、以下では、各モードでのCPUによる制御がなされる前に、イニシャルボタン10cが押下され操作部3はホームポジションに位置しているものとして説明する。
(1)軌跡設定モード
CPUは、軌跡設定モードにおいて、図15に示す軌跡設定ルーチンを実行する。軌跡設定ルーチンでは、まずステップ(以下、Sと略称する。)102において、駆動制御部72を介してX軸およびY軸駆動モータ38,30を励磁させる。操作部3は減速ギアユニット39,31を介してX軸およびY軸駆動モータ38,30に連結されているため、訓練指導者の主導で使用者Uが操作部3を移動させる際に使用者Uには所定の負荷が掛かる。なお、S102または次に述べるS104により前に、使用者Uが訓練指導者の主導によって辿る予定の全体軌跡(参照軌跡)を予め表示装置80に表示するようにしてもよい。
次にS104で上述した信号情報を取り込み、S106において操作部3の位置(Px,Py)を算出する。すなわち、CPUは、信号情報に含まれるエンコーダ38aのカウント値を一周期(10[ms])前のカウント積算値に積算することで操作部3のX軸方向の位置Pxを算出し、同様に、信号情報に含まれるエンコーダ30aのカウント値を一周期前のカウント積算値に積算することで操作部3のY軸方向の位置Pyを算出する。その際、信号情報に含まれるX軸およびY軸方向駆動モータ38,30の回転方向のデフォルト値を参照してカウント値を加算するか減算するかを判断する。
次いでS108において、操作部3の移動が終了したか否かを判断する。すなわち、操作部3の位置(Px,Py)が予め設定された設定時間(例えば、1.5[s]の間)、ほぼ同じ値か否かを判断し、否定判断のときは次の(10[ms]後の)操作部3の位置を検出するためにS104に戻り、肯定判断のときはS110に進む。従って、CPUは、10[ms]ごとに操作部3の位置(Px,Py)を算出する。
S110では、10[ms]ごとに算出した操作部3の位置(Px,Py)のデータを時系列順に並べた軌跡情報Iとして不揮発性メモリ74に保存して軌跡設定ルーチンを終了する。その際、CPUは、S108で説明した設定時間の操作部3の位置(Px,Py)のデータを削除して不揮発性メモリ74に保存する。
(2)負荷検出モード
CPUは、負荷検出モードにおいて、図16に示す負荷検出ルーチンを実行する。負荷設定ルーチンでは、S202で不揮発性メモリ74に保存した軌跡情報Iを読み出し、次のS204において操作部3が軌跡情報Iの位置となるように(操作部3が移動軌跡設定モードで設定された軌跡を再現するように)駆動制御部72を介してX軸およびY軸方向駆動モータ38,30を駆動させる。すなわち、軌跡情報Iの処理対象の現在の位置と軌跡情報Iの次の位置とのそれぞれX軸方向およびY軸方向の距離をこの間の移動時間10[ms]で割ることで求めた指令速度を駆動制御部72に出力する。
次にS206で信号情報を取り込み、S208において信号情報に含まれるエンコーダ38a,30aのカウント値を積算することで操作部3の位置(Px,Py)を算出する。次いでS210で信号情報に含まれる、操作部3に作用するX軸およびY軸方向の力(Fx,Fy)を合成した合成力Fを算出する(図14、式(2)も参照)。次のS212では、S208で算出した操作部3の位置(Px,Py)およびS210で算出した合成力F(負荷)を表示制御部76に出力して表示装置80に操作部3の位置および負荷を表示させる。このとき、表示制御部76は一周期前の画情報に今回(直近)の描画情報を追加した画情報を生成するとともに、予め定められた画像表示上の原点位置を基準に平行移動処理を行う。
次にS214において、S202で読み出した軌跡情報Iの最後の位置に操作部3を位置付ける処理を行ったか否かを判定することで操作部3の移動が終了したか否かを判断する。否定判断のときは負荷検出を続行するためにS204に戻り、肯定判断のときはS216に進む。S216では、10[ms]ごとに算出した操作部3の位置(Px,Py)のデータおよび操作部3に作用する力(Fx,Fy,F)のデータを時系列順に並べた軌跡-負荷情報I(Px,Py,Fx,Fy,F)として不揮発性メモリ74に保存して負荷設定ルーチンを終了する。
図20は、S214における肯定判断時点で表示装置80に描画された画面を模式的に示した(合成力F(負荷)を絶対値|F|で示した)もので、画面上部には使用者Uが操作部3を移動させて辿った軌跡、下部には時間軸を横軸にとったときの軌跡の各位置における負荷変動が表示されている。図20の例では、時刻T1から時刻T2の範囲で、使用者Uから操作部3に大きな力が加わったことが示されている。表示制御部76は、CPUの指示(CPUから出力される閾値情報)に従って、例えば、S214における肯定判断後にこの範囲の表示の色を変えるように表示装置80を制御してもよい。或いは、図20に示すように、鎖線で囲って強調するようにしてもよい。時刻T1から時刻T2の範囲での軌跡を参照すると、使用者Uが操作部3をうまく操作できないと推測でき、運動訓練者はこのデータを参照して使用者Uの運動訓練プログラムを作成することができる。
(3)運動訓練モード
CPUは、運動訓練モードにおいて、図17に示す運動訓練ルーチンを実行する。なお、運動訓練モードには、使用者Uが自ら軌跡-負荷情報Iの軌跡をなぞるように操作部3を移動させる能動訓練モードと、自動的に軌跡-負荷情報Iの軌跡を辿る操作部3に引っ張られて運動する受動訓練モードとがある。受動訓練モードは主としてリハビリ中の人を対象とする運動訓練モード、能動訓練モードはリハビリ最終段階の人や健常者を対象とする運動訓練モードとして想定されている。なお、運動訓練装置1は、健常者の運動訓練にも対応可能なようにFx、Fyの最大値:90[N]、最大加速度:8[m/s]、最大速度:1.24[m/s]に設定されている。
運動訓練ルーチンでは、まずS302において、不揮発性メモリ74に保存した軌跡-負荷情報Iを読み出す。次いでS304で能動訓練モードおよび受動訓練モードのいずれを選択するかを問い合わせる画面を表示装置80に表示させ、S306でいずれかの選択(入力)があるまで待機する(S306で否定判断)。選択があると(S306で肯定判断)、次のS308において能動訓練モードが選択されたか否かを判断し、肯定判断のときはS310に進み、否定判断のときはS328に進む。
S310では、調整値情報を要求する画面を表示装置80に表示させる。この調整値は、上述した仮想モデルIMを表す式(1)のパラメータ(仮想質量m、粘性減衰係数c、摩擦係数μ、最大静止摩擦力μ、操作部3が静止しているとみなす領域vvst)であるが、本実施形態では、表示装置80に、例えば運動量や静止摩擦力の大きさに応じて予め定めた幾とおりかの選択子にその説明(例えば、運動量:大、静止摩擦力:中)を加えた画面を表示したり、運動量や静止摩擦力の大きさを調整可能に表したレベルメータを表示したりすることでパラメータの入力を容易にしている。
次にS312において、調整値情報の入力があるまで待機し(S312で否定判断)、入力があると(S312で肯定判断)、次のS314において調整値情報を取り込んで上述したパラメータの値を確定させるとともに、確定したμおよびvvstの値から図14に示した静止摩擦エリア90の半径の値(後述する所定値、図18のS408も参照)を決定する。
次いでS316において、上述した信号情報を監視して操作部3に力(Fx,Fy)が作用したか否か、および、操作部3の位置がホームポジションから移動したか否かを判定することで、能動訓練が開始されたか否かを判断する。なお、能動訓練開始前(S316の判定でいずれかが否定判定のとき)は、X軸およびY軸方向駆動モータ38,30は励磁状態にあり、操作部3はホームポジション(0,0)に位置している。
能動訓練が開始されると(S316の判定で双方が肯定)、S318で信号情報を取り込み、S320において信号情報に含まれるエンコーダ38a,30aのカウント値を積算することで操作部3の位置(Px,Py)を算出する。また、S320では、信号情報に含まれるエンコーダ38a,30aのカウント値、すなわちX軸およびY軸方向駆動モータ38,30の回転速度(と減速ギアユニット39,31の減速ギア比と)から操作部3の実際の速度(v,v)を算出する。
次のS322では、駆動制御部72に指令(出力電流Ii)を与えるための駆動指令処理を実行する。図18は、S322の駆動指令処理の詳細を示す駆動指令処理サブルーチンのフローチャートを示したものである。駆動指令処理サブルーチンでは、S402において、軌跡-負荷情報Iの軌跡位置とS320で算出した位置(Px,Py)との位置差(距離差)が予め定められた許容範囲内か否かを判断し、否定判断のときは使用者Uの上肢の運動範囲が広がり過ぎるとみなし駆動指令処理サブルーチンを終了して図17のS342に進み、肯定判断のときはS404に進む。
S404では、信号情報に含まれる操作部3に作用する力(Fx,Fy)を合成した合成力Fを算出し、次のS406において、合成力Fの大きさ(絶対値)|F|と、S320で算出した操作部3の位置(Px,Py)に最も近い軌跡-負荷情報Iの操作部3の位置における合成力Fの大きさ|F|との差(負荷差)が予め定められた許容範囲内か否かを判断し、否定判断のときは使用者Uに予定以上の負担が掛り過ぎているとみなし駆動指令処理サブルーチンを終了して図17のS342に進み、肯定判断のときはS408に進む。
S408では、合成力Fが図14に示した静止摩擦エリア90内にあるかを判定するために、合成力Fの大きさ|F|が所定値(図17のS314で算出した静止摩擦エリア90の半径の値)以下か否かを判断し、肯定判断のときは、S410で式(1)上段により指令速度(vvx,vvy)を算出してS414に進み、否定判断のときは、S412で式(1)下段により指令速度(vvx,vvy)を算出してS414に進む。ここで留意すべき点は、S410およびS412(特に、S412)で式(1)を用いて指令速度(vvx,vvy)を算出する際に、合成力Fに対応する速度vを求め、その速度vをX軸およびY軸方向の速度vvx,vvyに分解して指令速度(vvx,vvy)を算出することである。
S414では、S320で算出した操作部3の位置(Px,Py)が力覚提示エリアAf(図10参照)内か否かを判断し、肯定判断のときは、S416においてX軸およびY軸方向駆動モータ38,30に対する制御モードをPD制御またはP制御と決定し、否定判断のとき(安全対策エリアAs内のとき)は、S418においてX軸およびY軸方向駆動モータ38,30に対する制御モードをPID制御またはPI制御と決定する。
次に、CPUは、S420において、S320で算出した操作部3の実際の速度(v,v)およびS410またはS412で算出した指令速度(vvx,vvy)、並びに、S416またはS418で決定した制御モードに従って出力電流Iiすなわち駆動量を算出し、算出した出力電流Ii(デューティ)を駆動制御部72に指令して駆動指令処理サブルーチンを終了し、図17のS324に進む。
ここで、図13を参照してS420での出力電流Iiの算出処理について簡単に補足する。図13(A)は駆動モータ制御の概念、図13(B)はCPUによる本実施形態での駆動モータ制御を示したものである。図13(A)に示すように、CPUは、操作部3の実際の速度が指令速度に追随するように、a)PD制御(Proportional-Differential Control)若しくはP制御(Proportional Control)、または、b)PID制御(Proportional-Integral-Differential Control)若しくはPI制御(Proportional-Integral Control)のいずれかの制御モードでX軸およびY軸方向駆動モータ38,30の駆動を制御する。
このため、CPUは、図13(B)に示すように、決定した制御モードに従って出力電流Iiを算出する。すなわち、制御モードをPD(P)制御と決定した場合には偏差の積分値に比例した電流分を加えず、PID(PI)制御と決定した場合には偏差の積分値に比例した電流分を加えて出力電流Iiを算出する。その際、CPUは、MCU71のROMに格納されRAMに展開された、指令速度、減速ギアユニット31または減速ギアユニット39の減速ギア比、モータの回転速度およびモータへの出力電流(デューティ)の関係を表した関係式を参照する。なお、本実施形態では、CPUは、一周期前に算出したモータの回転速度と、今回(直近に)検出された実際のモータの回転速度とから偏差を算出する。
図17のS324では、S320で算出した操作部3の位置(Px,Py)および図18のS404で算出した合成力F(負荷)、並びに、軌跡-負荷情報Iの位置(Px,Py)および軌跡-負荷情報Iの当該位置での合成力Fのデータを表示制御部76に出力して表示装置80に操作部3の軌跡および負荷変動を表示させる。なお、軌跡-負荷情報Iの位置および合成力Fのデータは、時系列順に纏められた軌跡-負荷情報I(Px,Py,Fx,Fy,F)の中から10[ms]ごとに順次選択される。これにより、表示装置80の画面上部には、負荷検出モードで操作者Uが操作部3を操作したときのスピードと能動訓練モードで操作部3を操作したときのスピードとの違いがリアルタイムで表示される。
次にS326において、図15のS108と同様に、操作部3の位置(Px,Py)が予め設定された設定時間、ほぼ同じ値か否かを判定することで、操作部3の移動が終了したか否かを判断する。否定判断のときは使用者Uの能動訓練を続行するためにS318に戻り、肯定判断のときはS342に進む。
図21は、S326における肯定判断時点で表示装置80に描画された画面を模式的に示した(合成力Fを絶対値|F|で示した)もので、画面上部には軌跡-負荷情報Iに従って表示された軌跡(実線)および使用者Uが軌跡-負荷情報Iの軌跡をなぞった際の軌跡(破線)、下部には時間軸を横軸にとったときの、軌跡-負荷情報Iに従って表示された負荷変動(実線)および使用者Uが軌跡-負荷情報Iの軌跡をなぞった際の負荷変動(破線)が表示されている。表示制御部76は、CPUの指示に従って、例えば、S326における肯定判断後に実線と破線との表示の色を変えて表示装置80に表示させるようにしてもよい。
一方、図17のS308で否定判断のときは、S328~S340(受動訓練モード)での処理を実行する。S328~S340での処理は、原則的にS310~S326(能動訓練モード)での処理と同じである。以下、異なる点について説明する。なお、受動訓練モードでは、力センサ51が検出するX軸およびY軸方向の力(Fx,Fy)は、X軸およびY軸方向駆動モータ38,30の駆動力と使用者Uが操作部3に及ぼす力の差分の分力として検出される。
まず、能動訓練モードではS310~S314で調整値情報を取り込んで所定値(静止摩擦エリア90の半径の値)を算出するのに対し、受動訓練モードでは使用者Uが自動的に動く操作部3の動きに追随して運動することが目的のため、調整値は予め定められており上述した所定値は算出されない。このため、受動訓練モードではS310~S314に対応するステップを欠く。
また、S316に対応するS328では、信号情報を監視して操作部3に力(Fx,Fy)が作用したか否かを判定することで、受動訓練が開始したか否かを判断する。肯定判断のときは、次のS330で駆動制御部72を介してX軸およびY軸方向駆動モータ38,30の駆動を開始し、軌跡-負荷情報Iを構成する最初の位置(Px,Py)に操作部3を位置付ける。すなわち、軌跡-位置情報Iを構成する最初の位置(Px,Py)とホームポジション(0,0)とのそれぞれX軸方向およびY軸方向の距離をこの間の移動時間10[ms]で割ることで求めた指令速度を駆動制御部72に出力する。
さらに、S322に対応するS336の駆動指令処理では、図19に示すように、図18のS402、S414~S418に対応するステップを欠く。この理由も、受動訓練モードでは使用者Uが自動的に動く操作部3の動きに追随して運動することが目的のため、操作部3の移動範囲が図10に示した力覚提示エリアAf内に限られるからである。従って、X軸およびY軸方向駆動モータ38,30の制御モードはPD(P)制御に定められている。
また、図19の駆動指令処理サブルーチンでは、図18のS408~S412に代えて、S456で指令速度を算出する。この指令速度は、図17のS302で読み出した軌跡-位置情報Iの位置となるように10[ms]ごとに指令速度を算出する。すなわち、軌跡-位置情報Iの処理対象の現在の位置と軌跡-位置情報Iの次の位置とのそれぞれX軸方向およびY軸方向の距離をこの間の移動時間10[ms]で割ることで求めた指令速度を駆動制御部72に出力する。従って、式(1)は用いられない。
さらに、S340では、図16のS214と同様に、軌跡-負荷情報Iの最後の位置に操作部3を位置付ける処理を行ったか否かを判定することで、操作部3の移動が終了したか否かを判断する。否定判断のときは受動訓練を続行するためにS332に戻り、肯定判断のときはS342に進む。
S342ではX軸およびY軸方向駆動モータ38,30の駆動を停止させ、次のS342において運動訓練データを不揮発性メモリ74に保存して運動訓練ルーチンを終了する。なお、運動訓練データは、使用者Uの上肢状況の参考のため、図18のS402、S406、図19のS454で否定判断されたときにも保存される。
この運動訓練データには、10[ms]ごとに算出した操作部3の位置(Px,Py)のデータおよび操作部3に作用する力(Fx,Fy,F)のデータを加えた運動訓練軌跡-負荷情報I、能動訓練モードの場合にはさらにS314で確定した調整値および決定した所定値のデータが含まれる。運動訓練軌跡-負荷情報Iは、例えば、(Px,Py,Fx,Fy,F)で表される10[ms]ごとのデータを運動訓練開始時から終了時まで時系列順に並べたデータとなる。
なお、図16のS208(および図17のS334)では、図17のS320と同様に、信号情報に含まれるエンコーダ38a,30aのカウント値から操作部3の実際の速度(v,v)を算出し、S204では、図18のS420と同様に、操作部3の実際の速度(v,v)および指令速度(vvx,vvy)を算出するとともに、所定の制御モード(PD制御またはP制御)における出力電流を駆動制御部72に指令するが、上記では本発明と直接関連しないためその説明を省略した。
3.効果等
次に、本実施形態の運動訓練装置1の効果等について説明する。
3.1.効果
本実施形態の運動訓練装置1では、図18のS408で合成力Fの大きさ|F|が所定値以下か否かを判断し、所定値以下のときに、S410で式(1)上段により指令速度(vvx,vvy)を算出する。すなわち、式(1)上段は(式(1)下段と比較して)X軸およびY軸方向駆動モータ38,30の駆動量を制限する式として機能する。このため、使用者Uが平面運動を行う際に、操作部3が止まっている状態からは一定以上の力を加えないと動かないという静止摩擦を模擬でき、使用者Uが操作部3を操作する際の仮想摩擦力を実現することができる。また、使用者Uが操作部3を停止させる際にも仮想静止力が働き、操作部3を停止させるときに滑らかに停止するといった違和感も防止できる。
また、本実施形態の運動訓練装置1では、図18のS408で合成力Fの大きさ|F|が所定値より小さいか否かを判断し、大きいときに、S412で式(1)下段により合成力Fに対応する速度vを求め、その速度vをX軸およびY軸方向の速度vvx,vvyに分解して指令速度(vvx,vvy)を算出する。このため、式(1)下段により操作部3に作用するX軸方向の力FxからX軸方向の指令速度vvxと、操作部3に作用するY軸方向の力FxからY軸方向の指令速度vvyとをX軸、Y軸独立に算出する場合と比較して、操作部3の斜め方向への移動の際の操作性を向上させることができる(後述する4.試験の比較例1も参照)。
さらに、本実施形態の運動訓練装置1では、仮想モデルIMのパラメータを調整可能に構成したので(S310~S314)、使用者Uの上肢状況に応じて運動訓練を適切に支援することができる。また、パラメータを入力する際に、運動量や静止摩擦力の大きさに応じた入力(調整値)情報からCPUがパラメータを決定するので、入力作業を容易とすることができる。
また、本実施形態の運動訓練装置1では、操作部3が力覚提示エリアAf内にあるときはPD(P)制御でX軸およびY軸方向駆動モータ38,30を制御する(図18のS414、S416、S420)。PID(PI)制御により位置精度が高まることから、操作部3の仮想質量mを小さくして訓練負荷を小さく設定した場合でも、力覚提示エリアAf内では操作部3の振動を抑制(制振)できるので、運動訓練装置1の操作部3の操作性の向上を図る(使用者Uによる平面運動を快適に支援する)ことができる。
さらに、本実施形態の運動訓練装置1では、操作部3が安全対策エリアAs内にあるときはPID(PI)制御でX軸およびY軸方向駆動モータ38,30を制御する(図18のS414、S418、S420)。このため、操作部3が機械的動作限界に衝突することを予防でき使用者Uや運動訓練装置1に掛かる負担をなくすことができるとともに、操作部3の可動領域すなわち使用者Uの運動訓練領域の広さを適正に確保することができる。
3.2.変形例
なお、本実施形態では、図18のS408、S410において、合成力Fの大きさ|F|が所定値以下のときに、式(1)上段により指令速度(vvx,vvy)を実際に算出する例を示したが、本発明はこれに制約されるものではない。例えば、合成力Fの大きさ|F|が所定値以下のときに、指令速度(vvx,vvy)=(0,0)、すなわちX軸およびY軸方向駆動モータ38,30の駆動量をそれぞれ0(励磁状態)とするようにしてもよい。このような態様でも、使用者Uは操作部3を操作する際に仮想摩擦力を違和感なく体感することができる。
また、本実施形態では、図17のS314で所定値(図18、S408も参照)を実際に算出する例を示したが、本発明はこれに制限されるものではなく、所定値を予め設定するようにしてもよい。
さらに、本実施形態では、摩擦係数μをパラメータとした仮想モデルIMについて例示したが、摩擦係数μを用いない仮想モデルで指令速度(vvx,vvy)を算出してもよい。そのような仮想モデルは、例えば、下記式で構成することができる。
Figure 2022088770000003
式(5)上段は、合成力Fが静止摩擦エリア90内にあるときの操作部3の指令速度vvx,vvy)の計算式となり、下段は合成力Fが静止摩擦エリア90外にあるときの操作部3の指令速度(vvx,vvy)の計算式となる。なお、式(5)~(7)のパラメータは仮想モデルIMの場合と同じである。
さらに、本実施形態では、力覚提示エリアAfにおける操作部3の振動を抑制するために、X軸およびY軸方向駆動モータ38,30の双方をPD(P)制御する例を示したが、本発明はこれに限定されず、X軸およびY軸方向駆動モータ38,30のいずれか一方(例えば、Y軸方向駆動モータ38)のみをPD(P)制御し、いずれか他方をPID(PI)制御するようにしてもよい。同様に、安全対策エリアAsにおいて、X軸およびY軸方向駆動モータ38,30のいずれか一方(例えば、Y軸方向駆動モータ38)のみをPID(PI)制御し、いずれか他方をPD(P)制御するようにしてもよい。
また、本実施形態では、力センサ51に市販の歪みゲージを用いた6軸力覚センサを用いる例を示したが、本発明はこれに限らず、2軸または3軸力覚センサや、歪みゲージに代えて、例えば、静電容量式や光学式のものを用いるようにしてもよい。またさらに、本実施形態では、Fx,Fyのみを用いることから、それに応じて歪み-荷重変換行列式を簡素化するようにしてもよい。また、本実施形態では、Fx,Fyのみを用いる例を示したが、操作部3に作用するZ軸方向の力Fzを、図17のS316、S328において、上述した信号情報を監視して操作部3に力Fzが作用したか否かを判定することで、能動訓練や受動訓練が開始したか否かを判断するようにしてもよい。
さらに、本実施形態では、図20、図21に示したように、表示装置80に時間軸に対する負荷変動を表示する例を示したが、時間軸のない、方向と大きさを同時に示すレーダチャートで表示するようにしてもよい。図22はそのようなレーダチャートの一例を示したものである。図22の例では、X軸およびY軸が交差する原点を基準に負荷(合成力F)の方向と大きさとを示している。また、点p、qは軌跡-負荷情報Iの負荷から外れたときの負荷を示している。このようなレーダチャートを用いると、訓練時間が長くなっても時間軸をスクロールさせる必要なくなる。また、操作部3に作用する力の方向と大きさを同時に表示できるため、所定の軌跡でどの方向にどれくらいの負荷が掛かっているかを確認することができる。なお、図20、図21に示した例でも、合成力Fの絶対値|F|ではなく、正負情報を含む合成力Fで表示するようにしてもよい。
また、本実施形態では、図15のS110、図16のS216、図17のS344で情報/データを一律に不揮発性メモリ342に保存する例を示したが、制御部70は通信制御部78を有していることから外部装置に情報/データを送信してもよく、また、例えば、軌跡設定ルーチンに続いて負荷検出ルーチンを続行する場合には軌跡設定ルーチンで取得した軌跡情報IがMCU71のワークエリア内に一時的に格納されおり負荷検出ルーチンでその軌跡情報Iを用いるようにしてもよいことから、保存するか否かを問い合わせた上で不揮発性メモリ74に保存するようにしてもよい。
また、本実施形態では、図9に示した位置をホームポジションとした例を示したが、本発明はこれに制限されるものではない。例えば、入力された操作者Uの利き手の別に応じてCPUがホームポジションの位置を変えるようにしてもよい。
さらに、運動訓練装置1は、運動訓練モードの内容を再現するための再現モードを有するようにしてもよい。再現モードでは、例えば、図17のS302において、不揮発性メモリ74に保存された運動訓練軌跡-負荷情報I、さらに能動訓練モードの場合には既に確定/決定された調整値および所定値のデータを読み出し、S304~S314までの処理を行わないようにすればよい。
また、再現モードでは、運動訓練の内容の一部を再現するようにしてよい。例えば、表示装置80に図21に示した軌跡や負荷変動を表示しその一部を選択させ、その選択した部分だけの運動訓練の内容を再現するようにしてもよい。訓練指導者は、使用者Uがどの移動範囲で上肢を動かし難かったり、力が入りにくかったりするかを確認することができ、使用者Uに合わせた運動訓練プログラムを作成することができる。
さらに、本実施形態では、MCU71のRAMをワークエリアとしてすべてのデータを処理する例を示したが、必要に応じて処理データを暫定的に格納するバッファメモリをMCU71の外部バスに接続するようにしてもよい。また、本実施形態では、入力装置79と表示装置80とを個別に設ける例を示したが、タッチパネル等を用いることによりこれらを一体化するようにしてもよい。この場合には、入力制御部75と表示制御部76も一体化される。
さらに、本実施形態では、信号処理部73の信号処理ICが歪み-荷重変換行列演算を行って(Fx,Fy,Fz,Tx,Ty,Tz)を算出する例を示したが、CPUが行うようにしてもよい。このような態様では、信号処理部73はA/Dコンバータを介して上述した外部バスに接続される。
またさらに、本実施形態では、円形の軌跡を辿る例を示したが、本発明はこれに制約されず、例えば、三角形等の多角形や、ローマ字等の軌跡を辿るようにしてもよい。さらに、本実施形態では、軌跡設定ルーチンで実際に操作部3を移動させ、各位置の値を軌跡情報Iとした例を示したが、予めデータ化された全体軌跡を予め入力しておき、使用者Uが軌跡設定モードを選択したときに、表示装置80に参照軌跡として表示するようにしてもよい。この点は、負荷検出ルーチンや運動訓練ルーチンについても同じである。また、予め基本パターンを複数とおり不揮発性メモリ74に保存しておき、使用者Uに応じて一つの基本パターンを選択するようにしてもよい。またさらに、本実施形態では、リハビリ中の人を想定して軌跡設定モード、負荷検出モードを経て運動訓練モードを実施する例を示したが、健常者の場合には、直ちに運動訓練モードを実施するようにしてもよい。その際、表示装置80に上記の参照軌跡を表示することが望ましい。
さらに、本実施形態では、緊急停止ボタン10aが押下されたときにX軸およびY軸方向駆動モータ38,30を停止させる例を示したが、さらに安全性を高めるために、不図示の電源部と駆動制御部72の間にスイッチング素子を挿入し、CPUは緊急停止ボタン10aの状態のデフォルト値が緊急停止ボタン10aが押下されたことを表すときに、当該スイッチング素子をオフ状態とするようにしてもよい。
また、本実施形態では、カバー4にベローズ状シートを例示したが、これに代えて、例えば樹脂または布製の比較的柔軟なシートで構成し、装置本体2の前後左右各側縁部の内側に配置されたロール機構に、巻取方向に付勢するばね構造によって巻取・引出自在に収容するようにしてもよい。この種のロール機構は、従来、車両や建物の窓を覆うスクリーン等に広く採用されている。また、カバー4の構造には、蛇腹構造やロール機構に限らず、従来公知の種々のものを用いることができる。
さらに、本実施形態では、Y軸方向アクチュエータ21をX軸方向アクチュエータ22の上に配置する例を示したが、本発明はこれに限らず、両者を位置関係を逆にしても、または、構造を異ならせ同一面に配置するようにしてもよい。さらにまた、本実施形態では、ケーシング6の補強構造として左右補強部材14a,14bと前後補強部材13a~13cとが一体化した例を示したが、左右補強部材14a,14bと前後補強部材13a~13cとは、一体化しなくてもよく、また上下方向に離隔していてもよい。
また、本実施形態では、X軸およびY軸方向駆動モータ38,30の停止時に減速ギアユニット39,31のギア比によりモータ軸の回転を防止し操作部3の移動を防止する構造を示したが、例えば、X軸およびY軸方向駆動モータ38,30への電力供給停止時に、その回転を停止させかつ保持するように、電磁ブレーキ等を設けるようにしてもよい。
さらに、本実施形態では、ハンドル部材49が操作ロッド48に取り付けられた例を示したが、本発明はこれに制限されず、ハンドル部材49が操作ロッド48に対して着脱自在に装着されるようにしてもよい。このような態様では、ハンドル部材49は、運動訓練装置1の使用目的、使用者Uの状態等に対応して、使用者Uの上肢または下肢との係合に適した様々な部材と交換することができる。例えば、使用者の手がハンドル部材49をうまく掴むことができない場合には、その手(または上肢)を固定するベルト付きの部材を用いるようにしてもよい。これにより、使用者Uの手(または上肢)から操作ロッド48に力を伝達して操作部3を移動させ、または移動する操作部3から操作ロッド48を介して力を受けて手(または上肢)を動かすことができる。また、使用者Uの下肢を訓練する場合には、同様にハンドル部材49に代えて、使用者の足を載せる台や足を固定するベルト付きの部材を用いるようにしてもよい。
またさらに、本実施形態では、運動訓練装置1を略水平に載置して使用する例を示したが、例えばサンディング訓練を行うために、装置本体2を前後方向または左右方向に傾斜させた状態で使用するようにしてもよい。その際、運動訓練装置1は、その傾斜状態、すなわち傾斜方向および傾斜角度を検出するための傾斜センサ87(図2参照)を有していてもよい。このような傾斜センサ87には、例えばジャイロセンサを用いることができるが、これに限るものではない。このような態様では、運動訓練装置1は、例えば、傾斜角度を調整可能な別個の支持構造上に設置され、傾斜センサ77の出力信号は制御部70に入力され、運動訓練装置1の傾斜方向および傾斜角度の大きさに対応して、X軸およびY軸方向駆動モータ38,30の少なくとも一方の出力を制御するために使用される。
そして、本実施形態では、力覚提示エリアAfや安全対策エリアAsの寸法、処理周期、Fx,Fyの最大値、最大加速度、最大速度、閾値等を具体的な数値で示したが、本発明はこれらに限定されるものではなく、任意の数値を用いることができることは論を待たない。
4.運動訓練中における操作部の運転制御
運動訓練装置1を用いて運動訓練を行うとき、使用者が操作部3を常に、制御部70によって事前に設定された目標軌道に沿って移動するように操作することは、必ずしも容易ではない。例えば、使用者の身体的な障害等のために、操作部3を操作する手や腕、肩等の可動範囲が狭い場合、使用者自身が操作部3に掛ける力を上手く制御したり調節できない場合、操作部3が所定の目標軌道から逸れて移動することがあり得る。
このような場合、使用者にとって適切な運動訓練を行うためには、操作部3を不必要に停止させることなく、移動させながら外れた位置から目標軌道に戻すように制御することが好ましい。このとき、X軸およびY軸方向駆動モータ30,38から操作部3に加わる駆動力が大き過ぎると、使用者および/または運動訓練装置1、特にX軸およびY軸方向駆動モータ30,38並びにその駆動機構に過大な負担を掛けることになり、安全性の問題を生じさせる虞がある。
本実施形態の運動訓練装置1は、運動訓練中の安全性を確保しつつ、使用者に適切な運動訓練を提供し得るように、操作部3を移動させるX軸およびY軸方向駆動モータ30,38の駆動を制御する。制御部70は、運動訓練が受動訓練モードであるか、能動訓練モードであるかに応じて、X軸およびY軸方向駆動モータ30,38の駆動制御を切り替えて行う。以下に、詳細に説明する。
4.1.受動訓練モード
図29は、制御部70が事前に設定した操作部3の受動訓練モードにおける目標軌跡TLと、受動訓練を行う使用者Uの操作によって、目標軌跡TLから外れて操作部3が実際に移動する操作軌跡ALとを示している。同図において、目標軌跡TLは、説明を簡単にするために、所定半径の円形軌道で表している。これに対し、操作軌跡ALは、目標軌跡TLの円形の内方に逸れる円弧状に表している。
操作軌跡AL上に符号LP0~LP4で示す小円は、実際に移動する操作部3の軌跡位置をそれぞれ示している。各軌跡位置LP0~LP4から延びる二重線の矢印K0~K4は、実際の操作部3に作用する速度ベクトルを示している。また、目標軌跡TL上に符号TP0で示す小円は、操作部3の現在位置を、符号TP1~TP4で示す各小円は、それぞれ操作部3の現在位置に対する次の目標位置、即ち軌跡位置LP1~LP4にそれぞれ対応する次の目標位置を示している。目標軌跡TL上の位置TP0,TP1~TP4から延びる破線の矢印R0~R4は、目標軌跡TLに沿って移動する操作部3に作用する速度ベクトルを示している。
本実施形態において、操作部3の目標軌跡TL上の各位置TP0,TP1~TP4は、現在位置TP0を運動訓練の開始点として、一定の時間間隔で設定される。この時間間隔Δtは、後述する受動訓練モードおよび能動訓練モードにおいて使用者のスムーズな運動訓練に支障を生じさせないように事前に設定する。制御部70は、運動訓練の開始と同時に、内蔵するカウンタにより現在位置TP0(LP0)を時刻t0として計時を開始し、かつΔtを加算して算出される各位置TP1~TP4の時刻t1~t4毎に、エンコーダ38a,30aから入力するパルス数に基づいて、操作部3の操作軌跡AL上の現在位置LP1~LP4を決定する。尚、図29には、目標位置TP1~TP4および軌跡位置LP1~LP4を4つずつ記載したが、これは単に説明を簡単にするためのものであって、実際には、目標軌跡上により多くの目標位置が設定される。
図30は、受動訓練モードで実行される使用者の運動訓練において、制御部70が行うX軸およびY軸方向駆動モータ38,30の駆動制御を説明するための回路ブロック図である。制御部70のMCU71は、力センサ51、エンコーダ38a,30a、および不揮発性メモリ74から入力する情報に基づいて操作部3の速度を求め、駆動制御部72に電流値(出力電流Ii、デューティ)を出力して、X軸およびY軸方向駆動モータ38,30への電力供給を制御する。
本実施形態において、制御部70は、操作部3から力センサ51への入力値が予め設定した所定の範囲内にある場合と、前記所定の範囲を超える場合とで、操作部3の駆動制御を切り替えて行う。前記所定の範囲は、目標軌跡TLに沿って移動するように駆動される操作部3を、使用者Uから受ける抵抗力を無視して、強制的にX軸およびY軸方向駆動モータ38,30によって移動させても、使用者Uへの過度な負担を生じさせないように、比較的小さい値に設定される。
図31は、操作軌跡AL上の軌跡位置LP0において、操作部3から力センサ51への入力値が前記所定の範囲内にある場合を示している。同図において、操作部3の現在位置である操作軌跡AL上の軌跡位置LP0は、目標軌跡TL上の位置TP0と同一である。前記所定の範囲は、その外郭を操作部3の中心Oを中心とする円Dで表している。操作部3の中心Oから延びる太い矢印FSは、使用者Uから操作部3に加えられる抵抗力の向きおよび大きさを表しており、その大きさ|FS|とその向きを表すX軸方向およびY軸方向成分は、力センサ51への入力値として検出される。
図31に示すように、操作部3からの抵抗力FSが円D内にあるとき、操作部3から力センサ51への入力値の大きさ|FS|は、前記所定の範囲内にある。このとき、制御部70は、使用者Uから操作部3を介して作用する抵抗力FSを無視して、操作部3の駆動を制御する。具体的には、目標軌跡TL上の現在位置LP0(=TP0)にある操作部3には、目標軌跡TLの接線方向を向いた速度ベクトルR0のみが生じ、目標軌跡TLに沿って移動するように、X軸およびY軸方向駆動モータ38,30を制御する。従って、操作部3を掴んだ使用者Uの手は、操作部3と共に目標軌跡TLに沿って運動訓練する。
図32は、操作部3の現在位置LP0が、図31と同様に目標軌跡TL上の位置TP0にあって、操作部3からの抵抗力FSが円Dの外側まで延長している場合を示している。この場合、操作部3から力センサ51への入力値の大きさ|FS|は、前記所定の範囲を超えているので、制御部70は、該入力値の大きさを考慮して、操作部3の駆動を制御する。
具体的には、現在位置LP0=TP0にある操作部3を目標軌跡TL上から外れさせるように作用する抵抗力FSに抗して、目標軌跡TL上の位置に戻す向きに作用する復帰力FRが発生するように、X軸およびY軸方向駆動モータ38,30を駆動させる。この復帰力FRは抵抗力FSよりも小さく、操作部3が目標軌跡TL上にあるので、抵抗力FSと同じ作用線上で逆向きに発生する。
このとき、抵抗力FSと復帰力FRとの差は、抵抗力FSと同じ向きの速度ベクトルM0で表すことができる。その結果、操作部3には、目標軌跡TLに沿って移動させるようにその接線方向を向いた速度ベクトルR0と速度ベクトルM0との合成ベクトルである速度ベクトルK0が発生する。従って、操作部3は、現在位置LP0=TP0から次の目標位置TP1に向かう向きではなく、速度ベクトルK0の向きに、その大きさに対応する速度で移動する。
図33は、操作部3が図32の現在位置=軌跡位置LP0から次の軌跡位置LP1に移動したときに、操作部3からの抵抗力FSが円Dの外側まで延長している場合を示している。この場合も、操作部3から力センサ51への入力値の大きさ|FS|が、前記所定の範囲を超えているので、制御部70は、該入力値の大きさを考慮して、操作部3の駆動を制御する。
具体的には、軌跡位置LP1にある操作部3を更に目標軌跡TL上から外れさせるように作用する抵抗力FSに抗して、軌跡位置LP1に対応する目標軌跡TL上の目標位置TP1、即ち操作部3が目標軌跡TLに沿って移動していれば現在あるべき位置に戻す向きに作用する復帰力FRが発生するように、X軸およびY軸方向駆動モータ38,30を駆動させる。この復帰力FRは、抵抗力FSよりも小さいが、軌跡位置LP1とそれに対応する目標位置TP1との距離が大きくなるほど大きく、操作部3から目標軌跡TL上の目標位置TP1に向かう向きに発生する。
このとき、操作部3には、現在位置する軌跡位置LP1から次の目標位置TP2を向いた速度ベクトルR1と、抵抗力FSと復帰力FRとの合力による速度ベクトルM1とが発生する。その結果、操作部3には、図33に示すように、速度ベクトルR1と速度ベクトルM1との合成ベクトルである速度ベクトルK1が発生する。従って、操作部3は、現在位置する軌跡位置LP1から次の目標位置TP2に向かう向きではなく、速度ベクトルK1の向きに、その大きさに対応する速度で移動する。
図34は、操作部3が図33の現在位置LP1から次の軌跡位置LP2に移動したときに、操作部3からの抵抗力FSが円Dの外側まで延長している場合を示している。この場合も、操作部3から力センサ51への入力値の大きさ|FS|が、前記所定の範囲を超えているので、制御部70は、該入力値の大きさを考慮して、操作部3の駆動を制御する。
具体的には、軌跡位置LP1にある操作部3を更に目標軌跡TL上から外れさせるように作用する抵抗力FSに抗して、軌跡位置LP2に対応する目標軌跡TL上の目標位置TP2、即ち操作部3が目標軌跡TLに沿って移動していれば現在あるべき位置に戻す向きに作用する復帰力FRが発生するように、X軸およびY軸方向駆動モータ38,30を駆動させる。この復帰力FRは、抵抗力FSよりも小さいが、軌跡位置LP2とそれに対応する目標位置TP2との距離が、図33における軌跡位置LP1と目標位置TP1との距離より大きいので、図33の場合によりも大きく、操作部3から目標軌跡TL上の目標位置TP2に向かう向きに発生する。同図の例では、復帰力FRが、抵抗力FSと同じ作用線上で逆向きに発生している。
このとき、操作部3には、現在位置する軌跡位置LP2から次の目標位置TP3を向いた速度ベクトルR2と、抵抗力FSと復帰力FRとの合力による速度ベクトルM2とが発生する。その結果、操作部3には、図34に示すように、速度ベクトルR2と速度ベクトルM2との合成ベクトルである速度ベクトルK2が発生する。従って、操作部3は、現在位置する軌跡位置LP2から次の目標位置TP3に向かう向きではなく、速度ベクトルK2の向きに、その大きさに対応する速度で移動する。
次に、図35は、操作部3が図34と同じ軌跡位置LP2に位置しているが、操作部3から作用する抵抗力FSが円Dの外側へ延長しているだけでなく、予め設定した所定の閾値を超えた場合を示している。このとき、図34の場合と同様に軌跡位置LP2と目標位置TP2との距離に応じて発生させた復帰力FRに比して、抵抗力FSが過大なため、それらの差により発生する速度ベクトルM2も過大となって、操作部3の動きが速くなり過ぎる虞があり、かかる運転状態は使用者にとって危険である。
そこで、本実施形態では、操作部3の動きが速くなっても、使用者にとって危険な運転状態とならない抵抗力FSの大きさに、前記所定の閾値を設定する。そして、制御部70は、抵抗力FSの大きさが前記所定の閾値を超えたとき、復帰力FRおよび軌跡位置LP2から次の目標位置TP3に向かう速度ベクトルR2を0にする。更に制御部70は、操作部3に対して、軌跡位置LP2と目標位置TP2との距離に応じて発生させる復帰力FRよりも大きい制動力を、抵抗力FSと逆向きに作用させるように、X軸およびY軸方向駆動モータ38,30を制御する。それにより、操作部3の速度ベクトルKSを小さくし、操作部3をゆっくりと抵抗力FSの向きに移動させることができるので、使用者への危険が回避される。
図35の場合において、上述した実施形態では、復帰力FRおよび速度ベクトルR2を0にしたが、別の実施形態では、復帰力FRを軌跡位置LP2と目標位置TP2との距離に応じて発生させる場合よりも小さく、かつ速度ベクトルR2を軌跡位置LP2から次の目標位置TP3に向かう場合よりも小さくすることができる。これによっても、同様に、操作部3の速度ベクトルKSを小さくし、操作部3をゆっくりと移動させ、使用者への危険を回避することができる
受動訓練モードにおいて上述したように操作部3の移動を制御するために、制御部70のMCU71は、力センサ51から該力センサへの入力値を受信して、抵抗力FSの大きさを判定する力判定部71aを有する。力判定部71aにより判定された抵抗力FSの大きさは、第1速度ベクトル算出部71bに出力され、エンコーダ38a,30aから入力する操作部3の現在位置情報と不揮発性メモリ74から入力する目標位置の情報に基づいて、速度ベクトルM0~M2を算出する。算出した速度ベクトルM0~M2は、第2速度ベクトル算出部71cに出力され、不揮発性メモリ74から入力する速度ベクトルR0~R2と合成して、操作部3の速度ベクトルK0~K2を算出する。力判定部71aは、判定した抵抗力FSの大きさが前記所定の閾値を超える場合、それを第3速度ベクトル算出部71dに出力し、操作部3の速度ベクトルKSが算出される。
操作部3の速度ベクトルK0~K2およびKSは、モータ回転速度算出部71eに出力され、X軸およびY軸方向駆動モータ38,30の回転速度および向きが算出される。MCU71は、このようにして算出したX軸およびY軸方向駆動モータ38,30の回転速度および向きに対応する電流値(出力電流Ii、デューティ)を駆動制御部72に出力し、前記X軸およびY軸方向駆動モータの駆動を制御する。
4.2.能動訓練モード
図36は、能動訓練モードで実行される使用者の運動訓練において、制御部70が行うX軸およびY軸方向駆動モータ38,30の駆動制御を説明するための回路ブロック図である。制御部70のMCU71は、力センサ51、エンコーダ38a,30a、および不揮発性メモリ74から入力する情報に基づいて操作部3の速度を求め、駆動制御部72に電流値(出力電流Ii、デューティ)を出力して、X軸およびY軸方向駆動モータ38,30への電力供給を制御する。
本実施形態において、制御部70は、使用者Uにより操作される操作部3の位置が、予め設定した所定の目標領域内にある場合と、前記所定の目標領域から外れた場合とで、操作部3の駆動制御を切り替えて行う。前記所定の目標領域は、予め設定した目標軌跡TL上の各点から一定の距離の範囲であり、この一定の距離は、運動訓練の観点から操作部3が実質的に目標軌跡TLをなぞるように操作されていると見なすことができる大きさに設定される。
図37は、能動訓練モードの運動訓練開始時において、操作部3の中心Oが目標軌跡TL上の開始位置TP0に一致するように配置されている場合を示している。前記所定の目標領域は、その外郭を目標軌跡TL上の点(図37では、開始位置TP0)を中心とする円TRで表している。操作部3の中心Oから延びる太い矢印FAは、使用者Uから操作部3に加えられる操作力の向きおよび大きさを表しており、その大きさ|FA|と、その向きを表す操作力FAのX軸方向およびY軸方向成分は、力センサ51への入力値として検出される。操作力FAは、同図に示すように、操作部3に発生する速度ベクトルNで表すことができる。
図37の運動訓練開始時には、操作部3の中心Oが目標軌跡TL上に位置して、目標領域TR内にあるので、制御部70は、使用者Uからの操作力FAに対応する力センサ51への入力値に基づいて、速度ベクトルNに等しい速度ベクトルQを操作部3に発生させるように、X軸およびY軸方向駆動モータ38,30を制御する。別言すれば、使用者Uの操作を妨げたり操作力FA以外の余計な力を発揮させることなく、操作部3を動かすことができるように、X軸およびY軸方向駆動モータ38,30を駆動する。
図38は、使用者Uの操作により図37の開始位置TP0から移動した操作部3の現在位置LPにおいて、その中心Oが目標軌跡TL上の目標位置TPから逸れているが、目標領域TR内にある場合を示している。この場合、制御部70は、図37の場合と同様に、使用者Uからの操作力FAに対応する力センサ51への入力値に基づいて、速度ベクトルNに等しい速度ベクトルQを操作部3に発生させるように、X軸およびY軸方向駆動モータ38,30を制御する。従って、操作部3は、使用者Uからの操作力FAに対応する力センサ51への入力値に基づいて、使用者Uが動かす向きに移動する。
図39は、使用者Uの操作により図38の位置から移動した操作部3の現在位置LPにおいて、その中心Oが目標領域TRから外れた場合を示している。この場合、制御部70は、使用者Uからの操作力FAに対応する力センサ51への入力値に基づく速度ベクトルNに加えて、操作部3を目標領域TRに戻す向きに働く速度ベクトルWを発生させるように、X軸およびY軸方向駆動モータ38,30を制御する。それにより、操作部3には、速度ベクトルNと速度ベクトルWとの合成ベクトルである速度ベクトルQが発生する。従って、操作部3は、使用者Uからの操作力FAに速度ベクトルWを加えて補助することにより、使用者Uが動かす向きを目標領域TRに戻すように調節して移動させることができる。
制御部70は、操作部3の中心Oが、図39のように目標領域TRから外れた位置から目標領域TRに戻ると、操作力FAを補助する速度ベクトルWを0または小さくして、操作部3の移動速度を遅らせる。それにより、操作部3が目標領域TRを通り過ぎて、反対側の外れた位置まで移動することを未然に回避することができる。
図40は、操作部3の中心Oが目標領域TR内に戻ったとき、速度ベクトルWを0にした場合を示している。速度ベクトルWによる補助が無くなることにより、操作部3に作用する力及び速度ベクトルは、上述した図38の状態と同じになる。即ち、制御部70は、使用者Uからの操作力FAに対応する力センサ51への入力値に基づいて、速度ベクトルNに等しい速度ベクトルQを操作部3に発生させるように、X軸およびY軸方向駆動モータ38,30を制御し、操作部3は、使用者Uからの操作力FAに対応して、使用者Uが動かす向きに移動する。
実際の使用時において、図39に示すように操作部3の中心Oが目標領域TRから外れた状態から、X軸およびY軸方向駆動モータ38,30を駆動して速度ベクトルWを発生させる操作部3への補助動作によっても、その中心Oが直ぐに目標領域TR内に戻らない場合を考慮すべきである。例えば、操作部3を図39の状態から目標領域TRに戻そうとする補助動作の最中に、使用者Uから操作部3への操作力FAの大きさおよび/または向きが、何らかの理由で大きく変化することは起こり得る。
図41は、図39の状態で速度ベクトルWを作用させても、操作部3の中心Oが依然として目標領域TRから外れている状態を示している。ここで、符号LP2、O2は、図41における操作部3の現在位置および中心を、符号LP1、O1は、それより1つ前の時点である図39における操作部3の現在位置および中心をそれぞれ示している。符号TP2、TR2は、図41の時点における操作部3の目標位置および目標領域であり、符号TP1、TR1は、図39の時点における操作部3の目標位置および目標領域である。
この場合、制御部70は、図41の現在位置LP2から、その時点における目標位置TP2ではなく、1つ前の時点における目標位置TP1(図39の目標位置TP)に再び戻すように、X軸およびY軸方向駆動モータ38,30を駆動して、前記補助動作を修正する速度ベクトルWAを発生させる。この速度ベクトルWAとこの時点における使用者Uから操作部3への操作力FAによる速度ベクトルNとの合成ベクトルQAは、図示するように、操作部3をこの時点における目標領域TR2に向かわせるように作用させることが好ましい。このように前記補助動作を修正して、操作部3を速やかに目標領域TRの範囲内に戻すことによって、使用者Uの能動訓練を適切に続行することができる。
上述した図41にかかる実施形態では、目標軌跡TL上の目標位置TPが、使用者Uの訓練中における時間の経過に沿って、操作部3の移動に対応して移動するように設定されている。そのため、操作部3をその現在位置に対応する目標位置TP2に戻すように速度ベクトルWAを作用させても、操作部3が直ぐに目標領域TR内に戻らない場合があり得る。そのような場合、操作部3は目標領域TRから外れたまま、長い時間移動し続けることになるので、使用者Uの訓練上好ましくない。
そこで、更に別の実施形態では、操作部3を1つ前の時点における目標位置(操作部3の中心位置Oが目標領域TRから外れた時点での目標位置)に戻すように、前記補助動作を修正する速度ベクトルWAを発生させることができる。そのように操作部3への補助動作を制御する好適な手法を、図42,43を用いて以下に説明する。図42において、目標領域TRから外れた状態であって、より早い時点t1における操作部3の位置を破線で、その次の時点t2における操作部3の位置を実線で示している。符号O1は、時点t1における操作部3の中心位置を、符号O2は、次の時点t2における操作部3の中心位置をそれぞれ示している。
先ず、制御部70は、操作部3は目標領域TRから外れた状態において、使用者Uの訓練における時間の経過に拘わらず、目標軌跡TL上における目標位置TPの移動を停止させる。そして、制御部70は、その時点t1で移動を停止させた目標領域TR内に操作部3の中心O1を戻す向きに速度ベクトルWA1を発生させるように、X軸およびY軸方向駆動モータ38,30を制御する。この時点t1で、速度ベクトルWA1と使用者Uの操作部3への操作力FA1による速度ベクトルN1との合成ベクトルQA1は、同図に破線で示すように、操作部3(破線)の中心位置O1を移動停止中の目標領域TRに向かわせるように作用していない。そのため、時点t2において、操作部3(実線)の中心位置O2は、目標領域TRに戻りきらず、依然として目標領域TRから外れた位置にある。
そこで制御部70は、時点t2で、上述した時点t1における補助動作を繰り返し実行する。即ち、移動停止中の目標領域TR内に操作部3の中心O2を戻す向きに速度ベクトルWA2を発生させるように、X軸およびY軸方向駆動モータ38,30を制御する。同図に実線で示すように、速度ベクトルWA2と使用者Uの操作部3への操作力FA2による速度ベクトルN2との合成ベクトルQA2が、操作部3(実線)の中心位置O2を移動停止中の目標領域TRを向くように発生させる。これにより、操作部3は、図43に示すように、その中心位置Oを目標領域TR内に復帰させることができる。本実施形態によれば、このように合成ベクトルQA2を発生させる補助動作を、操作部3の中心位置Oが目標領域TR内に復帰するまで繰り返し実行する。言い換えると、制御部70は、操作部3の中心位置Oが目標領域TRから外れてから再び目標領域TR内に戻るまで、停止している目標位置TPへ向かう速度ベクトルWが発生し続けるようにX軸およびY軸方向駆動モータ38,30を制御する。
操作部3の中心Oが目標領域TR内に戻ると、制御部70は、図43に示すように、使用者Uの操作力FAを補助する速度ベクトルWを0にすると同時に、再び時間の経過に対応した目標位置TPの目標軌跡TLに沿った移動を開始する。このとき、操作部3は、X軸およびY軸方向駆動モータ38,30による速度ベクトルWA1,WA2の補助が無くなるので、使用者Uの操作力FAによってその操作方向に移動する。このように前記補助動作を修正することによっても、操作部3を速やかに目標領域TRの範囲内に戻して、使用者Uの能動訓練を適切に続行することができる。尚、この操作部3の移動は、制御部70において、常時使用者Uの操作力FAに対応する力センサ51への入力値に基づく速度ベクトルNとして把握されている。
操作部3の中心Oが目標領域TR内に戻ったとき、制御部70は、使用者Uの操作力FAを補助する速度ベクトルWを一気に0にするのではなく、徐々に小さくして0にすることができる。このように速度ベクトルWの作用を残しながら無くすことによって、目標領域TR外から復帰した直後の操作部3の目標領域TR内における移動を、よりスムーズに速やかに安定させることができる。
また、上述した図41にかかる前記補助動作の修正と、図42,図43にかかる前記補助動作の修正とは、組み合わせて実行することができる。その場合、制御部70は、目標軌跡TL上における目標位置TPの移動を、力センサ51への入力値から把握される操作部3の移動状態(位置、操作力、速度、加速度等)に応じて選択的に維持しまたは停止させることができる。例えば、操作部3の中心位置Oの目標領域TRからの離隔距離や、目標領域TR外における操作部3への操作力、操作部3の速度、加速度が所定の閾値以内であれば、目標位置TPの移動を維持し(図41の実施形態)、該閾値を超えた場合には、目標位置TPの移動を停止して(図42の実施形態)、前記補助動作を実行する。
能動訓練モードにおいて上述したように操作部3の移動を制御するために、制御部70のMCU71は、力センサ51から該力センサへの入力値を受信して、操作力FAの大きさを判定する力判定部71aを有する。力判定部71aにより判定された操作力FAの大きさは、第1速度ベクトル算出部71fに出力され、力センサ51への入力値に基づく速度ベクトルNが算出される。第2速度ベクトル算出部71gは、エンコーダ38a,30aから入力する操作部3の現在位置情報と不揮発性メモリ74から入力する目標位置の情報に基づいて、操作部3が目標領域TRから外れている場合に、その現在位置に対応した速度ベクトルWを算出して出力する。操作部3が目標領域TR内にある場合、第2速度ベクトル算出部71gが出力する速度ベクトルWは0である。
第3速度ベクトル算出部71hは、第1速度ベクトル算出部71fから出力される速度ベクトルNと、第2速度ベクトル算出部71gから出力される速度ベクトルWとを合成して速度ベクトルQを算出する。算出した速度ベクトルQは、モータ回転速度算出部71eに出力され、X軸およびY軸方向駆動モータ38,30の回転速度および向きが算出される。MCU71は、このようにして算出したX軸およびY軸方向駆動モータ38,30の回転速度および向きに対応する電流値(出力電流Ii、デューティ)を駆動制御部72に出力し、前記X軸およびY軸方向駆動モータの駆動を制御する。
5.試験
次に、実施形態の運動訓練装置1を用いて行った試験について説明する。
5.1.試験内容
本試験では、上述した能動訓練モードで被験者が表示装置80に表示された半径0.107mの円(参照軌跡)をなぞるように運動訓練装置1の操作部3を操作するものとした。なお、被験者として20代男性の健常者4名に事前に試験内容を説明し、インフォームドコンセントを取得した上で行った。
試験では、仮想モデルIMのパラメータおよびX軸およびY軸方向駆動モータ38,30の制御モードを下表1のように設定した。
Figure 2022088770000004
すなわち、実施例では、仮想モデルIMで用いられるパラメータを、操作部3の仮想質量m:5[kg]、粘性減衰係数c:20[kg/s]、最大静止摩擦力μ:3[N]、摩擦係数μ:2[N]に設定し、X軸およびY軸方向駆動モータ38,30の制御モードをP制御(Kp=3×10)とした。
一方、比較例1では、X軸、Y軸独立に構成され各軸に不感帯と粘性抵抗を模擬した仮想モデルを用い操作部3の仮想質量m:5[kg]、不感帯:1[N]、粘性減衰係数c:20[kg/s]に設定し、X軸およびY軸方向駆動モータ38,30の制御モードをPID制御とした。ちなみに、比較例1のように各軸独立に不感帯と粘性抵抗を模擬した仮想モデルを用いる場合には、操作部3の仮想質量mを5[kg]より小さくすると操作中に操作部3が振動的になり操作が困難となることが確認されている。従って、比較例1に示したパラメータが各軸独立に不感帯と粘性抵抗を模擬した仮想モデルにおける訓練負荷の最小のものとなる。
また、比較例2では、訓練負荷を最小とするために、仮想モデルIMで用いられたパラメータを、操作部3の仮想質量m:2[kg]、粘性減衰係数c:10[kg/s]、最大静止摩擦力μ:3[N]、摩擦係数μ:2[N]に設定し、X軸およびY軸方向駆動モータ38,30の制御モードをP制御(Kp=3×10)とした。
5.2.試験結果
次に、本試験の試験結果を図23~図28に示す。図23~図28は4名の被検者のうち1名の被検者の試験結果を示したものであり、図23、図24は実施例1、図25、図26は比較例1、図27、図28は比較例2の試験結果である。図23、図25、図27の左側のグラフはX軸に関する試験結果、右側のグラフはY軸に関する試験結果である。上段のグラフは操作部3に作用する力、中段は操作部3の速度、下段は操作部3の位置を示を示す。また、図24、図26、図28は、実線が操作部3の軌跡であり、破線は操作者Uが操作中に参照した参照軌跡である。
5.3.評価
図25および図26に示すように、各軸独立に構成され軸ごとに不感帯と粘性抵抗を模擬した仮想モデルを用いた比較例1の試験結果では、斜め方向の操作に対して不感帯による反力が増大してしまうことから、直線的な操作部3の軌跡となっていることが確認できる。これに対し、図23および図24に示すように、平面運動における静止摩擦を模擬した仮想モデルIMを用いた実施例の試験結果では、仮想摩擦力が運動方向に対して与えられているため、実際のワイピング訓練に近い状態となり、より円に近い軌跡が描かれている。また、操作部3に作用する力の大きさは実施例、比較例1ともに4[N]程度であったが、操作部3の速度は平面運動における静止摩擦を模擬した仮想モデルIMを用いた実施例の方が若干抑えられており、スムーズな操作が行われたことが確認できる。さらに、図27および図28に示すように、訓練負荷を最小とした比較例2の試験結果では、操作部3の速度が増大して円軌跡を精度良く描くことが困難になっていることが確認できる。
また、試験後に被験者へアンケート調査を行った結果、3名の被験者が平面運動における静止摩擦を模擬した仮想モデルIMを用いた実施例が最も操作しやすく、訓練負荷を最小とした比較例2が操作しにくいとの回答を得た。
以上の結果から、平面運動における静止摩擦を模擬した仮想モデルIMを用いた実施例が、ワイピング訓練等の平面運動に対して高臨場感を創出し、良好な操作性が得られることが確認できた。また、仮想質量m等のパラメータ(調整値)を変更することで自在に訓練負荷を調整できることも確認できた。一方で、訓練負荷を過小にすると操作性が損なわれることも確認された。
以上述べたとおり、本発明は、違和感なく使用者の平面運動を模擬可能な運動訓練装置を提供するものであるため、運動訓練装置の製造、販売に寄与するので、産業上の利用可能性を有する。
1 運動訓練装置
3 操作部
20 アクチュエータ機構(駆動部)
30 Y軸方向駆動モータ
38 X軸方向駆動モータ
51 力センサ
70 制御部
71 MCU

Claims (6)

  1. XY平面で移動可能な操作部と、
    X軸およびY軸方向駆動モータを有し、前記操作部をXY平面で駆動する駆動部と、
    前記操作部を操作する使用者から前記操作部に作用するX軸およびY軸方向の力Fx,Fyを検出する力センサと、
    前記X軸およびY軸方向駆動モータを制御する制御部と、
    を備え、
    前記制御部は、前記力センサにより検出される前記X軸およびY軸方向の力Fx,Fyの合成力Fの大きさが所定の範囲内である場合に、前記操作部を所定の軌道に沿って移動させるように前記X軸およびY軸方向駆動モータを駆動し、前記合成力Fの大きさが前記所定の範囲を超える場合に、前記操作部を現在位置から前記所定の軌道上の次の目標位置に向かわせる大きさの第1速度ベクトルと、前記合成力Fの大きさに基づいた大きさの第2速度ベクトルとに応じて、前記操作部を現在位置から移動させるように前記X軸およびY軸方向駆動モータを制御する、ことを特徴とする運動訓練装置。
  2. 前記制御部は、使用者により操作される前記操作部が前記所定の軌道から外れたとき、前記操作部の現在位置に対応する前記所定の軌道上の現在の目標位置に前記操作部を戻す方向の第3速度ベクトルを設定し、前記第2速度ベクトルと前記第3速度ベクトルとの合成ベクトルと、第1速度ベクトルとに応じて、前記操作部を現在位置から移動させるように前記X軸およびY軸方向駆動モータを制御する、ことを特徴とする請求項1に記載の運動訓練装置。
  3. 前記制御部は、前記操作部の現在位置とそれに対応する前記所定の軌道上の現在の目標位置との距離に応じて、前記第3速度ベクトルの大きさを変化させる、ことを特徴とする請求項2に記載の運動訓練装置。
  4. 前記制御部は、前記操作部の現在位置とそれに対応する前記所定の軌道上の現在の目標位置との前記距離が大きいほど、前記第3速度ベクトルの大きさを大きくする、ことを特徴とする請求項3に記載の運動訓練装置。
  5. 前記制御部は、前記力センサにより前記所定の範囲を超える所定の大きさ以上の力が検出された場合に、前記第1速度ベクトルの大きさを、前記操作部を現在位置から前記所定の軌道上の次の目標位置に向かわせる大きさよりも小さくし、前記第3速度ベクトルの大きさを、前記合成力Fの大きさに基づいた大きさよりも小さくし、前記第2速度ベクトルの大きさが、前記合成力Fの大きさに基づいた大きさよりも小さくなるように、前記X軸およびY軸方向駆動モータを制御する、ことを特徴とする請求項2乃至4のいずれかに記載の運動訓練装置。
  6. 前記制御部は、前記力センサにより前記所定の範囲を超える所定の大きさ以上の力が検出された場合に、前記第1および第3速度ベクトルの大きさを0にする、ことを特徴とする請求項5に記載の運動訓練装置。

JP2020200786A 2020-12-03 2020-12-03 運動訓練装置 Pending JP2022088770A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2020200786A JP2022088770A (ja) 2020-12-03 2020-12-03 運動訓練装置
US17/537,620 US20220175606A1 (en) 2020-12-03 2021-11-30 Motion training apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020200786A JP2022088770A (ja) 2020-12-03 2020-12-03 運動訓練装置

Publications (1)

Publication Number Publication Date
JP2022088770A true JP2022088770A (ja) 2022-06-15

Family

ID=81849729

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020200786A Pending JP2022088770A (ja) 2020-12-03 2020-12-03 運動訓練装置

Country Status (2)

Country Link
US (1) US20220175606A1 (ja)
JP (1) JP2022088770A (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115192990B (zh) * 2022-07-19 2023-12-19 普康慧健医疗设备(重庆)有限公司 一种老年人触觉统合训练装置及方法

Also Published As

Publication number Publication date
US20220175606A1 (en) 2022-06-09

Similar Documents

Publication Publication Date Title
JP6678832B2 (ja) 遠隔制御マニピュレータシステムおよび制御装置
US20150227200A1 (en) Tactile force sense presentation device, information terminal, tactile force sense presentation method, and computer-readable recording medium
JP7157980B2 (ja) 運動訓練装置
CN110292748B (zh) 双边协调训练系统和控制方法
JP2022088770A (ja) 運動訓練装置
JP7209282B2 (ja) 運動訓練装置
JP2022088771A (ja) 運動訓練装置
JP2007033563A (ja) 運転模擬試験装置
JP7209281B2 (ja) 運動訓練装置
JP7157979B2 (ja) 運動訓練装置
JP7004549B2 (ja) 運動訓練装置
JP2005154047A (ja) パワーアシスト装置
JP7071820B2 (ja) 運動訓練装置
JP6990823B2 (ja) 運動訓練装置
Hasunuma et al. Development of teleoperation master system with a kinesthetic sensation of presence
JP6974812B2 (ja) 運動訓練装置
JP3190026B1 (ja) 人間型ロボット体感提示装置およびマスタスレーブ制御装置
Azmi et al. The Wiimote with SAPI: Creating an accessible low-cost, human computer interface for the physically disabled
JP2022156175A (ja) 運動訓練システム、運動訓練装置、表示方法及びプログラム
JP2006218573A (ja) 操作装置と、操作子の動作調節方法と、そのためのプログラム
JP4736591B2 (ja) 運転模擬試験装置
JP2007033562A (ja) 運転模擬試験装置
JP3424392B2 (ja) 操縦装置、操縦方法、内視鏡の操縦装置、仮想イメージの操縦装置
JP2022156174A (ja) 運動訓練装置及びプログラム
JPH07210234A (ja) 操作制御装置および操作制御方法

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20231124