JP7157980B2 - exercise training device - Google Patents
exercise training device Download PDFInfo
- Publication number
- JP7157980B2 JP7157980B2 JP2018229725A JP2018229725A JP7157980B2 JP 7157980 B2 JP7157980 B2 JP 7157980B2 JP 2018229725 A JP2018229725 A JP 2018229725A JP 2018229725 A JP2018229725 A JP 2018229725A JP 7157980 B2 JP7157980 B2 JP 7157980B2
- Authority
- JP
- Japan
- Prior art keywords
- axis direction
- operation unit
- axis
- control
- force
- 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
Links
Images
Description
本発明は運動訓練装置に係り、特に、使用者の平面運動を支援可能な運動訓練装置に関する。 TECHNICAL FIELD The present invention relates to an exercise training apparatus, and more particularly, to an exercise training apparatus capable of supporting a user's planar exercise.
従来、運動機能を向上させるために様々な運動訓練が行われている。例えば、机上を拭くような動作で肩や肘を屈伸させるワイピング訓練や傾斜したボード上で手を上下方向に滑動させるサンディング訓練が広く行われている。そして、これらの運動訓練を支援するために種々の運動訓練装置が提案されている。 BACKGROUND ART Conventionally, various exercise trainings have been performed in order to improve motor function. For example, wiping training in which the shoulders and elbows are bent and stretched like wiping a desk, and sanding training in which hands are slid up and down on an inclined board are widely performed. Various exercise training devices have been proposed to support these exercise trainings.
例えば、特許文献１には、十字状に架設した２本のガイド部材で構成された２軸並進機構の交叉部に操作（ハンドル）部を設け、ガイド部材に設けられた正逆転可能な駆動モータを有する直線駆動装置により前後左右および上下方向に移動可能に構成した肢体機能回復訓練支援装置が開示されている。
For example, in
なお、本発明に関連する技術として、例えば、特許文献２には、往復動可能な単軸直動機構に固定用バンドが固着した台部材が取り付けられ、直動機構を正逆転可能な駆動モータで駆動することで使用者の往復運動を支援するリハビリテーション装置が開示されている。また、非特許文献１には、このような直動機構（で移動する台車）に対してローパスフィルタを用いることで制振する技術が開示されている。
As a technique related to the present invention, for example,
ところで、上記特許文献１の装置では、力センサで検出された力に応じて駆動モータの駆動を制御している。駆動モータにサーボモータが用いられていることから、駆動モータの制御モードをＰＩＤ制御とすることで、指令値に対し高精度に追随させることができる。しかしながら、使用者へ与える訓練負荷を小さくすると、ＰＩＤ制御の積分動作による応答遅れが影響し、運動訓練中に操作部が振動的になり使用者へ衝撃や不快感を与えてしまう、という問題がある。
By the way, in the device of
一方、指令値に対する定常偏差が大きいと、操作部の機械的動作限界に対する位置精度が低下することから、操作部が装置の機械的動作限界に衝突して使用者や装置に衝撃を与えるおそれがある。このような衝撃を未然に予防するためには、装置の機械的動作限界に対して操作部の可動領域（使用者の運動訓練領域）の設定に大きな余裕をとる必要があり、その結果、操作部の可動領域が極端に狭くなってしまう、という問題がある。 On the other hand, if the steady-state deviation with respect to the command value is large, the positional accuracy of the operation unit relative to the mechanical operation limit will decrease. be. In order to prevent such impacts, it is necessary to set a large margin in setting the movable area of the operation unit (user's exercise training area) with respect to the mechanical operation limit of the device. There is a problem that the movable area of the part becomes extremely narrow.
本発明は上記事案に鑑み、使用者よる平面運動を快適に支援するとともに、使用者の運動訓練領域を適正に確保可能な運動訓練装置を提供することを課題とする。 SUMMARY OF THE INVENTION It is an object of the present invention to provide an exercise training apparatus that can comfortably support a user's planar exercise and appropriately secure a user's exercise training area.
上記課題を解決するために、本発明に係る運動訓練装置は、ＸＹ平面で移動可能な操作部と、Ｘ軸方向駆動モータおよびＹ軸方向駆動モータを有し前記操作部をＸＹ平面で駆動する駆動部と、前記操作部に作用するＸ軸方向の力およびＹ軸方向の力を検出する力センサと、前記操作部の位置を検出する位置検出手段と、前記力センサで検出された前記Ｘ軸方向の力および前記Ｙ軸方向の力に基づいて前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータを制御する制御部と、を備え、前記制御部は、前記位置検出手段で検出された前記操作部が、前記操作部が移動可能なＸＹ平面での中心部を含む第１の領域に位置する場合に、前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータの少なくとも一方をＰＤ制御またはＰ制御で制御し、前記位置検出手段で検出された前記操作部が、前記第１の領域の外側に形成され前記操作部が移動可能な第２の領域に位置する場合に、前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータをＰＩＤ制御またはＰＩ制御で制御する、ことを特徴とする。 In order to solve the above problems, an exercise training apparatus according to the present invention has an operating section movable in the XY plane, an X-axis direction driving motor and a Y-axis direction driving motor, and drives the operating section in the XY plane. a drive unit, a force sensor for detecting X-axis direction force and Y-axis direction force acting on the operation unit, position detection means for detecting the position of the operation unit, and the X detected by the force sensor. a control unit that controls the X-axis direction driving motor and the Y-axis direction driving motor based on the axial force and the Y-axis direction force, wherein the control unit controls the position detected by the position detection means. at least one of the X-axis direction driving motor and the Y-axis direction driving motor is PD-controlled or When the operation part detected by the position detection means is positioned in a second area formed outside the first area and in which the operation part is movable, the X-axis direction is controlled by P control. The drive motor and the Y-axis direction drive motor are controlled by PID control or PI control .
また、入力された情報に基づいて操作部の仮想質量を設定するための設定手段をさらに備え、制御部は、設定手段で設定された操作部の仮想質量と力センサで検出されたＸ軸およびＹ軸方向の力と操作部に発生させるべきＸ軸およびＹ軸方向の速度との関係を予め定めた関係式により操作部に発生させるべきＸ軸およびＹ軸方向の速度を算出し、操作部が算出した速度となるようにＸ軸およびＹ軸方向駆動モータを制御するようにしてもよい。このとき、設定手段は、予め設定された第１の閾値以上となるように操作部の仮想質量を設定し、制御部は、操作部が第１の領域に位置するときに、設定手段で設定された操作部の仮想質量が第１の閾値より値の大きい第２の閾値以上か否かを判断し、肯定判断のときにＸ軸およびＹ軸方向駆動モータの少なくとも一方をＰＩＤ制御またはＰＩ制御で制御し、否定判断のときにＸ軸およびＹ軸方向駆動モータをＰＤ制御またはＰ制御で制御するようにしてもよい。 The control unit further comprises setting means for setting the virtual mass of the operating section based on the input information, and the control section controls the virtual mass of the operating section set by the setting means, the X-axis detected by the force sensor, and the The X-axis and Y-axis velocities to be generated by the operation unit are calculated according to a relational expression that defines the relationship between the Y-axis direction force and the X-axis and Y-axis velocities to be generated by the operation unit. The X-axis and Y-axis direction drive motors may be controlled so that the calculated speed is achieved. At this time, the setting means sets the virtual mass of the operation section to be equal to or greater than a preset first threshold, and the control section sets the virtual mass by the setting means when the operation section is positioned in the first region. It is determined whether or not the virtual mass of the manipulated operation unit is equal to or greater than a second threshold value larger than the first threshold value, and when the determination is affirmative, at least one of the X-axis and Y-axis direction drive motors is PID-controlled or PI-controlled. , and when a negative determination is made, the X-axis and Y-axis direction drive motors may be controlled by PD control or P control.
さらに、Ｘ軸およびＹ軸方向駆動モータの駆動量を検出する駆動量検出手段をさらに備え、制御部は、駆動量検出手段で検出されたＸ軸およびＹ軸方向駆動モータの駆動量が算出された操作部に発生させるべきＸ軸およびＹ軸方向の速度に対応する駆動量となるようにＸ軸およびＹ軸方向駆動モータを制御するようにしてもよい。 Further, the controller further includes drive amount detection means for detecting the drive amount of the X-axis and Y-axis direction drive motors, and the control unit calculates the drive amounts of the X-axis and Y-axis direction drive motors detected by the drive amount detection means. The X-axis and Y-axis direction drive motors may be controlled so as to provide drive amounts corresponding to the speeds in the X-axis and Y-axis directions to be generated in the operation unit.
また、位置検出手段と駆動量検出手段とを同一部材で構成するようにしてもよい。このとき、位置検出手段および駆動量検出手段を、Ｘ軸およびＹ軸方向駆動モータに取り付けられたエンコーダとしてもよい。そして、Ｘ軸およびＹ軸方向駆動モータをＤＣサーボモータとしてもよい。 Further, the position detection means and the drive amount detection means may be configured by the same member. At this time, the position detection means and the drive amount detection means may be encoders attached to the X-axis and Y-axis direction drive motors. Also, the X-axis and Y-axis direction drive motors may be DC servo motors.
本発明によれば、制御部が、操作部の制振が必要な領域ではＸ軸およびＹ軸方向駆動モータの少なくとも一方に対し偏差の積分値に比例した駆動量分を出力しない制御モードで制御することで応答遅れに起因する操作部の振動を抑制するとともに、操作部の位置精度が必要な領域ではＸ軸およびＹ軸方向駆動モータの少なくとも一方に対し偏差の積分値に比例した駆動量分を出力する制御モードで制御することで位置精度が高まり操作部の可動領域が適正に確保されるので、使用者よる平面運動を快適に支援するとともに、使用者の運動訓練領域を適正に確保することができる、という効果を得ることができる。 According to the present invention, the control unit performs control in a control mode that does not output a drive amount proportional to the integral value of the deviation to at least one of the X-axis and Y-axis direction drive motors in a region where damping of the operation unit is required. By doing so, vibration of the operation part caused by response delay is suppressed, and in the area where the positional accuracy of the operation part is required, at least one of the X-axis and Y-axis direction drive motors is driven by the amount proportional to the integral value of the deviation. By controlling in the control mode that outputs , the positional accuracy is increased and the movable area of the operation unit is properly secured, so the user's planar movement is comfortably supported, and the user's exercise training area is properly secured. You can get the effect that you can.
以下、図面を参照して本発明が適用可能な実施形態の運動訓練装置について説明する。なお、本実施形態の運動訓練装置は略水平な載置面に載置され、例えば、使用者（運動訓練者）の上肢の運動機能向上を目的として行われる運動訓練に使用される（図１参照）。 An exercise training apparatus according to an embodiment to which the present invention can be applied will be described below with reference to the drawings. The exercise training apparatus of the present embodiment is placed on a substantially horizontal mounting surface, and is used, for example, in exercise training for the purpose of improving the motor function of the upper limbs of a user (exercise trainee) (see FIG. 1). reference).
１．構成
１．１．機構部
１．１．１．機構部概略
運動訓練装置１は、ＸＹ平面で移動可能な操作部３（図１参照）と、Ｘ軸方向駆動モータ３８およびＹ軸方向駆動モータ３０を有し、操作部３をＸＹ平面で駆動するアクチュエータ機構２０（図５参照）と、操作部３に作用するＸ軸およびＹ軸方向の力を検出する力センサ５１（図５参照）とを備えている。Ｘ軸およびＹ軸方向駆動モータ３８，３０は、ＸＹ平面での操作部３の位置を検出するためのエンコーダ３８ａ，３０ａ（図５参照）と一体に構成されている。操作部３を除くこれらの部材は筺体５内に収容されており、操作部３（のハンドル部材４９、図５参照）は筺体５から上方に突出している（図１参照）。
1. Configuration 1.1. Mechanism 1.1.1. Outline of Mechanism The
１．１．２．機構部詳細
（１）筺体５
図１および図２に示すように、筺体５は、上部が開口した略箱状のケーシング６と矩形枠状の外側フレーム１１とで構成されている。なお、図１では、使用者（運動訓練者）Ｕが運動訓練装置１の正面に位置し、例えばワイピング訓練を行うために、右腕ＡＲを前方に伸ばして右手ＨＲで操作部３を操作している状態を示している。また、図２は、図１に示す運動訓練装置１からカバー４を取り外した状態の装置本体２を示しており、図中手前側が運動訓練装置１の正面（前面）側、奥側が背面（後面）側である。
1.1.2. Details of mechanism (1)
As shown in FIGS. 1 and 2, the
Ａ）ケーシング６
ケーシング６は、上下両端部が略コ字状に折り曲げられた正面フレーム６ａ、背面フレーム６ｂ（図１参照）、右面フレーム６ｃ（図２参照）および左面フレーム６ｄ（図１参照）と、これらのフレーム６ａ～６ｄの底面側に配された底面フレーム６ｅ（図２参照）とで構成されている。
A)
The
ケーシング６は複数の補強部材により補強されている。すなわち、図２～図４に示すように、ケーシング６内には、前後方向に延在する３つの前後補強部材１３ａ～１３ｃが左右方向に離隔して平行に配設されており、それらの両端部はそれぞれケーシング６の内壁（正面フレーム６ａ、背面フレーム６ｂ）下端部に固定されている。また、前後補強部材１３ａ～１３ｃと直交してケーシング６内に左右方向に延在する２つの左右補強部材１４ａ，１４ｂが前後方向に離隔して平行に配設されており、それらの両端部はそれぞれケーシング６の内壁（右面フレーム６ｃ、左面フレーム６ｄ）下端部に固定されている。
The
左右補強部材１４ａ，１４ｂは前後補強部材１３ａ～１３ｃの上に配置されており、ねじ締結で一体化されている。なお、前後補強部材１３ａ～１３ｃの位置に対応するケーシング６の底面および外側フレーム１１の底面中央部には、運動訓練装置１を載置面に載置するための複数の脚部１５が突設されている。
The left and right reinforcing
Ｂ）外側フレーム１１
図２に示すように、外側フレーム１１は対角に配置された補強板で補強されている。外側フレーム１１の上面には、運動訓練装置１の状態を表示する３つの状態表示ランプと、３つのマニュアル操作ボタンとが配設されている。３つの状態表示ランプは、運動訓練装置１の作動中に点灯する緑色ＬＥＤ９ａと、操作部３がホームポジションに移動中に点灯する白色ＬＥＤ９ｂと、電力投入後の運動訓練装置１の作動停止中に点灯する赤色ＬＥＤ９ｃとで構成されている。一方、３つのマニュアル操作ボタンは、操作部３の作動を緊急に停止させるための緊急停止ボタン１０ａと、操作部３の作動を一時的に停止させるための一時停止ボタン１０ｂと、操作部３をホームポジションに位置付けるためのイニシャルボタン１０ｃとで構成されている。
B)
As shown in FIG. 2, the
外側フレーム１１はケーシング６を構成する右面フレーム６ｃにねじ締結により複数箇所で固定されており、外側フレーム１１およびケーシング６には配線用の連通窓が形成されている。また、図１～図２に示すように、ケーシング６を構成する左面フレーム６ｄおよび外側フレーム１１の外側面には、運動訓練装置１を持ち運ぶための略水平な棒状の取っ手１２が取り付けられている。
The
（２）カバー４
図１に示すように、ケーシング６の上部開口は略全面的にカバー４で覆われており、操作部３はカバー４の上面から突出するように配置されている。カバー４は、左部カバー４ａ、右部カバー４ｂ、前部カバー４ｃおよび後部カバー４ｄで構成されている。カバー４ａ～４ｄは、それぞれ操作部３の前後および左右方向に配置されており、操作部３の移動に合わせて伸縮可能なベローズ（蛇腹）構造のシート状部材で構成されている。
(2)
As shown in FIG. 1 , the upper opening of the
図２および図４に示すように、ケーシング６の正面および背面側内壁（正面フレーム６ａ、背面フレーム６ｂ）には、その上端から少し下がった高さ位置に、左右方向の略全長に亘って一定幅の段差面１６ａ，１６ｂがそれぞれ内側に向けて形成されている。また、ケーシング６の正面および背面内壁は、それぞれ上端部が内側へ直角に折曲され左右方向の略全長に亘って一定幅の折曲板部１７ａ，１７ｂが形成されており、その下方の段差面１６ａ，１６ｂとの間に隙間が画定されている。この隙間には、左部カバー４ａおよび右部カバー４ｂの左右側辺部が前後方向の略全長に亘って挿入され、操作部３が左右方向（Ｘ軸方向）に移動するときに、その移動に合わせて蛇腹構造の左部カバー４ａおよび右部カバー４ｂを伸縮させるためのガイドとなる。なお、前部カバー４ｃおよび後部カバー４ｄについても同様の構造が採用されているが、その点については後述する。
As shown in Figs. 2 and 4, the front and rear inner walls (
（３）アクチュエータ機構２０
図５に示すように、アクチュエータ機構２０は、操作部３をＹ軸方向（前後方向）に駆動するＹ軸方向アクチュエータ２１と、Ｘ軸方向（左右方向）に駆動するＸ軸方向アクチュエータ２２とで構成されている。すなわち、アクチュエータ機構２０は２軸直動アクチュエータである。図２に示すように、アクチュエータ機構２０は、前後補強部材１３ａ～１３ｃおよび左右補強部材１４ａ，１４ｂ上に、Ｘ軸方向アクチュエータ２２、Ｙ軸方向アクチュエータ２１の順で設けられている。
(3)
As shown in FIG. 5, the
Ａ）Ｙ軸方向アクチュエータ２１
図２および図５に示すように、Ｙ軸方向アクチュエータ２１は、操作部３をＹ軸方向に直線状に案内するためのガイド部２３と、操作部３をガイド部２３に沿って駆動するＹ軸方向駆動部２４とを有している。Ｙ軸方向駆動部２４は、ガイド部２３の一方の端部（図２および図４に示すように背面側の端部）にガイド部２３と一体に設けられている。
A) Y-
As shown in FIGS. 2 and 5 , the Y-axis direction actuator 21 includes a
図５に示すように、ガイド部２３は、上向きに開放された矩形チャネル状のガイドフレーム２５と、その内部を長手方向に延在するロッド状の送りねじ２６と、スライダブロック２７とで構成されている。ガイドフレーム２５の長手方向に沿う両側部上面は、その長手方向にスライダブロック２７を案内するスライダレールとして機能する。スライダブロック２７は、複数の鋼球からなるボールを介して送りねじ２６のねじ溝と螺合するナット部を有しており、送りねじと組み合わされてボールねじ構造を構成している。
As shown in FIG. 5, the
図４および図５に示すように、Ｙ軸方向駆動部２４は、正逆回転可能なＹ軸方向駆動モータ３０と、Ｙ軸方向駆動モータ３０のモータ軸と送りねじ２６との間に介装された減速ギアユニット３１とで構成されている。また、Ｙ軸方向駆動モータ３０のモータ軸には、その回転方向および回転量を検出するロータリエンコーダ３０ａが取り付けられている。本実施形態では、Ｙ軸方向駆動モータ３０にＤＣサーボモータが用いられている。
As shown in FIGS. 4 and 5, the Y-axis
減速ギアユニット３１は、Ｙ軸方向駆動モータ３０の回転を減速して送りねじ２６に伝達する歯車列からなる。減速ギアユニット３１の減速ギア比は、操作部３を介して使用者Ｕの上肢にＹ軸方向駆動モータ３０の駆動力を伝達するのに十分なトルクを発生し得るように設定されている。なお、減速ギアユニット３１の減速ギア比は、Ｙ軸方向駆動モータ３０の駆動が停止したときに、送りねじ２６側からの逆入力によって容易に回転しないように比較的高く設定することが好ましい。この点は、後述する（Ｘ軸アクチュエータ２２を構成する）減速ギアユニット３９の減速ギア比についても同じである。
The
図５に示すように、Ｙ軸方向アクチュエータ２１は、連結部材５３を介してＸ軸方向アクチュエータ２２上に取り付けられている。連結部材５３は、矩形の板状部材からなり、ガイドフレーム２５の下面に結合され、ガイド部２３をＸ軸方向アクチュエータ２２のスライダブロック３７上に一体に固定する。Ｙ軸方向アクチュエータ２１は、操作部３をＸ軸方向に移動させたときに、Ｘ軸方向アクチュエータ２２を構成するガイドフレーム３５の直上をその長手方向に沿って走行する。
As shown in FIG. 5 , the Y-axis direction actuator 21 is mounted on the X-axis direction actuator 22 via a connecting
Ｂ）Ｘ軸方向アクチュエータ２２
図２および図５に示すように、Ｘ軸方向アクチュエータ２２は、原則的に上述したＹ軸方向アクチュエータ２１と同様に構成されている。すなわち、Ｘ軸方向アクチュエータ２２は、Ｙ軸方向アクチュエータ２１をＸ軸方向に直線状に案内するためのガイド部３３と、Ｙ軸方向アクチュエータ２１をガイド部３３に沿って駆動するＸ軸方向駆動部３４とを有している。Ｘ軸方向駆動部３４は、ガイド部３３の一方の端部（図２および図３の右側の端部）にガイド部３３と一体に設けられている。
B)
As shown in FIGS. 2 and 5, the
図５に示すように、ガイド部３３は、上向きに開放された矩形チャネル状のガイドフレーム３５と、その内部を長手方向に延在するロッド状の送りねじ３６と、スライダブロック３７とで構成されている。ガイドフレーム３５の長手方向に沿う両側部上面は、その長手方向にスライダブロック３７を案内するためのスライダレールとして機能する。スライダブロック３７は、複数の鋼球からなるボールを介して送りねじ３６のねじ溝と螺合するナット部を有しており、送りねじ３６と組み合わされてボールねじ構造を構成している。
As shown in FIG. 5, the
図３および図５に示すように、Ｘ軸方向駆動部３４は、正逆回転可能なＸ軸方向駆動モータ３８と、Ｘ軸方向駆動モータ３８のモータ軸と送りねじ３６との間に介装された減速ギアユニット３９とで構成されている。また、Ｘ軸方向駆動モータ３８のモータ軸には、その回転方向および回転量を検出するロータリエンコーダ３８ａが取り付けられている。本実施形態では、Ｘ軸方向駆動モータ３８にＤＣサーボモータが用いられている。
As shown in FIGS. 3 and 5, the X-axis
減速ギアユニット３９は、Ｘ軸方向駆動モータ３８の回転を減速して送りねじ３６に伝達する歯車列からなる。減速ギアユニット３９の減速ギア比は、Ｙ軸方向アクチュエータ２１および操作部３を介して使用者Ｕの上肢にＸ軸方向駆動モータ３８の駆動力を伝達するのに十分なトルクを発生し得るように設定されている。
The
（４）可動フレーム４１
図２～図４に示すように、Ｙ軸方向アクチュエータ２１は、ケーシング６内側のＹ軸方向の略全長に亘って延在する可動フレーム４１と一体化されている。図６に示すように、可動フレーム４１は、ガイド部２３の長手方向に沿って延在する断面略Ｌ字状の一対の可動フレーム部材４１ａ，４１ｂで構成されている。可動フレーム部材４１ａ，４１ｂは、それぞれＬ字状の内側をガイド部２３側に向けてガイドフレーム２５の長手方向に沿う両側部にねじ締結されている。これにより、ガイド部２３と可動フレーム部材４１ａ，４１ｂとの間には、ガイドフレーム２５の側面から側方に延出する一定幅の水平面と、断面矩形の溝状空間Ｓａ，Ｓｂとが画定される。
(4)
As shown in FIGS. 2 to 4, the Y-axis direction actuator 21 is integrated with a
ガイドフレーム２５に固定された可動フレーム部材４１ａ，４１ｂの上端部は、長手方向の全長に亘って内側すなわちガイドフレーム２５側に直角に折曲され一定狭幅の折曲板部４３ａ，４３ｂを構成している。可動フレーム部材４１ａ，４１ｂのＬ字状の垂直な内面には、その上端から少し下がった高さ位置に、該内面からガイドフレーム２５側に直角に延出する一定狭幅の突板部４４ａ，４４ｂが、長手方向の両端部を除く略全長に亘って一体に形成されている。これにより、可動フレーム部材４１ａ，４１ｂの上端部内側には、折曲板部４３ａ，４３ｂと突板部４４ａ，４４ｂとの間に隙間が、長手方向の両端部を除く略全長に亘って画定される。この隙間には、前部カバー４ｃおよび後部カバー４ｄの前後側辺部が左右方向の略全長に亘って挿入され、操作部３が前後方向（Ｙ軸後方向）に移動するときに、その移動に合わせて蛇腹構造の前部カバー４ｃおよび後部カバー４ｄを伸縮させるためのガイドとなる。
The upper ends of the
図２および図４に示すように、可動フレーム部材４１ａ，４１ｂの長手方向の両端部は、突板部４４ａ，４４ｂより下側の部分が切り欠かれており、切欠残部が長手方向の突出部４５ａ，４５ｂを構成している。突出部４５ａ，４５ｂは、アクチュエータ機構２０をケーシング６内に収容したときに、それぞれケーシング６の正面および背面側内壁（正面フレーム６ａ、背面フレーム６ｂ）の折曲板部１７ａ，１７ｂと段差面１６ａ，１６ｂとで画定された隙間内に余裕をもって挿入される。
As shown in FIGS. 2 and 4, both ends of the
（５）操作部３
図５に示すように、操作部３はアクチュエータ機構２０の上方に取り付けられている。操作部３は、比較的短い垂直な操作ロッド４８と、その上端部に設けられたハンドル部材４９とで構成されている。ハンドル部材４９は、使用者Ｕが片手で掴むことができるように、比較的厚いディスク状に形成されている。なお、ハンドル部材４９は、本実施形態では、使用者Ｕが掴んだ手で回すことができるように、操作ロッド４８を中心に回動可能に取り付けられているが、固定するようにしてもよい。操作ロッド４８は、その下端部側で操作ロッド４８に作用する力（ハンドル部材４９に作用する力）を検出する力センサ５１と一体化されている。
(5)
As shown in FIG. 5, the
図５および図６に示すように、操作部３は取付プレート５２に取り付けられている。取付プレート５２は、矩形の板状部材からなり、可動フレーム４１の長手方向に直交する幅方向に可動フレーム４１の内幅より若干小さい寸法を有する。取付プレート５２の、可動フレーム４１の長手方向に沿う両側部は、下面側が直角に切除されており、切除残部が折曲板部４３ａ，４３ｂと突板部４４ａ，４４ｂとで画定された隙間の高さ寸法より小さな寸法の側辺部５４ａ，５４ｂを構成している。
As shown in FIGS. 5 and 6, the operating
取付プレート５２は、側辺部５４ａ，５４ｂが折曲板部４３ａ，４３ｂと突板部４４ａ，４４ｂとで画定された隙間内に余裕をもって挿入され、ガイド部２３と可動フレーム部材４１ａ，４１ｂとの間に画定された溝状空間Ｓａ，Ｓｂを横断するようにスライダブロック２７に取り付けられている。
The
（６）力センサ５１
力センサ５１には、検出原理の異なる種々のタイプが知られているが、本実施形態では、力センサ５１として歪みゲージを用いた市販の６軸力覚センサが採用されている。歪みゲージは図示を省略した起歪体に貼り付けられている。起歪体は、力とトルクを受けて変形する部材であり、６軸力覚センサの性能を左右する重要な部材である。
(6)
Various types of the
一般に、６軸力覚センサは、力とトルク（モーメント）の大きさと方向を３次元空間ベクトルで示すセンサであり、直交するＸ，Ｙ，Ｚ軸方向の力Ｆ０（Ｆｘ，Ｆｙ，Ｆｚ）およびこれら３軸周りに作用するトルクＴ（Ｔｘ，Ｔｙ，Ｔｚ）を検出する。また、演算により接触情報も求め得る有用なセンサである。市販の６軸力覚センサは、通常、固定側の基部と、検出すべき外力を受けるための検知部とを有している。 In general, a 6-axis force sensor is a sensor that indicates the magnitude and direction of force and torque (moment) by a three-dimensional space vector. and the torque T (Tx, Ty, Tz) acting around these three axes. Moreover, it is a useful sensor that can obtain contact information by calculation. A commercially available 6-axis force sensor usually has a fixed-side base and a detection part for receiving an external force to be detected.
本実施形態では、６軸力覚センサのＸ軸およびＹ軸が、アクチュエータ機構２０のＸ軸方向およびＹ軸方向とそれぞれ一致するように配置されている。また、図５に示すように、力センサ５１は概ね短円柱状の基部とその上面に設けられた検知部とを有している。力センサ５１の検知部には、その上面中央に操作ロッド４８が垂直に固定されている。力センサ５１の基部は、取付プレート５２を介してＹ軸方向アクチュエータ２１のスライダブロック２７と一体化されている。
In this embodiment, the X-axis and Y-axis of the 6-axis force sensor are arranged to match the X-axis direction and Y-axis direction of the
力センサ５１は、使用者Ｕの上肢が操作部３を動かしまたは操作部３により動かされるときに、操作ロッド４８が使用者Ｕの上肢から直接受ける力Ｆ０および各軸周りに作用するトルクＴを、（Ｆｘ，Ｆｙ，Ｆｚ，Ｔｘ，Ｔｙ，Ｔｚ）として検出可能に構成されている。なお、本実施形態では、後述するように、力センサ５１を、操作部３に作用するＸ軸方向の力ＦｘおよびＹ軸方向の力Ｆｙ（厳密には、操作部３に作用する力Ｆ０のＸ軸方向のベクトル成分ＦｘおよびＹ軸方向のベクトル成分Ｆｙ）、すなわち（Ｆｘ，Ｆｙ）の検出のみに使用する。
The
（７）リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂ
図２に示すように、運動訓練装置１は、Ｙ軸方向アクチュエータ２１による操作部３のＹ軸方向の可動範囲を制限するために、一対のリミットセンサ５５ａ，５５ｂを有している。リミットセンサ５５ａ，５５ｂは、ガイド部２３と一方（図２右側）の可動フレーム部材４１ｂとの間の水平面上に、それぞれケーシング６の正面および背面側内壁の内側に配置されている。
(7)
As shown in FIG. 2, the
リミットセンサ５５ａ，５５ｂには、アームレバーを水平方向に回動可能にばね付勢した公知の構造が採用されている。図６に示すように、取付プレート５２の下面には、リミットセンサ５５ａ，５５ｂのアームレバーを回動させるための作動ブロック５６が突設されている。操作部３がＹ軸方向に移動して作動ブロック５６がアームレバーを回動させると、リミットセンサ５５ａ，５５ｂはオン状態となる。
The
また、運動訓練装置１は、図２に示すように、Ｘ軸方向アクチュエータ２２によるＹ軸方向アクチュエータ２１のＸ軸方向の可動範囲を制限するために、一対のリミットセンサ６１ａ，６１ｂを有している。リミットセンサ６１ａ，６１ｂは、背面側の左右補強部材１４ａ上に、それぞれケーシング６の左右側内壁の内側に配置されている。
In addition, as shown in FIG. 2, the
リミットセンサ６１ａ，６１ｂも、アームレバーを水平方向に回動可能にばね付勢した公知の構造を有している。図７に示すように、一方（図２の左側）の可動フレーム部材４１ａの下面には、リミットセンサ６１ａ，６１ｂのアームレバーを回動させるための作動ブロック６２が取付プレート６３を介して突設されている。操作部３がＹ軸方向アクチュエータ２１とともにＸ軸方向に移動して作動ブロック６２がアームレバーを回動させると、リミットセンサ６１ａ，６１ｂはオン状態となる。
The
図８は、アクチュエータ機構２０における操作部３のＸ軸およびＹ軸方向の可動範囲を示したものである。また、図１０は、ＸＹ平面での操作部３の可動範囲とリミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂとの関係を示している。
FIG. 8 shows the movable range of the operating
図１０に示す破線は、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂが作動ブロック５６，６２を検出しリミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行する位置を示している。この破線の位置から所定距離（後述するＤ１）内側には斜線で表した領域が設けられている。この斜線で表した操作部３が移動可能なＸＹ平面での中心部を含む領域は、使用者Ｕの運動訓練が可能な領域であり、本実施形態では表示装置８０（図１１参照）が操作者Ｕの運動訓練中または訓練後の操作部３の軌跡や負荷変動を表示（提示）可能な領域でもあることから、以下、この領域を力覚提示エリアＡｆという。
The dashed lines shown in FIG. 10 indicate positions where the
リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂのアームレバーは、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行した後、なおも回動可能に構成されており、アームレバーの回動限界がＸ軸およびＹ軸方向アクチュエータ２２，２１の機械的動作限界となる。この機械的動作限界の位置をＸＹ平面上で表すと、図１０の外枠となる。以下、力覚提示エリアＡｆの外側かつ図１０の外枠内の領域を安全対策エリアＡｓという。
The arm levers of the
なお、本実施形態では、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行する位置間の寸法が５４０［ｍｍ］（Ｘ軸方向）×５５０［ｍｍ］（Ｙ軸方向）に設定されている。また、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行する位置から力覚提示エリアＡｆの境界線までの距離Ｄ１がＸ軸およびＹ軸方向ともに３０［ｍｍ］、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行する位置からＸ軸およびＹ軸方向アクチュエータ２２，２１の機械的動作限界までの距離Ｄ２がＸ軸およびＹ軸方向ともに２０［ｍｍ］に設定されている。従って、力覚提示エリアＡｆの寸法は、５１０［ｍｍ］（Ｘ軸方向）×５２０［ｍｍ］（Ｙ軸方向）に設定されている。
In this embodiment, the dimension between the positions where the
（８）ホームポジションセンサ５７，６４
図２に示すように、運動訓練装置１は、操作部３のＸ軸方向の初期位置を設定するためのホームポジションセンサ６４を有している。ホームポジションセンサ６４は、ケーシング６の背面側の左右補強部材１４ａ上に、リミットセンサ６１ｂよりも中央寄りに配置されている。図７に示すように、可動フレーム部材４１ａの下面には、垂直下向きに突出する板状のセンサフラグ部材６５が、操作部３をＸ軸方向に移動させたときに、ホームポジションセンサ６４の投光部と受光部の間隙を通過し得るように、取付プレート６３に取り付けられている。
(8)
As shown in FIG. 2, the
また、運動訓練装置１は、図２に示すように、操作部３をＹ軸方向の初期位置を設定するためのホームポジションセンサ５７を有している。ホームポジションセンサ５７は、可動フレーム部材４１ｂとの間の水平面上に、リミットセンサ５５ａよりも背面寄りに配置されている。取付プレート５２には、Ｘ軸方向のセンサフラグ部材６５と同様に、垂直下向きに突出する板状のセンサフラグ部材（不図示）が、操作部３をＹ軸方向に移動させたときに、ホームポジションセンサ５７の投光部と受光部の間隙を通過し得るように取り付けられている。
The
ホームポジションセンサ６４，５７は、小さな隙間をもって対向配置した投光部と受光部とを有する透過一体型センサであり、本実施形態では、受光部に入光するとオフ状態、受光部が遮光されるとオン状態となるものが用いられている。
The
図９は、操作部３がホームポジションに位置した状態を示している。図９に示すように、操作部３のホームポジションは、Ｘ軸およびＹ軸方向アクチュエータ２２，２１の交差中央位置を基準としたときに、Ｙ軸方向で正面寄りかつＸ軸方向で右寄りに設定されている。このため、使用者Ｕは、図１に示すように運動訓練装置１の正面に位置したときに、右手ＨＲを前に伸ばすと直ぐに操作部３のハンドル部材４９に触れることができる。
FIG. 9 shows a state in which the
（９）電気系
さらに、運動訓練装置１は、ケーシング６内に、運動訓練装置１を制御する制御部７０（図１１参照）と、商業交流電力から上述した機構部および制御部７０を駆動／作動させるための直流電力に変換する電源部（不図示）とを備えている。
(9) Electrical system Further, the
１．２．制御部
１．２．１．制御部概要
図１１に示すように、制御部７０は、高速演算を行うＣＰＵ、基本制御プログラムおよびプログラムデータを記憶したＲＯＭ、ＣＰＵのワークエリアとして働くとともに種々のデータを一時的に記憶するＲＡＭおよびこれらを接続する内部バスで構成されたＭＣＵ７１を有している。
1.2. Control unit 1.2.1. Outline of Control Unit As shown in FIG. 11, the
ＭＣＵ７１の内部バスは外部バスに接続されている。外部バスには、Ｘ軸およびＹ軸方向駆動モータ３８，３０の駆動を制御する駆動制御部７２、上述した各センサからの信号を処理する信号処理部７３、大容量フラッシュメモリやハードディスク等の不揮発性メモリ７４、マウスやキーボード等の入力装置７９から入力された情報を制御する入力制御部７５、ディスプレイ等の表示装置８０への表示（描画）を制御する表示制御部７６、状態表示ランプ９ａ～９ｃを点灯させるランプ点灯回路７７およびインターフェース（Ｉ／Ｆ）８１を介してノートパソコン等の外部装置との通信を制御する通信制御部７８が接続されている。
An internal bus of
１．２．２．制御部詳細
（１）駆動制御部７２
駆動制御部７２は、Ｘ軸方向駆動モータ３８の駆動を制御するＸ軸方向モータドライバと、Ｙ軸方向駆動モータ３０の駆動を制御するＹ軸方向モータドライバとで構成されている。Ｘ軸およびＹ軸方向モータドライバはそれぞれ制御ＩＣ（不図示）を有している。各制御ＩＣは、ＭＣＵ７１から指令された電流値（出力電流Ｉｉ、デューティ）に従って、Ｘ軸またはＹ軸方向駆動モータ３８，３０への電力供給を制御する（図１３（Ｂ）も参照）。
1.2.2. Details of control section (1) Drive
The
（２）信号処理部７３
信号処理部７３は、信号処理ＩＣ（不図示）で力センサ５１から出力された信号を処理しＭＣＵ７１に出力する。すなわち、６軸力覚センサに設けられた歪みゲージの信号をブリッジ回路で電圧（変化）信号に変換し、ローパスフィルタ（ＬＰＦ）で高周波ノイズを除去した後、オペアンプ等の増幅回路で微弱な信号を増幅する。次に、増幅された信号をＡ／Ｄコンバータでデジタル値に変換し、信号処理ＩＣで歪み－荷重変換行列演算を行って力とトルクの分力（Ｆｘ，Ｆｙ，Ｆｚ，Ｔｘ，Ｔｙ，Ｔｚ）を算出する。
(2)
The
ただし、本実施形態では、ＭＣＵ７１が操作部３に作用するＸ軸方向の力Ｆｘ、Ｙ軸方向の力Ｆｙのみを使用するため、信号処理部７３は演算した（Ｆｘ，Ｆｙ）の値をＭＣＵ７１に出力する。なお、本実施形態では、上述したＡ／Ｄコンバータのサンプリングレートが１０［ｍｓ］に設定されているため、信号処理部７３は１０［ｍｓ］ごとに（Ｆｘ，Ｆｙ）の値をＭＣＵ７１に出力する。
However, in this embodiment, since the
さらに、信号処理部７３は、エンコーダ３０ａ，３８ａから出力されたパルス数をカウントしたカウント値と回転方向のデフォルト値（例えば、Ｘ軸またはＹ軸方向駆動モータ３８，３０が正転とき０、逆転のとき１）とをＭＣＵ７１に出力する。
Further, the
また、信号処理部７３は、ホームポジションセンサ５７，６４がオン状態となったか（ホームポジションを検出したか）、および、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態となったか否かを表すデフォルト値（例えば、オフ状態のときのデフォルト値が０、オン状態のときのデフォルト値が１）をＭＣＵ７１に出力する。
The
さらに、信号処理部７３は、マニュアル操作ボタン１０ａ～１０ｃが押下された否かを監視して（マニュアル操作ボタン１０ａ～１０ｃの押下を検出する各スイッチング素子の出力がハイレベルとなったか否かを参照して）、デフォルト値（例えば、オフ状態のときのデフォルト値が０、オン状態のときのデフォルト値が１）をＭＣＵ７１に出力する。なお、各スイッチング素子の出力側と上述した信号処理ＩＣの入力側との間には、信号処理ＩＣの破損を防止するために保護抵抗が挿入されている。
Further, the
本実施形態では、力センサ５１の（Ｆｘ，Ｆｙ）の値が１０［ｍｓ］ごとにＭＣＵ７１に出力されることから、この周期に合わせて以上の信号情報をＭＣＵ７１に出力する。すなわち、信号処理部７３は、例えば、（Ｆｘ，Ｆｙ，エンコーダ３８ａのカウント値，Ｘ軸方向駆動モータ３８の回転方向のデフォルト値，エンコーダ３０ａのカウント値，Ｙ軸方向駆動モータ３０の回転方向のデフォルト値，ホームポジションセンサ５７の状態のデフォルト値，ホームポジションセンサ６４の状態のデフォルト値，リミットセンサ５５ａの状態のデフォルト値，リミットセンサ５５ｂの状態のデフォルト値，リミットセンサ６１ａの状態のデフォルト値，リミットセンサ６１ｂの状態のデフォルト値，緊急停止ボタン１０ａの状態のデフォルト値，一時停止ボタン１０ｂの状態のデフォルト値，イニシャルボタン１０ｃの状態のデフォルト値）で表される信号情報を１０［ｍｓ］ごとにＭＣＵ７１に出力する。
In this embodiment, since the value of (Fx, Fy) of the
なお、ＭＣＵ７１は、緊急停止ボタン１０ａ、一時停止ボタン１０ｂの状態のデフォルト値が緊急停止ボタン１０ａ、一時停止ボタン１０ｂが押下されたことを表すときには、駆動制御部７２を介してＸ軸およびＹ軸方向駆動モータ３８，３０の駆動を停止させるように制御する。この点は、リミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂのデフォルト値がオン状態に移行したことを表すデフォルト値の場合も同じである。また、ＭＣＵ７１は、緊急停止ボタン１０ａが押下されたときおよびリミットセンサ５５ａ，５５ｂ，６１ａ，６１ｂがオン状態に移行したときは、後述する軌跡設定ルーチン、負荷検出ルーチンおよび運動訓練ルーチンを直ちに終了する。
When the default values of the states of the
また、ＭＣＵ７１は、イニシャルボタン１０ｃの状態を表すデフォルト値がイニシャルボタン１０ｃが押下されたことを表すときには、操作部３をホームポジションに位置付けるため、駆動制御部７２を介して予め設定された速度でＸ軸およびＹ軸方向駆動モータ３８，３０を駆動させ、信号処理部７３から出力されたホームポジションセンサ５７のデフォルト値、ホームポジションセンサ６４のデフォルト値がそれぞれホームポジションに位置することを表すデフォルト値となったときに、Ｘ軸およびＹ軸方向駆動モータ３８，３０の駆動を個別に停止させる。
Further, when the default value representing the state of the
（３）ランプ点灯回路７７
ランプ点灯回路７７は、緑色ＬＥＤ９ａ、白色ＬＥＤ９ｂ、赤色ＬＥＤ９ｃを点灯させる３つの点灯回路で構成されている。各点灯回路はＭＯＳＦＥＴ等のスイッチング素子を有しており、ＭＣＵ７１が運動訓練装置１の状態に応じてデジタル信号（ハイレベル信号）をスイッチング素子のゲートに出力することでオン状態となり、緑色ＬＥＤ９ａ、白色ＬＥＤ９ｂおよび赤色ＬＥＤ９ｃを個別に点灯させる。なお、各スイッチング素子のゲートとＭＣＵ７１との間には、ＭＣＵ７１の破損を防止するために保護抵抗が挿入されている。
(3)
The
（４）その他
不揮発性メモリ７４、入力制御部７５、表示制御部７６および通信制御部７８には公知のものを用いることができる。付言すると、不揮発性メモリ７４は、使用者Ｕの個人データや運動訓練履歴等の運動訓練に関するデータを保存する。また、表示制御部７６は、ＭＣＵ７１の処理周期（１０［ｍｓ］）が表示装置８０の垂直帰線周期と相違することから、垂直帰線周期と一致した１／６０［ｓ］（１６．６［ｍｓ］）に一度の周期で行われる垂直帰線割込（Vsync）がなされたか否かを判断し、否定判断のときはＭＣＵ７１から指令された描画情報を追加し、肯定判断のときは現在の描画情報を表示装置８０に出力する。
(4) Others Known components can be used for the
２．動作
次に、本実施形態の運動訓練装置１の動作について説明する。
2. Operation Next, the operation of the
２．１．動作制御概要
図１２に示すように、ＭＣＵ７１は、後述する能動訓練モードにおいて、信号処理部７３から出力された操作部３に作用するＸ軸方向の力ＦｘおよびＹ軸方向の力Ｆｙから、平面運動における静止摩擦を模擬した仮想モデルＩＭを介して操作部３に発生させるべきＸ軸方向の速度ｖｖｘおよびＹ軸方向の速度ｖｖｙを算出し、駆動制御部７２に出力する。
2.1. Outline of Operation Control As shown in FIG. 12, the
仮想モデルＩＭは下記式で表される。
式（１）上段は操作部３の静止状態を示し、下段は動作状態を示す。ｍｖは操作部３の仮想質量、ｖｖｉは操作部３の速度、ｃｖは粘性減衰係数、μｋは摩擦係数、Ｆ０は（Ｆｘ，Ｆｙ）の合成力、μｓは最大静止摩擦力、ｖｖｓｔは操作部３が静止しているとみなす領域であり、ｖｖｓｔ＜＜１として与えられる。また、ｕｉは操作部３の速度の大きさを１に正規化したときの各軸方向の分速度であり、（ｕｘ
２＋ｕｙ
２）は１となる。式（４）は例えば力センサ５１に対するノイズやＭＣＵ７１の計算誤差の影響で動摩擦力が過大となることを防ぐために設けられている。
The upper part of the equation (1) indicates the stationary state of the
式（１）上段は、図１４（Ａ）に示すように、合成力Ｆ０が静止摩擦を再現するための円形の静止摩擦エリア９０内にあるときの操作部３の速度（ｖｖｘ，ｖｖｙ）の計算式となり、下段は、図１４（Ｂ）（Ｃ）に示すように、合成力Ｆ０が静止摩擦エリア９０外にあるときの操作部３の速度（ｖｖｘ，ｖｖｙ）の計算式となる。静止摩擦エリア９０は、式（１）上段によりμsおよびｖｖｓｔの値によって大きさが定まる。μsおよびｖｖｓｔの値は操作部３に発生させるべき速度（指令速度）の大きさによって決定できるので、静止摩擦エリア９０の半径の値は任意の値に設定することができる。
The upper part of equation ( 1 ) expresses the velocity (v vx , v vy ), and the lower part shows the velocity (v vx , v vy ) of the
なお、力センサ５１が検出するＸ軸およびＹ軸方向の力（Ｆｘ，Ｆｙ）は、Ｘ軸およびＹ軸方向駆動モータ３８，３０の駆動力により操作部３に発生させるべき力の分力として検出される。
The forces (Fx, Fy) in the X-axis and Y-axis directions detected by the
図１３（Ａ）に示すように、仮想モデルＩＭを用いて算出した操作部３の速度（ｖｖｘ，ｖｖｙ）を指令速度とし、駆動制御部７２によって実際の操作部３の速度（ｖｘ，ｖｙ）を指令速度に追随させることで仮想運動環境を具現する。なお、ＭＣＵ７１による具体的制御については後述する。
As shown in FIG. 13A, the speed (v vx , v vy ) of the
ここで、Ｘ軸およびＹ軸方向駆動モータ３８，３０にＤＣサーボモータを用いることから駆動制御部７２（モータドライバ）の制御モードをＰＩＤ制御に設定することで、指令速度に高精度に追随させることができる。しかし、仮想質量ｍｖを小さくして訓練負荷を小さく設定した場合には、ＰＩＤ制御の積分動作による応答遅れが影響し、操作中に操作部３が振動的になることが確認されている。そこで、力覚提示エリアＡｆにおいて、制御モードを、ＰＩＤ制御から偏差の積分値に比例した出力（電流値）を算出するための積分項を除いたＰＤ制御（またはさらに偏差の微分値に比例した出力を算出するための微分項を除いたＰ制御）とし比例ゲイン（Ｋｐ）を高く設定することで、定常偏差は生じるものの応答性が改善され、操作中に生じる操作部３の振動を抑制する。
Here, since DC servomotors are used for the X-axis and Y-axis direction drive
一方、指令速度（ｖｖｘ，ｖｖｙ）対する定常偏差が大きいと、操作部３の機械的動作限界（図１０参照）に対する位置精度が低下することから、操作部３が運動訓練装置１の機械的作動限界に衝突して使用者Ｕや運動訓練装置１に衝撃に与えるおそれがある。この場合、操作部３の振動を抑制するためにフィルタ等を設けることも考えられるが、同様に応答遅れが影響し位置精度が低下する。このような衝撃を未然に防止するために、機械的動作限界に対して操作部３の力覚提示エリアＡｆの境界線の設定に大きな余裕をとる必要があるが、その結果、力覚提示エリアＡｆが極端に狭くなってしまう。そこで、位置精度を重視すべき領域（上述した安全対策エリアＡｓ）では、ＰＩＤ（またはＰＩ）制御とする。
On the other hand, if the steady-state deviation with respect to the command speed (v vx , v vy ) is large, the positional accuracy of the
２．２．動作詳細
次に、本実施形態の運動訓練装置１の動作についてＭＣＵ７１のＣＰＵ（以下、ＣＰＵという。）を主体として説明する。
2.2. Details of Operation Next, the operation of the
運動訓練装置１により使用者Ｕが運動訓練を行う際には、（１）使用者Ｕが操作部３を掴みその上から訓練指導者が使用者Ｕの手をとって使用者Ｕの上肢状況に応じた動作範囲で操作部３を移動させることで、操作部３が辿る軌跡を設定するための軌跡設定モードと、（２）使用者Ｕのみが操作部３を掴み軌跡設定モードで設定された軌跡を辿ることで、使用者Ｕによる操作部３の位置（軌跡）とそのときに操作部３が受ける負荷とを検出するための負荷検出モードと経て、（３）運動訓練モードで行われる。なお、以下では、各モードでのＣＰＵによる制御がなされる前に、イニシャルボタン１０ｃが押下され操作部３はホームポジションに位置しているものとして説明する。
When the user U performs exercise training with the
（１）軌跡設定モード
ＣＰＵは、軌跡設定モードにおいて、図１５に示す軌跡設定ルーチンを実行する。軌跡設定ルーチンでは、まずステップ（以下、Ｓと略称する。）１０２において、駆動制御部７２を介してＸ軸およびＹ軸駆動モータ３８，３０を励磁させる。操作部３は減速ギアユニット３９，３１を介してＸ軸およびＹ軸駆動モータ３８，３０に連結されているため、訓練指導者の主導で使用者Ｕが操作部３を移動させる際に使用者Ｕには所定の負荷が掛かる。なお、Ｓ１０２または次に述べるＳ１０４により前に、使用者Ｕが訓練指導者の主導によって辿る予定の全体軌跡（参照軌跡）を予め表示装置８０に表示するようにしてもよい。
(1) Trajectory Setting Mode The CPU executes a trajectory setting routine shown in FIG. 15 in the trajectory setting mode. In the trajectory setting routine, first, in step (hereinafter abbreviated as S) 102 , the X-axis and Y-
次にＳ１０４で上述した信号情報を取り込み、Ｓ１０６において操作部３の位置（Ｐｘ，Ｐｙ）を算出する。すなわち、ＣＰＵは、信号情報に含まれるエンコーダ３８ａのカウント値を一周期（１０［ｍｓ］）前のカウント積算値に積算することで操作部３のＸ軸方向の位置Ｐｘを算出し、同様に、信号情報に含まれるエンコーダ３０ａのカウント値を一周期前のカウント積算値に積算することで操作部３のＹ軸方向の位置Ｐｙを算出する。その際、信号情報に含まれるＸ軸およびＹ軸方向駆動モータ３８，３０の回転方向のデフォルト値を参照してカウント値を加算するか減算するかを判断する。
Next, in S104, the signal information described above is taken in, and in S106, the position (Px, Py) of the
次いでＳ１０８において、操作部３の移動が終了したか否かを判断する。すなわち、操作部３の位置（Ｐｘ，Ｐｙ）が予め設定された設定時間（例えば、１．５［ｓ］の間）、ほぼ同じ値か否かを判断し、否定判断のときは次の（１０［ｍｓ］後の）操作部３の位置を検出するためにＳ１０４に戻り、肯定判断のときはＳ１１０に進む。従って、ＣＰＵは、１０［ｍｓ］ごとに操作部３の位置（Ｐｘ，Ｐｙ）を算出する。
Next, in S108, it is determined whether or not the movement of the
Ｓ１１０では、１０［ｍｓ］ごとに算出した操作部３の位置（Ｐｘ，Ｐｙ）のデータを時系列順に並べた軌跡情報Ｉ１として不揮発性メモリ７４に保存して軌跡設定ルーチンを終了する。その際、ＣＰＵは、Ｓ１０８で説明した設定時間の操作部３の位置（Ｐｘ，Ｐｙ）のデータを削除して不揮発性メモリ７４に保存する。
In S110, data of the position (Px, Py) of the
（２）負荷検出モード
ＣＰＵは、負荷検出モードにおいて、図１６に示す負荷検出ルーチンを実行する。負荷設定ルーチンでは、Ｓ２０２で不揮発性メモリ７４に保存した軌跡情報Ｉ１を読み出し、次のＳ２０４において操作部３が軌跡情報Ｉ１の位置となるように（操作部３が移動軌跡設定モードで設定された軌跡を再現するように）駆動制御部７２を介してＸ軸およびＹ軸方向駆動モータ３８，３０を駆動させる。すなわち、軌跡情報Ｉ１の処理対象の現在の位置と軌跡情報Ｉ１の次の位置とのそれぞれＸ軸方向およびＹ軸方向の距離をこの間の移動時間１０［ｍｓ］で割ることで求めた指令速度を駆動制御部７２に出力する。
(2) Load Detection Mode The CPU executes the load detection routine shown in FIG. 16 in the load detection mode. In the load setting routine, the trajectory information I1 stored in the non-volatile memory 74 is read out in S202, and the
次にＳ２０６で信号情報を取り込み、Ｓ２０８において信号情報に含まれるエンコーダ３８ａ，３０ａのカウント値を積算することで操作部３の位置（Ｐｘ，Ｐｙ）を算出する。次いでＳ２１０で信号情報に含まれる、操作部３に作用するＸ軸およびＹ軸方向の力（Ｆｘ，Ｆｙ）を合成した合成力Ｆ０を算出する（図１４、式（２）も参照）。次のＳ２１２では、Ｓ２０８で算出した操作部３の位置（Ｐｘ，Ｐｙ）およびＳ２１０で算出した合成力Ｆ０（負荷）を表示制御部７６に出力して表示装置８０に操作部３の位置および負荷を表示させる。このとき、表示制御部７６は一周期前の画情報に今回（直近）の描画情報を追加した画情報を生成するとともに、予め定められた画像表示上の原点位置を基準に平行移動処理を行う。
Next, in S206, the signal information is fetched, and in S208, the count values of the
次にＳ２１４において、Ｓ２０２で読み出した軌跡情報Ｉ１の最後の位置に操作部３を位置付ける処理を行ったか否かを判定することで操作部３の移動が終了したか否かを判断する。否定判断のときは負荷検出を続行するためにＳ２０４に戻り、肯定判断のときはＳ２１６に進む。Ｓ２１６では、１０［ｍｓ］ごとに算出した操作部３の位置（Ｐｘ，Ｐｙ）のデータおよび操作部３に作用する力（Ｆｘ，Ｆｙ，Ｆ０）のデータを時系列順に並べた軌跡-負荷情報Ｉ２（Ｐｘ，Ｐｙ，Ｆｘ，Ｆｙ，Ｆ０）として不揮発性メモリ７４に保存して負荷設定ルーチンを終了する。
Next, in S214, it is determined whether or not the
図２０は、Ｓ２１４における肯定判断時点で表示装置８０に描画された画面を模式的に示した（合成力Ｆ０（負荷）を絶対値｜Ｆ０｜で示した）もので、画面上部には使用者Ｕが操作部３を移動させて辿った軌跡、下部には時間軸を横軸にとったときの軌跡の各位置における負荷変動が表示されている。図２０の例では、時刻Ｔ１から時刻Ｔ２の範囲で、使用者Ｕから操作部３に大きな力が加わったことが示されている。表示制御部７６は、ＣＰＵの指示（ＣＰＵから出力される閾値情報）に従って、例えば、Ｓ２１４における肯定判断後にこの範囲の表示の色を変えるように表示装置８０を制御してもよい。或いは、図２０に示すように、鎖線で囲って強調するようにしてもよい。時刻Ｔ１から時刻Ｔ２の範囲での軌跡を参照すると、使用者Ｕが操作部３をうまく操作できないと推測でき、運動訓練者はこのデータを参照して使用者Ｕの運動訓練プログラムを作成することができる。
FIG. 20 schematically shows the screen drawn on the
（３）運動訓練モード
ＣＰＵは、運動訓練モードにおいて、図１７に示す運動訓練ルーチンを実行する。なお、運動訓練モードには、使用者Ｕが自ら軌跡-負荷情報Ｉ２の軌跡をなぞるように操作部３を移動させる能動訓練モードと、自動的に軌跡-負荷情報Ｉ２の軌跡を辿る操作部３に引っ張られて運動する受動訓練モードとがある。受動訓練モードは主としてリハビリ中の人を対象とする運動訓練モード、能動訓練モードはリハビリ最終段階の人や健常者を対象とする運動訓練モードとして想定されている。なお、運動訓練装置１は、健常者の運動訓練にも対応可能なようにＦｘ、Ｆｙの最大値：９０［Ｎ］、最大加速度：８［ｍ／ｓ２］、最大速度：１．２４［ｍ／ｓ］に設定されている。
(3) Exercise training mode The CPU executes an exercise training routine shown in FIG. 17 in the exercise training mode. The exercise training mode includes an active training mode in which the user U moves the
運動訓練ルーチンでは、まずＳ３０２において、不揮発性メモリ７４に保存した軌跡-負荷情報Ｉ２を読み出す。次いでＳ３０４で能動訓練モードおよび受動訓練モードのいずれを選択するかを問い合わせる画面を表示装置８０に表示させ、Ｓ３０６でいずれかの選択（入力）があるまで待機する（Ｓ３０６で否定判断）。選択があると（Ｓ３０６で肯定判断）、次のＳ３０８において能動訓練モードが選択されたか否かを判断し、肯定判断のときはＳ３１０に進み、否定判断のときはＳ３２８に進む。
In the exercise training routine, first, in S302, the trajectory-load information I2 stored in the
Ｓ３１０では、調整値情報を要求する画面を表示装置８０に表示させる。この調整値は、上述した仮想モデルＩＭを表す式（１）のパラメータ（仮想質量ｍｖ、粘性減衰係数ｃｖ、摩擦係数μｋ、最大静止摩擦力μｓ、操作部３が静止しているとみなす領域ｖｖｓｔ）であるが、本実施形態では、表示装置８０に、例えば運動量や静止摩擦力の大きさに応じて予め定めた幾とおりかの選択子にその説明（例えば、運動量：大、静止摩擦力：中）を加えた画面を表示したり、運動量や静止摩擦力の大きさを調整可能に表したレベルメータを表示したりすることでパラメータの入力を容易にしている。
In S310, a screen requesting adjustment value information is displayed on the
次にＳ３１２において、調整値情報の入力があるまで待機し（Ｓ３１２で否定判断）、入力があると（Ｓ３１２で肯定判断）、次のＳ３１４において調整値情報を取り込んで上述したパラメータの値を確定させるとともに、確定したμｓおよびｖｖｓｔの値から図１４に示した静止摩擦エリア９０の半径の値（後述する所定値、図１８のＳ４０８も参照）を決定する。このとき、ＣＰＵは、操作部３の振動を抑制するために、操作部３の仮想質量ｍｖが予め設定された閾値（例えば、４［ｋｇ］、後述する第１の閾値）未満のときに、操作部３の仮想質量ｍｖをこの閾値の値に設定する。
Next, in S312, it waits until adjustment value information is input (negative determination in S312), and if there is input (positive determination in S312), the adjustment value information is taken in in the next S314, and the values of the parameters described above are determined. 14 ( predetermined value, see also S408 in FIG. 18) of the
次いでＳ３１６において、上述した信号情報を監視して操作部３に力（Ｆｘ，Ｆｙ）が作用したか否か、および、操作部３の位置がホームポジションから移動したか否かを判定することで、能動訓練が開始されたか否かを判断する。なお、能動訓練開始前（Ｓ３１６の判定でいずれかが否定判定のとき）は、Ｘ軸およびＹ軸方向駆動モータ３８，３０は励磁状態にあり、操作部３はホームポジション（０，０）に位置している。
Next, in S316, by monitoring the signal information described above, it is determined whether the force (Fx, Fy) is applied to the
能動訓練が開始されると（Ｓ３１６の判定で双方が肯定）、Ｓ３１８で信号情報を取り込み、Ｓ３２０において信号情報に含まれるエンコーダ３８ａ，３０ａのカウント値を積算することで操作部３の位置（Ｐｘ，Ｐｙ）を算出する。また、Ｓ３２０では、信号情報に含まれるエンコーダ３８ａ，３０ａのカウント値、すなわちＸ軸およびＹ軸方向駆動モータ３８，３０の回転速度（と減速ギアユニット３９，３１の減速ギア比と）から操作部３の実際の速度（ｖｘ，ｖｙ）を算出する。
When active training is started (both sides are affirmative at S316), the signal information is captured at S318, and the count values of the
次のＳ３２２では、駆動制御部７２に指令（出力電流Ｉｉ）を与えるための駆動指令処理を実行する。図１８は、Ｓ３２２の駆動指令処理の詳細を示す駆動指令処理サブルーチンのフローチャートを示したものである。駆動指令処理サブルーチンでは、Ｓ４０２において、軌跡-負荷情報Ｉ２の軌跡位置とＳ３２０で算出した位置（Ｐｘ，Ｐｙ）との位置差（距離差）が予め定められた許容範囲内か否かを判断し、否定判断のときは使用者Ｕの上肢の運動範囲が広がり過ぎるとみなし駆動指令処理サブルーチンを終了して図１７のＳ３４２に進み、肯定判断のときはＳ４０４に進む。
In the next step S322, drive command processing for giving a command (output current Ii) to the
Ｓ４０４では、信号情報に含まれる操作部３に作用する力（Ｆｘ，Ｆｙ）を合成した合成力Ｆ０を算出し、次のＳ４０６において、合成力Ｆ０の大きさ（絶対値）｜Ｆ０｜と、Ｓ３２０で算出した操作部３の位置（Ｐｘ，Ｐｙ）に最も近い軌跡-負荷情報Ｉ２の操作部３の位置における合成力Ｆ０の大きさ｜Ｆ０｜との差（負荷差）が予め定められた許容範囲内か否かを判断し、否定判断のときは使用者Ｕに予定以上の負担が掛り過ぎているとみなし駆動指令処理サブルーチンを終了して図１７のＳ３４２に進み、肯定判断のときはＳ４０８に進む。
In S404, the resultant force F0 is calculated by synthesizing the forces ( Fx , Fy ) acting on the
Ｓ４０８では、合成力Ｆ０が図１４に示した静止摩擦エリア９０内にあるかを判定するために、合成力Ｆ０の大きさ｜Ｆ０｜が所定値（図１７のＳ３１４で算出した静止摩擦エリア９０の半径の値）以下か否かを判断し、肯定判断のときは、Ｓ４１０で式（１）上段により指令速度（ｖｖｘ，ｖｖｙ）を算出してＳ４１４に進み、否定判断のときは、Ｓ４１２で式（１）下段により指令速度（ｖｖｘ，ｖｖｙ）を算出してＳ４１４に進む。ここで留意すべき点は、Ｓ４１０およびＳ４１２（特に、Ｓ４１２）で式（１）を用いて指令速度（ｖｖｘ，ｖｖｙ）を算出する際に、合成力Ｆ０に対応する速度ｖｖを求め、その速度ｖｖをＸ軸およびＹ軸方向の速度ｖｖｘ，ｖｖｙに分解して指令速度（ｖｖｘ，ｖｖｙ）を算出することである。
In S408, in order to determine whether the resultant force F 0 is within the
Ｓ４１４では、Ｓ３２０で算出した操作部３の位置（Ｐｘ，Ｐｙ）が力覚提示エリアＡｆ（図１０参照）内か否かを判断し、肯定判断のときは、Ｓ４１６においてＸ軸およびＹ軸方向駆動モータ３８，３０に対する制御モードをＰＤ制御またはＰ制御と決定し、否定判断のとき（安全対策エリアＡｓ内のとき）は、Ｓ４１８においてＸ軸およびＹ軸方向駆動モータ３８，３０に対する制御モードをＰＩＤ制御またはＰＩ制御と決定する。
In S414, it is determined whether or not the position (Px, Py) of the
次に、ＣＰＵは、Ｓ４２０において、Ｓ３２０で算出した操作部３の実際の速度（ｖｘ，ｖｙ）およびＳ４１０またはＳ４１２で算出した指令速度（ｖｖｘ，ｖｖｙ）、並びに、Ｓ４１６またはＳ４１８で決定した制御モードに従って出力電流Ｉｉすなわち駆動量を算出し、算出した出力電流Ｉｉ（デューティ）を駆動制御部７２に指令して駆動指令処理サブルーチンを終了し、図１７のＳ３２４に進む。
Next, in S420, the CPU determines the actual speed ( vx, vy) of the operation unit 3 calculated in S320, the command speed (vvx , vvy ) calculated in S410 or S412, and The output current Ii, that is, the drive amount is calculated according to the determined control mode, and the calculated output current Ii (duty) is commanded to the
ここで、図１３を参照してＳ４２０での出力電流Ｉｉの算出処理について簡単に補足する。図１３（Ａ）は駆動モータ制御の概念、図１３（Ｂ）はＣＰＵによる本実施形態での駆動モータ制御を示したものである。図１３（Ａ）に示すように、ＣＰＵは、操作部３の実際の速度が指令速度に追随するように、ａ）ＰＤ制御（Proportional-Differential Control）若しくはＰ制御（Proportional Control）、または、ｂ）ＰＩＤ制御（Proportional-Integral-Differential Control）若しくはＰＩ制御（Proportional-Integral Control）のいずれかの制御モードでＸ軸およびＹ軸方向駆動モータ３８，３０の駆動を制御する。
Here, the calculation processing of the output current Ii in S420 will be briefly supplemented with reference to FIG. FIG. 13(A) shows the concept of drive motor control, and FIG. 13(B) shows the drive motor control in this embodiment by the CPU. As shown in FIG. 13A, the CPU controls a) PD control (Proportional-Differential Control) or P control (Proportional Control), or b ) Controls the driving of the X-axis and Y-axis direction drive
このため、ＣＰＵは、図１３（Ｂ）に示すように、決定した制御モードに従って出力電流Ｉｉを算出する。すなわち、制御モードをＰＤ（Ｐ）制御と決定した場合には偏差の積分値に比例した電流分を加えず、ＰＩＤ（ＰＩ）制御と決定した場合には偏差の積分値に比例した電流分を加えて出力電流Ｉｉを算出する。その際、ＣＰＵは、ＭＣＵ７１のＲＯＭに格納されＲＡＭに展開された、指令速度、減速ギアユニット３１または減速ギアユニット３９の減速ギア比、モータの回転速度およびモータへの出力電流（デューティ）の関係を表した関係式を参照する。なお、本実施形態では、ＣＰＵは、一周期前に算出したモータの回転速度と、今回（直近に）検出された実際のモータの回転速度とから偏差を算出する。
Therefore, the CPU calculates the output current Ii according to the determined control mode, as shown in FIG. 13(B). That is, when the control mode is determined to be PD (P) control, the current proportional to the integral value of the deviation is not added, and when the control mode is determined to be PID (PI) control, the current proportional to the integral value of the deviation is added. In addition, the output current Ii is calculated. At that time, the CPU controls the relationship between the command speed, the reduction gear ratio of the
図１７のＳ３２４では、Ｓ３２０で算出した操作部３の位置（Ｐｘ，Ｐｙ）および図１８のＳ４０４で算出した合成力Ｆ０（負荷）、並びに、軌跡-負荷情報Ｉ２の位置（Ｐｘ，Ｐｙ）および軌跡-負荷情報Ｉ２の当該位置での合成力Ｆ０のデータを表示制御部７６に出力して表示装置８０に操作部３の軌跡および負荷変動を表示させる。なお、軌跡-負荷情報Ｉ２の位置および合成力Ｆ０のデータは、時系列順に纏められた軌跡-負荷情報Ｉ２（Ｐｘ，Ｐｙ，Ｆｘ，Ｆｙ，Ｆ０）の中から１０［ｍｓ］ごとに順次選択される。これにより、表示装置８０の画面上部には、負荷検出モードで操作者Ｕが操作部３を操作したときのスピードと能動訓練モードで操作部３を操作したときのスピードとの違いがリアルタイムで表示される。
In S324 of FIG. 17, the position (Px, Py) of the
次にＳ３２６において、図１５のＳ１０８と同様に、操作部３の位置（Ｐｘ，Ｐｙ）が予め設定された設定時間、ほぼ同じ値か否かを判定することで、操作部３の移動が終了したか否かを判断する。否定判断のときは使用者Ｕの能動訓練を続行するためにＳ３１８に戻り、肯定判断のときはＳ３４２に進む。
Next, in S326, similarly to S108 in FIG. 15, it is determined whether or not the position (Px, Py) of the
図２１は、Ｓ３２６における肯定判断時点で表示装置８０に描画された画面を模式的に示した（合成力Ｆ０を絶対値｜Ｆ０｜で示した）もので、画面上部には軌跡-負荷情報Ｉ２に従って表示された軌跡（実線）および使用者Ｕが軌跡-負荷情報Ｉ２の軌跡をなぞった際の軌跡（破線）、下部には時間軸を横軸にとったときの、軌跡-負荷情報Ｉ２に従って表示された負荷変動（実線）および使用者Ｕが軌跡-負荷情報Ｉ２の軌跡をなぞった際の負荷変動（破線）が表示されている。表示制御部７６は、ＣＰＵの指示に従って、例えば、Ｓ３２６における肯定判断後に実線と破線との表示の色を変えて表示装置８０に表示させるようにしてもよい。
FIG. 21 schematically shows the screen drawn on the
一方、図１７のＳ３０８で否定判断のときは、Ｓ３２８～Ｓ３４０（受動訓練モード）での処理を実行する。Ｓ３２８～Ｓ３４０での処理は、原則的にＳ３１０～Ｓ３２６（能動訓練モード）での処理と同じである。以下、異なる点について説明する。なお、受動訓練モードでは、力センサ５１が検出するＸ軸およびＹ軸方向の力（Ｆｘ，Ｆｙ）は、Ｘ軸およびＹ軸方向駆動モータ３８，３０の駆動力と使用者Ｕが操作部３に及ぼす力の差分の分力として検出される。
On the other hand, when the determination in S308 of FIG. 17 is negative, the processing in S328 to S340 (passive training mode) is executed. The processing in S328-S340 is basically the same as the processing in S310-S326 (active training mode). The different points will be described below. In the passive training mode, the forces (Fx, Fy) in the X- and Y-axis directions detected by the
まず、能動訓練モードではＳ３１０～Ｓ３１４で調整値情報を取り込んで所定値（静止摩擦エリア９０の半径の値）を算出するのに対し、受動訓練モードでは使用者Ｕが自動的に動く操作部３の動きに追随して運動することが目的のため、調整値は予め定められており上述した所定値は算出されない。このため、受動訓練モードではＳ３１０～Ｓ３１４に対応するステップを欠く。 First, in the active training mode, the adjustment value information is taken in in S310 to S314 to calculate a predetermined value (value of the radius of the static friction area 90). Since the purpose is to follow the movement of the body, the adjustment value is determined in advance, and the predetermined value described above is not calculated. Therefore, the passive training mode lacks steps corresponding to S310 to S314.
また、Ｓ３１６に対応するＳ３２８では、信号情報を監視して操作部３に力（Ｆｘ，Ｆｙ）が作用したか否かを判定することで、受動訓練が開始したか否かを判断する。肯定判断のときは、次のＳ３３０で駆動制御部７２を介してＸ軸およびＹ軸方向駆動モータ３８，３０の駆動を開始し、軌跡-負荷情報Ｉ２を構成する最初の位置（Ｐｘ，Ｐｙ）に操作部３を位置付ける。すなわち、軌跡-位置情報Ｉ２を構成する最初の位置（Ｐｘ，Ｐｙ）とホームポジション（０，０）とのそれぞれＸ軸方向およびＹ軸方向の距離をこの間の移動時間１０［ｍｓ］で割ることで求めた指令速度を駆動制御部７２に出力する。
In addition, in S328 corresponding to S316, it is determined whether passive training has started by monitoring the signal information and determining whether force (Fx, Fy) has acted on the
さらに、Ｓ３２２に対応するＳ３３６の駆動指令処理では、図１９に示すように、図１８のＳ４０２、Ｓ４１４～Ｓ４１８に対応するステップを欠く。この理由も、受動訓練モードでは使用者Ｕが自動的に動く操作部３の動きに追随して運動することが目的のため、操作部３の移動範囲が図１０に示した力覚提示エリアＡｆ内に限られるからである。従って、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードはＰＤ（Ｐ）制御に定められている。
Furthermore, in the drive command process of S336 corresponding to S322, as shown in FIG. 19, steps corresponding to S402 and S414 to S418 of FIG. 18 are omitted. The reason for this is that in the passive training mode, the purpose is for the user U to exercise following the movement of the
また、図１９の駆動指令処理サブルーチンでは、図１８のＳ４０８～Ｓ４１２に代えて、Ｓ４５６で指令速度を算出する。この指令速度は、図１７のＳ３０２で読み出した軌跡-位置情報Ｉ２の位置となるように１０［ｍｓ］ごとに指令速度を算出する。すなわち、軌跡-位置情報Ｉ２の処理対象の現在の位置と軌跡-位置情報Ｉ２の次の位置とのそれぞれＸ軸方向およびＹ軸方向の距離をこの間の移動時間１０［ｍｓ］で割ることで求めた指令速度を駆動制御部７２に出力する。従って、式（１）は用いられない。
Further, in the drive command processing subroutine of FIG. 19, the command speed is calculated in S456 instead of S408 to S412 of FIG. This command speed is calculated every 10 [ms] so that the position of the trajectory-position information I2 read in S302 of FIG. 17 is obtained. That is, the distances in the X-axis direction and the Y-axis direction between the current position to be processed in the trajectory-position information I2 and the next position in the trajectory-position information I2 are divided by the moving time 10 [ms] between them. , is output to the
さらに、Ｓ３４０では、図１６のＳ２１４と同様に、軌跡-負荷情報Ｉ２の最後の位置に操作部３を位置付ける処理を行ったか否かを判定することで、操作部３の移動が終了したか否かを判断する。否定判断のときは受動訓練を続行するためにＳ３３２に戻り、肯定判断のときはＳ３４２に進む。
Furthermore, in S340, similarly to S214 in FIG. 16, it is determined whether or not the
Ｓ３４２ではＸ軸およびＹ軸方向駆動モータ３８，３０の駆動を停止させ、次のＳ３４２において運動訓練データを不揮発性メモリ７４に保存して運動訓練ルーチンを終了する。なお、運動訓練データは、使用者Ｕの上肢状況の参考のため、図１８のＳ４０２、Ｓ４０６、図１９のＳ４５４で否定判断されたときにも保存される。
At S342, the driving of the X-axis and Y-axis direction drive
この運動訓練データには、１０［ｍｓ］ごとに算出した操作部３の位置（Ｐｘ，Ｐｙ）のデータおよび操作部３に作用する力（Ｆｘ，Ｆｙ，Ｆ０）のデータを加えた運動訓練軌跡-負荷情報Ｉ３、能動訓練モードの場合にはさらにＳ３１４で確定した調整値および決定した所定値のデータが含まれる。運動訓練軌跡-負荷情報Ｉ３は、例えば、（Ｐｘ，Ｐｙ，Ｆｘ，Ｆｙ，Ｆ０）で表される１０［ｍｓ］ごとのデータを運動訓練開始時から終了時まで時系列順に並べたデータとなる。
The exercise training data includes data of the position (Px, Py) of the
なお、図１６のＳ２０８（および図１７のＳ３３４）では、図１７のＳ３２０と同様に、信号情報に含まれるエンコーダ３８ａ，３０ａのカウント値から操作部３の実際の速度（ｖｘ，ｖｙ）を算出し、Ｓ２０４では、図１８のＳ４２０と同様に、操作部３の実際の速度（ｖｘ，ｖｙ）および指令速度（ｖｖｘ，ｖｖｙ）を算出するとともに、所定の制御モード（ＰＤ制御またはＰ制御）における出力電流を駆動制御部７２に指令するが、上記では本発明と直接関連しないためその説明を省略した。
16 (and S334 in FIG. 17), similar to S320 in FIG. is calculated , and in S204 , as in S420 of FIG . The output current in the control or P control) is commanded to the
３．効果等
次に、本実施形態の運動訓練装置１の効果等について説明する。
3. Effect etc. Next, the effect etc. of the
３．１．効果
本実施形態の運動訓練装置１では、図１８のＳ４０８で合成力Ｆ０の大きさ｜Ｆ０｜が所定値以下か否かを判断し、所定値以下のときに、Ｓ４１０で式（１）上段により指令速度（ｖｖｘ，ｖｖｙ）を算出する。すなわち、式（１）上段は（式（１）下段と比較して）Ｘ軸およびＹ軸方向駆動モータ３８，３０の駆動量を制限する式として機能する。このため、使用者Ｕが平面運動を行う際に、操作部３が止まっている状態からは一定以上の力を加えないと動かないという静止摩擦を模擬でき、使用者Ｕが操作部３を操作する際の仮想摩擦力を実現することができる。また、使用者Ｕが操作部３を停止させる際にも仮想静止力が働き、操作部３を停止させるときに滑らかに停止するといった違和感も防止できる。
3.1. Effect In the exercise training apparatus 1 of the present embodiment, it is determined in S408 in FIG. 18 whether or not the magnitude | F0 | ) Calculate the command velocity (v vx , v vy ) from the upper stage. That is, the upper part of expression (1) functions as an expression that limits the drive amounts of the X-axis and Y-axis direction drive
また、本実施形態の運動訓練装置１では、図１８のＳ４０８で合成力Ｆ０の大きさ｜Ｆ０｜が所定値より小さいか否かを判断し、大きいときに、Ｓ４１２で式（１）下段により合成力Ｆ０に対応する速度ｖｖを求め、その速度ｖｖをＸ軸およびＹ軸方向の速度ｖｖｘ，ｖｖｙに分解して指令速度（ｖｖｘ，ｖｖｙ）を算出する。このため、式（１）下段により操作部３に作用するＸ軸方向の力ＦｘからＸ軸方向の指令速度ｖｖｘと、操作部３に作用するＹ軸方向の力ＦｘからＹ軸方向の指令速度ｖｖｙとをＸ軸、Ｙ軸独立に算出する場合と比較して、操作部３の斜め方向への移動の際の操作性を向上させることができる（後述する４．試験の比較例１も参照）。
Further, in the
さらに、本実施形態の運動訓練装置１では、仮想モデルＩＭのパラメータを調整可能に構成したので（Ｓ３１０～Ｓ３１４）、使用者Ｕの上肢状況に応じて運動訓練を適切に支援することができる。また、パラメータを入力する際に、運動量や静止摩擦力の大きさに応じた入力（調整値）情報からＣＰＵがパラメータを決定するので、入力作業を容易とすることができる。
Furthermore, the
また、本実施形態の運動訓練装置１では、操作部３が力覚提示エリアＡｆ内にあるときはＰＤ（Ｐ）制御でＸ軸およびＹ軸方向駆動モータ３８，３０を制御する（図１８のＳ４１４、Ｓ４１６、Ｓ４２０）。ＰＩＤ（ＰＩ）制御により位置精度が高まることから、操作部３の仮想質量ｍｖを小さくして訓練負荷を小さく設定した場合でも、力覚提示エリアＡｆ内では操作部３の振動を抑制（制振）できるので、運動訓練装置１の操作部３の操作性の向上を図る（使用者Ｕによる平面運動を快適に支援する）ことができる。
Further, in the
さらに、本実施形態の運動訓練装置１では、操作部３が安全対策エリアＡｓ内にあるときはＰＩＤ（ＰＩ）制御でＸ軸およびＹ軸方向駆動モータ３８，３０を制御する（図１８のＳ４１４、Ｓ４１８、Ｓ４２０）。このため、操作部３が機械的動作限界に衝突することを予防でき使用者Ｕや運動訓練装置１に掛かる負担をなくすことができるとともに、操作部３の可動領域すなわち使用者Ｕの運動訓練領域の広さを適正に確保することができる。
Furthermore, in the
３．２．変形例
なお、本実施形態では、図１８のＳ４０８、Ｓ４１０において、合成力Ｆ０の大きさ｜Ｆ０｜が所定値以下のときに、式（１）上段により指令速度（ｖｖｘ，ｖｖｙ）を実際に算出する例を示したが、本発明はこれに制約されるものではない。例えば、合成力Ｆ０の大きさ｜Ｆ０｜が所定値以下のときに、指令速度（ｖｖｘ，ｖｖｙ）＝（０，０）、すなわちＸ軸およびＹ軸方向駆動モータ３８，３０の駆動量をそれぞれ０（励磁状態）とするようにしてもよい。このような態様でも、使用者Ｕは操作部３を操作する際に仮想摩擦力を違和感なく体感することができる。
3.2. Modification In this embodiment, in S408 and S410 of FIG. 18, when the magnitude | F0 | ) has been shown, but the present invention is not limited to this. For example, when the magnitude of the resultant force F 0 |F 0 | The drive amount may be set to 0 (excited state). Even in such a mode, the user U can feel the virtual frictional force without discomfort when operating the
また、本実施形態では、図１７のＳ３１４で所定値（図１８、Ｓ４０８も参照）を実際に算出する例を示したが、本発明はこれに制限されるものではなく、所定値を予め設定するようにしてもよい。 Also, in the present embodiment, an example of actually calculating the predetermined value (see also FIG. 18 and S408) in S314 of FIG. You may make it
さらに、本実施形態では、摩擦係数μｋをパラメータとした仮想モデルＩＭについて例示したが、摩擦係数μｋを用いない仮想モデルで指令速度（ｖｖｘ，ｖｖｙ）を算出してもよい。そのような仮想モデルは、例えば、下記式で構成することができる。
式（５）上段は、合成力Ｆ０が静止摩擦エリア９０内にあるときの操作部３の指令速度ｖｖｘ，ｖｖｙ）の計算式となり、下段は合成力Ｆ０が静止摩擦エリア９０外にあるときの操作部３の指令速度（ｖｖｘ，ｖｖｙ）の計算式となる。なお、式（５）～（７）のパラメータは仮想モデルＩＭの場合と同じである。
The upper part of equation (5) is a formula for calculating the command velocity v vx , v vy of the
また、本実施形態では、図１８のＳ４１４、Ｓ４１６において、操作部３の位置（Ｐｘ，Ｐｙ）が力覚提示エリアＡｆ内か否かを判断し、力覚提示エリアＡｆ内のときに、Ｘ軸およびＹ軸方向駆動モータ３８，３０をＰＤ（Ｐ）制御に決定する例を示したが、本発明はこれに制約されるものではない。例えば、操作部３の位置（Ｐｘ，Ｐｙ）が力覚提示エリアＡｆ内のときに、操作部３の仮想質量ｍｖが予め設定された第２の閾値（例えば、５［ｋｇ］）以上か否かを判断し、肯定判断のときは、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードをＰＩＤ（ＰＩ）制御とし、否定判断のとき、すなわち、仮想質量ｍｖが、第１の閾値（例えば４［ｋｇ］、Ｓ３１４の説明参照）≦（仮想質量ｍｖ）＜第２の閾値の範囲にあるときは、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードをＰＤ（Ｐ）制御とするようにしてもよい。このような態様でも、本実施形態と同様に、力覚提示エリアＡｆ内での操作部３の振動を抑制することができる。
Further, in the present embodiment, in S414 and S416 of FIG. 18, it is determined whether or not the position (Px, Py) of the
さらに、本実施形態では、力覚提示エリアＡｆにおける操作部３の振動を抑制するために、Ｘ軸およびＹ軸方向駆動モータ３８，３０の双方をＰＤ（Ｐ）制御する例を示したが、本発明はこれに限定されず、Ｘ軸およびＹ軸方向駆動モータ３８，３０のいずれか一方（例えば、Ｙ軸方向駆動モータ３８）のみをＰＤ（Ｐ）制御し、いずれか他方をＰＩＤ（ＰＩ）制御するようにしてもよい。同様に、安全対策エリアＡｓにおいて、Ｘ軸およびＹ軸方向駆動モータ３８，３０のいずれか一方（例えば、Ｙ軸方向駆動モータ３８）のみをＰＩＤ（ＰＩ）制御し、いずれか他方をＰＤ（Ｐ）制御するようにしてもよい。
Furthermore, in the present embodiment, an example of PD (P) control of both the X-axis and Y-axis direction drive
また、本実施形態では、力センサ５１に市販の歪みゲージを用いた６軸力覚センサを用いる例を示したが、本発明はこれに限らず、２軸または３軸力覚センサや、歪みゲージに代えて、例えば、静電容量式や光学式のものを用いるようにしてもよい。またさらに、本実施形態では、Ｆｘ，Ｆｙのみを用いることから、それに応じて歪み－荷重変換行列式を簡素化するようにしてもよい。また、本実施形態では、Ｆｘ，Ｆｙのみを用いる例を示したが、操作部３に作用するＺ軸方向の力Ｆｚを、図１７のＳ３１６、Ｓ３２８において、上述した信号情報を監視して操作部３に力Ｆｚが作用したか否かを判定することで、能動訓練や受動訓練が開始したか否かを判断するようにしてもよい。
Further, in this embodiment, an example of using a 6-axis force sensor using a commercially available strain gauge as the
さらに、本実施形態では、図２０、図２１に示したように、表示装置８０に時間軸に対する負荷変動を表示する例を示したが、時間軸のない、方向と大きさを同時に示すレーダチャートで表示するようにしてもよい。図２２はそのようなレーダチャートの一例を示したものである。図２２の例では、Ｘ軸およびＹ軸が交差する原点を基準に負荷（合成力Ｆ０）の方向と大きさとを示している。また、点ｐ、ｑは軌跡-負荷情報Ｉ２の負荷から外れたときの負荷を示している。このようなレーダチャートを用いると、訓練時間が長くなっても時間軸をスクロールさせる必要なくなる。また、操作部３に作用する力の方向と大きさを同時に表示できるため、所定の軌跡でどの方向にどれくらいの負荷が掛かっているかを確認することができる。なお、図２０、図２１に示した例でも、合成力Ｆ０の絶対値｜Ｆ０｜ではなく、正負情報を含む合成力Ｆ０で表示するようにしてもよい。
Furthermore, in the present embodiment, as shown in FIGS. 20 and 21, an example of displaying load fluctuations with respect to the time axis on the
また、本実施形態では、図１５のＳ１１０、図１６のＳ２１６、図１７のＳ３４４で情報／データを一律に不揮発性メモリ３４２に保存する例を示したが、制御部７０は通信制御部７８を有していることから外部装置に情報／データを送信してもよく、また、例えば、軌跡設定ルーチンに続いて負荷検出ルーチンを続行する場合には軌跡設定ルーチンで取得した軌跡情報Ｉ１がＭＣＵ７１のワークエリア内に一時的に格納されおり負荷検出ルーチンでその軌跡情報Ｉ１を用いるようにしてもよいことから、保存するか否かを問い合わせた上で不揮発性メモリ７４に保存するようにしてもよい。
15, S216 in FIG. 16, and S344 in FIG. Information/data may be transmitted to an external device, and, for example, when continuing the load detection routine following the trajectory setting routine, the trajectory information I1 acquired in the trajectory setting routine is sent to the
また、本実施形態では、図９に示した位置をホームポジションとした例を示したが、本発明はこれに制限されるものではない。例えば、入力された操作者Ｕの利き手の別に応じてＣＰＵがホームポジションの位置を変えるようにしてもよい。 Further, in the present embodiment, the position shown in FIG. 9 is used as the home position, but the present invention is not limited to this. For example, the CPU may change the position of the home position according to whether the dominant hand of the operator U is inputted.
さらに、運動訓練装置１は、運動訓練モードの内容を再現するための再現モードを有するようにしてもよい。再現モードでは、例えば、図１７のＳ３０２において、不揮発性メモリ７４に保存された運動訓練軌跡-負荷情報Ｉ３、さらに能動訓練モードの場合には既に確定／決定された調整値および所定値のデータを読み出し、Ｓ３０４～Ｓ３１４までの処理を行わないようにすればよい。
Furthermore, the
また、再現モードでは、運動訓練の内容の一部を再現するようにしてよい。例えば、表示装置８０に図２１に示した軌跡や負荷変動を表示しその一部を選択させ、その選択した部分だけの運動訓練の内容を再現するようにしてもよい。訓練指導者は、使用者Ｕがどの移動範囲で上肢を動かし難かったり、力が入りにくかったりするかを確認することができ、使用者Ｕに合わせた運動訓練プログラムを作成することができる。
Also, in the reproduction mode, part of the content of the exercise training may be reproduced. For example, the trajectory and load fluctuations shown in FIG. 21 may be displayed on the
さらに、本実施形態では、ＭＣＵ７１のＲＡＭをワークエリアとしてすべてのデータを処理する例を示したが、必要に応じて処理データを暫定的に格納するバッファメモリをＭＣＵ７１の外部バスに接続するようにしてもよい。また、本実施形態では、入力装置７９と表示装置８０とを個別に設ける例を示したが、タッチパネル等を用いることによりこれらを一体化するようにしてもよい。この場合には、入力制御部７５と表示制御部７６も一体化される。
Furthermore, in the present embodiment, an example in which all data is processed using the RAM of the
さらに、本実施形態では、信号処理部７３の信号処理ＩＣが歪み－荷重変換行列演算を行って（Ｆｘ，Ｆｙ，Ｆｚ，Ｔｘ，Ｔｙ，Ｔｚ）を算出する例を示したが、ＣＰＵが行うようにしてもよい。このような態様では、信号処理部７３はＡ／Ｄコンバータを介して上述した外部バスに接続される。
Furthermore, in the present embodiment, the signal processing IC of the
またさらに、本実施形態では、円形の軌跡を辿る例を示したが、本発明はこれに制約されず、例えば、三角形等の多角形や、ローマ字等の軌跡を辿るようにしてもよい。さらに、本実施形態では、軌跡設定ルーチンで実際に操作部３を移動させ、各位置の値を軌跡情報Ｉ１とした例を示したが、予めデータ化された全体軌跡を予め入力しておき、使用者Ｕが軌跡設定モードを選択したときに、表示装置８０に参照軌跡として表示するようにしてもよい。この点は、負荷検出ルーチンや運動訓練ルーチンについても同じである。また、予め基本パターンを複数とおり不揮発性メモリ７４に保存しておき、使用者Ｕに応じて一つの基本パターンを選択するようにしてもよい。またさらに、本実施形態では、リハビリ中の人を想定して軌跡設定モード、負荷検出モードを経て運動訓練モードを実施する例を示したが、健常者の場合には、直ちに運動訓練モードを実施するようにしてもよい。その際、表示装置８０に上記の参照軌跡を表示することが望ましい。
Furthermore, in this embodiment, an example of tracing a circular trajectory has been shown, but the present invention is not limited to this, and for example, a polygonal trajectory such as a triangle, or a trajectory such as Roman letters may be traced. Furthermore, in the present embodiment, the
さらに、本実施形態では、緊急停止ボタン１０ａが押下されたときにＸ軸およびＹ軸方向駆動モータ３８，３０を停止させる例を示したが、さらに安全性を高めるために、不図示の電源部と駆動制御部７２の間にスイッチング素子を挿入し、ＣＰＵは緊急停止ボタン１０ａの状態のデフォルト値が緊急停止ボタン１０ａが押下されたことを表すときに、当該スイッチング素子をオフ状態とするようにしてもよい。
Furthermore, in this embodiment, the X-axis and Y-axis direction drive
また、本実施形態では、カバー４にベローズ状シートを例示したが、これに代えて、例えば樹脂または布製の比較的柔軟なシートで構成し、装置本体２の前後左右各側縁部の内側に配置されたロール機構に、巻取方向に付勢するばね構造によって巻取・引出自在に収容するようにしてもよい。この種のロール機構は、従来、車両や建物の窓を覆うスクリーン等に広く採用されている。また、カバー４の構造には、蛇腹構造やロール機構に限らず、従来公知の種々のものを用いることができる。
In this embodiment, the
さらに、本実施形態では、Ｙ軸方向アクチュエータ２１をＸ軸方向アクチュエータ２２の上に配置する例を示したが、本発明はこれに限らず、両者を位置関係を逆にしても、または、構造を異ならせ同一面に配置するようにしてもよい。さらにまた、本実施形態では、ケーシング６の補強構造として左右補強部材１４ａ，１４ｂと前後補強部材１３ａ～１３ｃとが一体化した例を示したが、左右補強部材１４ａ，１４ｂと前後補強部材１３ａ～１３ｃとは、一体化しなくてもよく、また上下方向に離隔していてもよい。
Furthermore, in this embodiment, an example in which the Y-axis direction actuator 21 is arranged above the X-axis direction actuator 22 is shown, but the present invention is not limited to this, and the positional relationship between the two may be reversed, or the structure may be changed. may be different and arranged on the same plane. Furthermore, in the present embodiment, an example in which the left and right reinforcing
また、本実施形態では、Ｘ軸およびＹ軸方向駆動モータ３８，３０の停止時に減速ギアユニット３９，３１のギア比によりモータ軸の回転を防止し操作部３の移動を防止する構造を示したが、例えば、Ｘ軸およびＹ軸方向駆動モータ３８，３０への電力供給停止時に、その回転を停止させかつ保持するように、電磁ブレーキ等を設けるようにしてもよい。
Further, in the present embodiment, a structure is shown in which rotation of the motor shaft is prevented by the gear ratio of the
さらに、本実施形態では、ハンドル部材４９が操作ロッド４８に取り付けられた例を示したが、本発明はこれに制限されず、ハンドル部材４９が操作ロッド４８に対して着脱自在に装着されるようにしてもよい。このような態様では、ハンドル部材４９は、運動訓練装置１の使用目的、使用者Ｕの状態等に対応して、使用者Ｕの上肢または下肢との係合に適した様々な部材と交換することができる。例えば、使用者の手がハンドル部材４９をうまく掴むことができない場合には、その手（または上肢）を固定するベルト付きの部材を用いるようにしてもよい。これにより、使用者Ｕの手（または上肢）から操作ロッド４８に力を伝達して操作部３を移動させ、または移動する操作部３から操作ロッド４８を介して力を受けて手（または上肢）を動かすことができる。また、使用者Ｕの下肢を訓練する場合には、同様にハンドル部材４９に代えて、使用者の足を載せる台や足を固定するベルト付きの部材を用いるようにしてもよい。
Furthermore, in this embodiment, an example in which the
またさらに、本実施形態では、運動訓練装置１を略水平に載置して使用する例を示したが、例えばサンディング訓練を行うために、装置本体２を前後方向または左右方向に傾斜させた状態で使用するようにしてもよい。その際、運動訓練装置１は、その傾斜状態、すなわち傾斜方向および傾斜角度を検出するための傾斜センサ８７（図２参照）を有していてもよい。このような傾斜センサ８７には、例えばジャイロセンサを用いることができるが、これに限るものではない。このような態様では、運動訓練装置１は、例えば、傾斜角度を調整可能な別個の支持構造上に設置され、傾斜センサ７７の出力信号は制御部７０に入力され、運動訓練装置１の傾斜方向および傾斜角度の大きさに対応して、Ｘ軸およびＹ軸方向駆動モータ３８，３０の少なくとも一方の出力を制御するために使用される。
Furthermore, in the present embodiment, an example in which the
そして、本実施形態では、力覚提示エリアＡｆや安全対策エリアＡｓの寸法、処理周期、Ｆｘ，Ｆｙの最大値、最大加速度、最大速度、閾値等を具体的な数値で示したが、本発明はこれらに限定されるものではなく、任意の数値を用いることができることは論を待たない。 In this embodiment, the dimensions of the haptic presentation area Af and the safety measure area As, the processing period, the maximum values of Fx and Fy, the maximum acceleration, the maximum velocity, the threshold value, etc. are indicated by specific numerical values. is not limited to these, and it goes without saying that any numerical value can be used.
４．試験
次に、実施形態の運動訓練装置１を用いて行った試験について説明する。
4. Test Next, a test performed using the
４．１．試験内容
本試験では、上述した能動訓練モードで被験者が表示装置８０に表示された半径０．１０７ｍの円（参照軌跡）をなぞるように運動訓練装置１の操作部３を操作するものとした。なお、被験者として２０代男性の健常者４名に事前に試験内容を説明し、インフォームドコンセントを取得した上で行った。
4.1. Test Details In this test, the subject operated the
試験では、仮想モデルＩＭのパラメータおよびＸ軸およびＹ軸方向駆動モータ３８，３０の制御モードを下表１のように設定した。
すなわち、実施例では、仮想モデルＩＭで用いられるパラメータを、操作部３の仮想質量ｍｖ：５［ｋｇ］、粘性減衰係数ｃｖ：２０［ｋｇ／ｓ］、最大静止摩擦力μｓ：３［Ｎ］、摩擦係数μｋ：２［Ｎ］に設定し、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードをＰ制御（Ｋｐ＝３×１０４）とした。
That is, in the embodiment, the parameters used in the virtual model IM are the virtual mass m v of the operation unit 3: 5 [kg], the viscous damping coefficient c v : 20 [kg/s], the maximum static friction force μ s : 3 [N], the friction coefficient μ k : 2 [N], and the control mode of the X-axis and Y-axis direction drive
一方、比較例１では、Ｘ軸、Ｙ軸独立に構成され各軸に不感帯と粘性抵抗を模擬した仮想モデルを用い操作部３の仮想質量ｍｖ：５［ｋｇ］、不感帯：１［Ｎ］、粘性減衰係数ｃｖ：２０［ｋｇ／ｓ］に設定し、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードをＰＩＤ制御とした。ちなみに、比較例１のように各軸独立に不感帯と粘性抵抗を模擬した仮想モデルを用いる場合には、操作部３の仮想質量ｍｖを５［ｋｇ］より小さくすると操作中に操作部３が振動的になり操作が困難となることが確認されている。従って、比較例１に示したパラメータが各軸独立に不感帯と粘性抵抗を模擬した仮想モデルにおける訓練負荷の最小のものとなる。
On the other hand, in Comparative Example 1, a virtual model that simulates a dead zone and viscous resistance on each axis, which is configured independently on the X axis and the Y axis, is used. , the viscous damping coefficient c v : 20 [kg/s], and the control mode of the X-axis and Y-axis direction drive
また、比較例２では、訓練負荷を最小とするために、仮想モデルＩＭで用いられたパラメータを、操作部３の仮想質量ｍｖ：２［ｋｇ］、粘性減衰係数ｃｖ：１０［ｋｇ／ｓ］、最大静止摩擦力μｓ：３［Ｎ］、摩擦係数μｋ：２［Ｎ］に設定し、Ｘ軸およびＹ軸方向駆動モータ３８，３０の制御モードをＰ制御（Ｋｐ＝３×１０４）とした。
In Comparative Example 2, in order to minimize the training load, the parameters used in the virtual model IM are set to virtual mass mv of the operation unit 3: 2 [kg], viscous damping coefficient cv : 10 [kg/ s], the maximum static friction force μ s : 3 [N], the friction coefficient μ k : 2 [N], and the control mode of the X-axis and Y-axis direction drive
４．２．試験結果
次に、本試験の試験結果を図２３～図２８に示す。図２３～図２８は４名の被検者のうち１名の被検者の試験結果を示したものであり、図２３、図２４は実施例１、図２５、図２６は比較例１、図２７、図２８は比較例２の試験結果である。図２３、図２５、図２７の左側のグラフはＸ軸に関する試験結果、右側のグラフはＹ軸に関する試験結果である。上段のグラフは操作部３に作用する力、中段は操作部３の速度、下段は操作部３の位置を示を示す。また、図２４、図２６、図２８は、実線が操作部３の軌跡であり、破線は操作者Ｕが操作中に参照した参照軌跡である。
4.2. Test Results Next, the test results of this test are shown in FIGS. 23 to 28. FIG. 23 to 28 show the test results of one subject out of four subjects, FIGS. 23 and 24 are Example 1, FIGS. 27 and 28 are test results of Comparative Example 2. FIG. 23, 25, and 27 are the test results on the X-axis, and the right-hand graphs are the test results on the Y axis. The upper graph shows the force acting on the
４．３．評価
図２５および図２６に示すように、各軸独立に構成され軸ごとに不感帯と粘性抵抗を模擬した仮想モデルを用いた比較例１の試験結果では、斜め方向の操作に対して不感帯による反力が増大してしまうことから、直線的な操作部３の軌跡となっていることが確認できる。これに対し、図２３および図２４に示すように、平面運動における静止摩擦を模擬した仮想モデルＩＭを用いた実施例の試験結果では、仮想摩擦力が運動方向に対して与えられているため、実際のワイピング訓練に近い状態となり、より円に近い軌跡が描かれている。また、操作部３に作用する力の大きさは実施例、比較例１ともに４［Ｎ］程度であったが、操作部３の速度は平面運動における静止摩擦を模擬した仮想モデルＩＭを用いた実施例の方が若干抑えられており、スムーズな操作が行われたことが確認できる。さらに、図２７および図２８に示すように、訓練負荷を最小とした比較例２の試験結果では、操作部３の速度が増大して円軌跡を精度良く描くことが困難になっていることが確認できる。
4.3. Evaluation As shown in FIGS. 25 and 26, in the test results of Comparative Example 1 using a virtual model configured independently for each axis and simulating the dead zone and viscous resistance for each axis, the reaction due to the dead zone against the operation in the oblique direction was observed. Since the force increases, it can be confirmed that the trajectory of the
また、試験後に被験者へアンケート調査を行った結果、３名の被験者が平面運動における静止摩擦を模擬した仮想モデルＩＭを用いた実施例が最も操作しやすく、訓練負荷を最小とした比較例２が操作しにくいとの回答を得た。 In addition, as a result of conducting a questionnaire survey to the subjects after the test, the example using the virtual model IM that simulated static friction in planar motion was the easiest for three subjects to operate, and the comparative example 2, which minimized the training load. I got the answer that it is difficult to operate.
以上の結果から、平面運動における静止摩擦を模擬した仮想モデルＩＭを用いた実施例が、ワイピング訓練等の平面運動に対して高臨場感を創出し、良好な操作性が得られることが確認できた。また、仮想質量ｍｖ等のパラメータ（調整値）を変更することで自在に訓練負荷を調整できることも確認できた。一方で、訓練負荷を過小にすると操作性が損なわれることも確認された。 From the above results, it can be confirmed that the embodiment using the virtual model IM, which simulates static friction in planar motion, creates a high sense of realism in planar motion such as wiping training, and obtains good operability. rice field. It was also confirmed that the training load can be freely adjusted by changing the parameters (adjustment values) such as the virtual mass mv . On the other hand, it was also confirmed that operability is impaired if the training load is too small.
以上述べたとおり、本発明は、使用者よる平面運動を快適に支援するとともに、使用者の運動訓練領域を適正に確保可能な運動訓練装置を提供するものであるため、運動訓練装置の製造、販売に寄与するので、産業上の利用可能性を有する。 As described above, the present invention provides an exercise training device that comfortably supports a user's planar exercise and can appropriately secure an exercise training area for the user. Since it contributes to sales, it has industrial applicability.
１ 運動訓練装置
３ 操作部
２０ アクチュエータ機構（駆動部）
３０ Ｙ軸方向駆動モータ
３０ａ エンコーダ（位置検出手段の一部、駆動量検出手段の一部）
３８ Ｘ軸方向駆動モータ
３８ａ エンコーダ（位置検出手段の一部、駆動量検出手段の一部）
５１ 力センサ
７０ 制御部
Ａｆ 力覚提示エリア（第１の領域）
Ａｓ 安全対策エリア（第２の領域）
1
30 Y-axis direction drive
38 X-axis direction drive
51
As Safety measure area (second area)
Claims (8)
Ｘ軸方向駆動モータおよびＹ軸方向駆動モータを有し前記操作部をＸＹ平面で駆動する駆動部と、
前記操作部に作用するＸ軸方向の力およびＹ軸方向の力を検出する力センサと、
前記操作部の位置を検出する位置検出手段と、
前記力センサで検出された前記Ｘ軸方向の力および前記Ｙ軸方向の力に基づいて前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータを制御する制御部と、を備え、
前記制御部は、
前記位置検出手段で検出された前記操作部が、前記操作部が移動可能なＸＹ平面での中心部を含む第１の領域に位置する場合に、前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータの少なくとも一方をＰＤ制御またはＰ制御で制御し、
前記位置検出手段で検出された前記操作部が、前記第１の領域の外側に形成され前記操作部が移動可能な第２の領域に位置する場合に、前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータをＰＩＤ制御またはＰＩ制御で 制御する、
ことを特徴とする運動訓練装置。 an operation unit movable on the XY plane;
X-axisdirectional drive motorand a drive unit having a Y-axis direction drive motor and driving the operation unit on the XY plane;
X-axis acting on the operating partforce of directionand a force sensor that detects the force in the Y-axis direction;
position detection means for detecting the position of the operation unit;
detected by the force sensorSaidX-axisforce of directionandSaidBased on the force in the Y-axis direction, the X-axisdirectional drive motorandSaida control unit that controls the Y-axis direction drive motor,
The control unit
SaidpositionThe operation part detected by the detection meansis positioned in a first region including the center of the movable XY plane of the operation unit, at least one of the X-axis direction drive motor and the Y-axis direction drive motor is controlled by PD control or P control. control and
When the operating portion detected by the position detecting means is located in a second region formed outside the first region in which the operating portion can move, the X-axis direction driving motor and the Y-axis Directional drive motor with PID control or PI control Control,
An exercise training device characterized by:
前記制御部は、
前記操作部に発生させるべきＸ軸方向の速度およびＹ軸方向の速度を、 前記設定手段で設定された前記操作部の仮想質量と前記力センサで検出された前記Ｘ軸方向の力および前記Ｙ軸方向の力と前記操作部に発生させるべき前記Ｘ軸方向の速度および前記Ｙ軸方向の速度との関係を予め定めた関係式により算出し、前記操作部が前記算出した速度となるように前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータを制御する、
ことを特徴とする請求項１に記載の運動訓練装置。 moreover, A setting means for setting the virtual mass of the operation unit based on the input information,
The control unit
The speed in the X-axis direction and the speed in the Y-axis direction to be generated in the operation unit are The virtual mass of the operation unit set by the setting means and the virtual mass detected by the force sensorSaidX-axisforce of directionandSaidThe force in the Y-axis direction and the force to be generated in the operation partSaidX-axisdirection speedandSaidThe relationship with the speed in the Y-axis direction is determined by a predetermined relational expression.subtractionand move the X-axis so that the operation unit reaches the calculated speed.directional drive motorandSaidControl the Y-axis drive motor,
A claim characterized by1Exercise training device according to.
前記制御部は、前記操作部が前記第１の領域に位置する場合に、前記設定手段で設定された前記操作部の仮想質量が前記第１の閾値より値の大きい第２の閾値以上か否かを判断し、肯定判断の場合に前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータの少なくとも一方をＰＩＤ制御またはＰＩ制御で制御し、否定判断の場合に前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータをＰＤ制御またはＰ制御で制御することを特徴とする請求項２に記載の運動訓練装置。 The setting means sets the virtual mass of the operation unit to be equal to or greater than a preset first threshold,
The control unit determines whether the virtual mass of the operation unit set by the setting unit is equal to or greater than a second threshold value larger than the first threshold value when the operation unit is positioned in the first region. If the determination is affirmative, at least one of the X-axis direction driving motor and the Y-axis direction driving motor is controlled by PID control or PI control. 3. The exercise training device according to claim 2 , wherein the axial drive motor is controlled by PD control or P control.
前記制御部は、前記駆動量検出手段で検出された前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータの駆動量が前記算出された前記操作部に発生させるべき前記Ｘ軸方向の速度および前記Ｙ軸方向の速度に対応する駆動量となるように前記Ｘ軸方向駆動モータおよび前記Ｙ軸方向駆動モータを制御することを特徴とする請求項２または請求項３に記載の運動訓練装置。 further comprising drive amount detection means for detecting drive amounts of the X-axis direction drive motor and the Y-axis direction drive motor;
The control unit controls the X-axis direction speed and the X -axis direction speed to be generated in the operation unit, and the drive amounts of the X-axis direction drive motor and the Y-axis direction drive motor detected by the drive amount detection means. 4. The exercise training apparatus according to claim 2 , wherein the X-axis direction driving motor and the Y-axis direction driving motor are controlled so as to provide a drive amount corresponding to the speed in the Y-axis direction.
駆動モータを有し前記操作部を前記所定方向に駆動する駆動部と、 a drive unit having a drive motor and driving the operation unit in the predetermined direction;
前記操作部に作用する前記所定方向の力を検出する力センサと、 a force sensor that detects a force acting on the operating portion in the predetermined direction;
前記操作部の位置を検出する位置検出手段と、 position detection means for detecting the position of the operating portion;
前記力センサで検出された前記所定方向の力に基づいて前記駆動モータを制御する制御部と、を備え、 a control unit that controls the drive motor based on the force in the predetermined direction detected by the force sensor;
前記制御部は、 The control unit
前記位置検出手段で検出された前記操作部が、前記操作部が往復移動可能な領域の中心部を含む第１の領域に位置する場合に、前記駆動モータをＰＤ制御またはＰ制御で制御し、 controlling the driving motor by PD control or P control when the operating portion detected by the position detecting means is positioned in a first region including a center portion of a region in which the operating portion can be reciprocated;
前記位置検出手段で検出された前記操作部が、前記第１の領域の外側に形成され前記操作部が移動可能な第２の領域に位置する場合に、前記駆動モータをＰＩＤ制御またはＰＩ制御で制御する、 When the operating portion detected by the position detecting means is positioned outside the first region in a second region in which the operating portion can move, the drive motor is controlled by PID control or PI control. Control,
ことを特徴とする運動訓練装置。An exercise training device characterized by:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018229725A JP7157980B2 (en) | 2018-12-07 | 2018-12-07 | exercise training device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018229725A JP7157980B2 (en) | 2018-12-07 | 2018-12-07 | exercise training device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020089623A JP2020089623A (en) | 2020-06-11 |
| JP7157980B2 true JP7157980B2 (en) | 2022-10-21 |
Family
ID=71012001
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018229725A Active JP7157980B2 (en) | 2018-12-07 | 2018-12-07 | exercise training device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7157980B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2022175862A (en) * | 2021-05-14 | 2022-11-25 | キヤノンファインテックニスカ株式会社 | Motion training system and program |
| JP2022175863A (en) * | 2021-05-14 | 2022-11-25 | キヤノンファインテックニスカ株式会社 | Motion training system and program |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2009119810A1 (en) | 2008-03-28 | 2009-10-01 | Thk株式会社 | Servo motor position control device |
| JP2016083313A (en) | 2014-10-29 | 2016-05-19 | 村田機械株式会社 | Training device |
-
2018
- 2018-12-07 JP JP2018229725A patent/JP7157980B2/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2009119810A1 (en) | 2008-03-28 | 2009-10-01 | Thk株式会社 | Servo motor position control device |
| JP2016083313A (en) | 2014-10-29 | 2016-05-19 | 村田機械株式会社 | Training device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2020089623A (en) | 2020-06-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104972466B (en) | Robot control device for controlling robot moved according to applied force | |
| JP5428965B2 (en) | Display device, display control method, program, and computer-readable recording medium | |
| WO2013038544A1 (en) | Robotic system and robot controller | |
| US20200215691A1 (en) | Remote control manipulator system and control device | |
| JP7157980B2 (en) | exercise training device | |
| CN107088878B (en) | Simulation device for robot for calculating scanning space | |
| WO2014080621A1 (en) | Arm control device, control method, and control program; robot; and arm-controlling integrated electronic circuit | |
| JP7209282B2 (en) | exercise training device | |
| JP7157979B2 (en) | exercise training device | |
| JP7209281B2 (en) | exercise training device | |
| US20220175606A1 (en) | Motion training apparatus | |
| JP2018128986A (en) | Path correction method and control device of multi-axis processing machine | |
| JP2005154047A (en) | Power assist device | |
| JP2003245881A (en) | Apparatus and method for controlling robot | |
| JP2007033563A (en) | Driving simulation test system | |
| US5754433A (en) | Computer-aided design system | |
| JP2022088771A (en) | Exercise training device | |
| JP7004549B2 (en) | Exercise training device | |
| Hasunuma et al. | Development of teleoperation master system with a kinesthetic sensation of presence | |
| JP7071820B2 (en) | Exercise training device | |
| Poitrimol et al. | Haptic interface for virtual reality based on hybrid Cable-Driven parallel robot | |
| JP6990823B2 (en) | Exercise training device | |
| CN109062408B (en) | Flexible object surface tactile feedback device | |
| JP6974812B2 (en) | Exercise training device | |
| EP4017690A1 (en) | Head movement control of a viewing system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20190422 |
|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20190425 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190611 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210831 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220620 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220624 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220810 |
|
| 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: 20220902 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220930 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7157980 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |