JP2005118466A5 - - Google Patents

Claims (7)

1. 肢体に装着して前記肢体を動かす駆動部を備え、前記駆動部に取り付けられた位置・角度センサのセンシング情報をもとに、力制御または位置制御によって前記駆動部の動作を制御する肢体駆動装置において、
   前記駆動部の先端が予め設定された軌道に沿って動作するように、動作指令を生成する目標軌道設定部と、
   前記目標軌道設定部の出力から前記軌道の接線方向を算出し接線座標系を導出する接線座標系生成手段と、
   前記接線座標系をもとに、前記軌道の接線方向については、法線方向に比べて柔軟に倣うように力制御の制御座標系を制御する力方向制御手段と、
   前記位置・角度センサのセンシング情報と前記目標軌道設定部の出力と前記力方向制御手段の出力とに基づいて治療状態を提示する治療状態提示手段と
   を備えたことを特徴とする肢体駆動装置。
2. 前記力方向制御手段は、前記軌道の接線方向の制限力と法線方向の制限力と前記軌道の接線方向および法線方向に対し共に垂直な方向の制限力とを各要素にもつ制限力ベクトルと、前記接線座標系と、前記肢体駆動装置の基準座標系とから座標変換行列を算出し、前記制限力ベクトルと前記座標変換行列とヤコビ行列との積から前記駆動部の制限トルクを算出し、トルクを制限することを特徴とする請求項１記載の肢体駆動装置。
3. 前記接線座標系生成手段は、前記目標軌道設定部の出力と前記駆動部の位置情報とから、前記駆動部先端の現在位置に最も近い前記目標軌道設定部の出力（目標点）を選択し、前記目標点を基に前記軌道の接線方向を算出し前記接線座標系を導出することを特徴とする請求項１乃至２記載の肢体駆動装置。
4. 前記接線座標系生成手段は、前記目標軌道設定部の出力と前記駆動部の位置情報とから、前記駆動部先端の現在位置に最も近い前記目標軌道設定部の出力（目標点）を選択し、その間の距離が予め定めた規定値以上の場合は、警告情報を前記治療状態提示手段に出力することを特徴とする請求項１乃至３記載の肢体駆動装置。
5. 前記治療状態提示手段は、複数回の前記肢体動作サイクルに渡る治療状態を同時に提示することを特徴とする請求項１乃至４記載の肢体駆動装置。
6. 前記目標軌道設定部は、前記目標点と前記駆動部先端の現在位置との間の距離が予め定めた第１の閾値よりも大きい場合は、前記駆動部先端の動作方向が前記目標点と逆方向になるように動作指令を生成することを特徴とする請求項１乃至５記載の肢体駆動装置。
7. 前記目標軌道設定部は、前記目標点と前記駆動部先端の現在位置との間の距離の時間変化が予め定めた第２の閾値よりも大きい場合は、動作指令を停止することを特徴とする請求項１乃至６記載の肢体駆動装置。