JP6930328B2 - Seating motion assist device - Google Patents

Seating motion assist device Download PDF

Info

Publication number
JP6930328B2
JP6930328B2 JP2017181091A JP2017181091A JP6930328B2 JP 6930328 B2 JP6930328 B2 JP 6930328B2 JP 2017181091 A JP2017181091 A JP 2017181091A JP 2017181091 A JP2017181091 A JP 2017181091A JP 6930328 B2 JP6930328 B2 JP 6930328B2
Authority
JP
Japan
Prior art keywords
angle
control
θcur
deviation
link
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2017181091A
Other languages
Japanese (ja)
Other versions
JP2019055016A (en
Inventor
大河 松本
大河 松本
宏史 嶋田
宏史 嶋田
今井田 昌幸
昌幸 今井田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2017181091A priority Critical patent/JP6930328B2/en
Publication of JP2019055016A publication Critical patent/JP2019055016A/en
Application granted granted Critical
Publication of JP6930328B2 publication Critical patent/JP6930328B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Rehabilitation Tools (AREA)

Description

本発明は、着座動作補助装置に関するものであり、例えば、利用者の着座動作を補助する着座動作補助装置に関する。 The present invention relates to a seating motion assisting device, and for example, relates to a sitting motion assisting device that assists a user in a sitting motion.

特許文献1には、利用者の少なくとも一方の脚に装着され、当該利用者の着座動作を補助する着座動作補助装置が開示されている。特許文献1の着座動作補助装置は、利用者の一方の脚の大腿に装着される第1のリンクと、第1のリンクとピッチ軸周りに伸展状態から屈曲状態まで回転可能に連結され、脚の下肢に装着される第2のリンクと、第1のリンクに対して第2のリンクをピッチ軸周りに相対的に回転駆動する駆動部と、駆動部を制御する制御部を備えている。そして、制御部は、利用者が着座動作を開始した際に、第2のリンクに対する第1のリンクのピッチ軸周りの角度が予め定めた所定の角度よりも大きい間は、当該角度が小さくなるように駆動部を制御する角度制御を実行し、ピッチ軸周りの角度が所定角度以下の間は、ダンパ制御を実行している。 Patent Document 1 discloses a seating motion assisting device that is attached to at least one leg of a user and assists the sitting motion of the user. The seating motion assisting device of Patent Document 1 is rotatably connected to the first link attached to the thigh of one leg of the user and the first link around the pitch axis from the extended state to the bent state, and the leg. It includes a second link attached to the lower limbs, a drive unit that drives the second link to rotate relative to the first link around the pitch axis, and a control unit that controls the drive unit. Then, when the user starts the seating operation, the control unit reduces the angle of the first link with respect to the second link as long as the angle around the pitch axis is larger than a predetermined angle. The angle control for controlling the drive unit is executed as described above, and the damper control is executed while the angle around the pitch axis is equal to or less than a predetermined angle.

特許第5741375号公報Japanese Patent No. 5741375

角度制御期間において、例えば、利用者の体重が想定以上である場合や、利用者が勢いをつけて着座しようとした場合に、実際の角度がダンパ制御開始角度に至ったタイミングにおいて、既に勢いがつき、ダンパ制御が実行されたとしても、利用者を十分にゆっくりした速度で着座させることが困難になる場合がある。 In the angle control period, for example, when the weight of the user is more than expected, or when the user tries to sit with momentum, the momentum has already reached the timing when the actual angle reaches the damper control start angle. Even if the damper control is executed, it may be difficult to seat the user at a sufficiently slow speed.

本発明は、このような問題を解決するためになされたものであり、ダンパ制御による効果が低減することを抑制することができる着座動作補助装置を提供する。 The present invention has been made to solve such a problem, and provides a seating motion assisting device capable of suppressing a decrease in the effect of damper control.

本発明の一態様に係る着座動作補助装置は、利用者の少なくとも一方の脚の大腿に装着される第1のリンクと、前記第1のリンクとピッチ軸周りに伸展状態から屈曲状態まで回転可能に連結され、脚の下腿に装着される第2のリンクと、前記第1のリンクに対して、前記第2のリンクを前記ピッチ軸周りに相対的に回転駆動させる駆動部と、前記第2のリンクに対する前記第1のリンクの前記ピッチ軸周りの角度を検出する角度検出部と、検出された前記角度が小さくなるように前記駆動部を制御する角度制御を実行しつつ、前記検出された角度が所定のダンパ制御遷移角度よりも小さい角度ではダンパ制御を実行する制御部と、を備える着座動作補助装置であって、前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、目標制御角度が前記検出された角度よりも大きく、且つ、前記目標制御角度と前記検出された角度との偏差が、所定の偏差量を超える場合は、前記ダンパ制御を実行する。このような構成とすることにより、ダンパ制御による効果が低減することを抑制することができる。 The seating motion assisting device according to one aspect of the present invention can rotate from the extended state to the bent state around the pitch axis with the first link attached to the thigh of at least one leg of the user. A second link connected to the lower leg of the leg, a drive unit for driving the second link to rotate relative to the first link, and the second link. The detection was performed while executing an angle detection unit that detects the angle of the first link with respect to the link around the pitch axis and an angle control that controls the drive unit so that the detected angle becomes smaller. A seating operation assisting device including a control unit that executes damper control at an angle smaller than a predetermined damper control transition angle, wherein the detected angle is equal to or greater than the damper control transition angle. In this case, if the target control angle is larger than the detected angle and the deviation between the target control angle and the detected angle exceeds a predetermined deviation amount, the damper control is executed. With such a configuration, it is possible to suppress the reduction of the effect of the damper control.

また、前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、前記目標制御角度が前記検出された角度よりも小さく、且つ、前記目標制御角度と前記検出された角度との偏差が、所定の屈曲保持偏差角度を超える場合には、前記目標制御角度を保持する。このような構成により、過度なアシスト力が利用者に加わることを抑制することができる。 Further, when the detected angle is equal to or larger than the damper control transition angle, the control unit has the target control angle smaller than the detected angle, and the target control angle and the detected angle. When the deviation of the above exceeds a predetermined bending holding deviation angle, the target control angle is held. With such a configuration, it is possible to prevent an excessive assisting force from being applied to the user.

さらに、前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、保持された前記目標精度角度と前記検出された角度との偏差が、前記屈曲保持偏差角度よりも小さい屈曲再開偏差角度よりも小さい場合には、前記角度制御を再開する。このような構成とすることにより、利用者の着座動作を適切に補助することができる。 Further, in the control unit, when the detected angle is equal to or larger than the damper control transition angle, the deviation between the held target accuracy angle and the detected angle is smaller than the bending holding deviation angle. If it is smaller than the restart deviation angle, the angle control is restarted. With such a configuration, it is possible to appropriately assist the user's sitting motion.

本発明により、ダンパ制御による効果が低減することを抑制することができる着座動作補助装置を提供する。 INDUSTRIAL APPLICABILITY The present invention provides a seating motion assisting device capable of suppressing a decrease in the effect of damper control.

実施形態1に係る着座動作補助装置の構成を使用形態で例示した斜視図である。It is a perspective view which illustrated the structure of the seating motion assisting apparatus which concerns on Embodiment 1. 実施形態1に係る着座動作補助装置の構成を使用形態で例示した正面図である。It is a front view which illustrated the structure of the seating operation assisting apparatus which concerns on Embodiment 1. 実施形態1に係る着座動作補助装置の構成を使用形態で例示した側面図である。It is a side view which illustrated the structure of the seating operation assisting apparatus which concerns on Embodiment 1. 実施形態1に係る着座動作補助装置の制御方法を説明するための説明図である。It is explanatory drawing for demonstrating the control method of the seating operation assisting apparatus which concerns on Embodiment 1. FIG. 実施形態1に係る着座動作補助装置の制御方法における角度制御を例示したグラフであり、横軸は、時間を示し、縦軸は、角度θを示す。It is a graph which illustrated the angle control in the control method of the seating motion assisting apparatus which concerns on Embodiment 1, the horizontal axis shows time, and the vertical axis shows the angle θ. 実施形態1に係る着座動作補助装置の制御方法における角度制御を例示したグラフであり、横軸は、時間を示し、縦軸は、角度θを示す。It is a graph which illustrated the angle control in the control method of the seating motion assisting apparatus which concerns on Embodiment 1, the horizontal axis shows time, and the vertical axis shows the angle θ. 実施形態1に係る着座動作補助装置を用いた着座動作の制御方法を例示したフローチャート図である。It is a flowchart which illustrates the control method of the seating motion using the seating motion assisting device which concerns on Embodiment 1. FIG. 実施形態2に係る着座動作補助装置を用いた着座動作の制御方法を例示したフローチャート図である。It is a flowchart which illustrates the control method of the seating motion using the seating motion assisting device which concerns on Embodiment 2. FIG. 実施形態3に係る着座動作補助装置を用いた着座動作の制御方法を例示したフローチャート図である。It is a flowchart which illustrates the control method of the seating motion using the seating motion assisting device which concerns on Embodiment 3. FIG.

以下、本発明を実施するための最良の形態について、添付図面を参照しながら説明する。但し、本発明が以下の実施の形態に限定される訳ではない。また、説明を明確にするため、以下の記載及び図面は、適宜、簡略化されている。 Hereinafter, the best mode for carrying out the present invention will be described with reference to the accompanying drawings. However, the present invention is not limited to the following embodiments. Further, in order to clarify the explanation, the following description and drawings have been simplified as appropriate.

(実施形態1)
実施形態1に係る着座動作補助装置を説明する。まず、着座動作補助装置の構成を説明する。その後、着座動作補助装置による着座動作の制御方法を説明する。
(Embodiment 1)
The seating operation assisting device according to the first embodiment will be described. First, the configuration of the seating motion assisting device will be described. After that, a method of controlling the seating motion by the seating motion assisting device will be described.

(着座動作補助装置の構成)
図1〜3は、実施形態1に係る着座動作補助装置の構成を使用形態で例示した図であり、図1は、斜視図を示し、図2は、正面図を示し、図3は、側面図を示す。図1〜3に示すように、着座動作補助装置1は、第1のリンク10と、第2のリンク20と、駆動部30と、角度検出部40と、制御部50と、を備えている。また、着座動作補助装置1は、足裏載置部60、膝装着部70、腰装着部80を備えている。
(Configuration of seating motion assist device)
1 to 3 are views illustrating the configuration of the seating operation assisting device according to the first embodiment in a usage embodiment, FIG. 1 shows a perspective view, FIG. 2 shows a front view, and FIG. 3 shows a side surface. The figure is shown. As shown in FIGS. 1 to 3, the seating operation assisting device 1 includes a first link 10, a second link 20, a drive unit 30, an angle detection unit 40, and a control unit 50. .. Further, the seating motion assisting device 1 includes a foot mounting portion 60, a knee mounting portion 70, and a waist mounting portion 80.

第1のリンク10は、利用者の少なくとも一方の脚の大腿に装着されている。例えば、第1のリンク10は、利用者の上腿部の側部に配置される。第1のリンク10は、利用者の上腿部の左右両側部にそれぞれ配置される。第1のリンク10の上端部は、上腿保持部11の側部に連結されている。第1のリンク10の下端部は、第2のリンク20に回転可能に連結されている。 The first link 10 is attached to the thigh of at least one leg of the user. For example, the first link 10 is arranged on the side of the user's upper thigh. The first link 10 is arranged on each of the left and right sides of the upper thigh of the user. The upper end of the first link 10 is connected to the side of the upper thigh holding portion 11. The lower end of the first link 10 is rotatably connected to the second link 20.

ここで、上腿保持部11は、板状部材であって、利用者の上腿部の外周形状に倣うように湾曲した形状とされている。当該湾曲した面の内側面を使用者の上腿部に接触させる。ここで、当該内側面にはスポンジ等の緩衝部材が設けられていることが好ましい。 Here, the upper thigh holding portion 11 is a plate-shaped member, and has a curved shape so as to follow the outer peripheral shape of the upper thigh portion of the user. The inner surface of the curved surface is brought into contact with the user's upper thigh. Here, it is preferable that a cushioning member such as a sponge is provided on the inner surface.

第2のリンク20は、利用者の脚の下腿に装着されている。例えば、第2のリンク20は、利用者の下腿部における脛部分の側部に配置される。第2のリンク20は、利用者の脛部分の左右両側部にそれぞれ配置される。第2のリンク20の上端部は、第1のリンク10の下端部に、ピッチ軸C周りに回転可能に連結されている。よって、第2のリンク20は、第1のリンク10とピッチ軸C周りに伸展状態から屈曲状態まで回転可能に連結されている。なお、ピッチ軸Cは、利用者の左右方向、ここでは膝の左右方向に延びた軸をいう。第2のリンク20の下端部は、足裏載置部60に回転可能に連結されている。 The second link 20 is attached to the lower leg of the user's leg. For example, the second link 20 is located on the side of the shin portion of the user's lower leg. The second link 20 is arranged on each of the left and right sides of the user's shin portion. The upper end of the second link 20 is rotatably connected to the lower end of the first link 10 around the pitch axis C. Therefore, the second link 20 is rotatably connected to the first link 10 around the pitch axis C from the extended state to the bent state. The pitch axis C refers to an axis extending in the left-right direction of the user, in this case, in the left-right direction of the knee. The lower end of the second link 20 is rotatably connected to the sole mounting portion 60.

足裏載置部60は、利用者の足を支持する。本実施形態の足裏載置部60は、載置部61、アーム62を備えている。載置部61は板状部材であって、利用者の足裏が載置される。アーム62は、載置部61を第2のリンク20に連結する。つまり、アーム62は利用者の下腿部における足首部分の左右両側部にそれぞれ配置される。 The sole mounting portion 60 supports the user's foot. The foot sole mounting portion 60 of the present embodiment includes a mounting portion 61 and an arm 62. The mounting portion 61 is a plate-shaped member on which the sole of the user's foot is mounted. The arm 62 connects the mounting portion 61 to the second link 20. That is, the arms 62 are arranged on the left and right sides of the ankle portion of the user's lower leg, respectively.

アーム62の上端部は、第2のリンク20の下端部に回転可能に連結されている。アーム62の下端部は、載置部61の側部に連結されている。これにより、利用者の体重を着座動作補助装置1に支持させることができる。 The upper end of the arm 62 is rotatably connected to the lower end of the second link 20. The lower end of the arm 62 is connected to the side of the mounting portion 61. As a result, the weight of the user can be supported by the seating motion assisting device 1.

膝装着部70は、アーチ71、図示を省略したビンディングを備えている。アーチ71は、左右の第1のリンク10と第2のリンク20との連結部相互を連結する。ビンディングは、アーチ71に設けられている。ビンディングは、アーチ71を使用者の膝に固定する。ビンディングは、アーチ71を使用者の膝に固定できる構成であれば特に限定しないが、例えば使用者の膝に着脱可能なバンドを含む。 The knee-mounted portion 70 includes an arch 71 and a binding (not shown). The arch 71 connects the connecting portions of the left and right first links 10 and the second links 20 to each other. The binding is provided on the arch 71. The binding secures the arch 71 to the user's knee. The binding is not particularly limited as long as the arch 71 can be fixed to the user's knee, and includes, for example, a band that can be attached to and detached from the user's knee.

駆動部30は、第1のリンク10と第2のリンク20との連結部分に駆動力を伝達する。駆動部30は、第1のリンク10に対して、第2のリンク20をピッチ軸C周りに相対的に回転駆動させる。駆動部30は、駆動モータ31、減速機32を備えている。駆動モータ31は、制御部50の制御信号に基づいて駆動する。駆動モータ31の駆動力は、減速機32に入力される。 The driving unit 30 transmits a driving force to the connecting portion between the first link 10 and the second link 20. The drive unit 30 drives the second link 20 to rotate relative to the first link 10 around the pitch axis C. The drive unit 30 includes a drive motor 31 and a speed reducer 32. The drive motor 31 is driven based on the control signal of the control unit 50. The driving force of the drive motor 31 is input to the speed reducer 32.

減速機32は、駆動モータ31から入力される駆動力を増減して、第1のリンク10と第2のリンク20との連結部分のピッチ軸C周りにおける回転軸に伝達する。これにより、第2のリンク20が第1のリンク10に対して利用者の前後方向に回転駆動する。 The speed reducer 32 increases or decreases the driving force input from the drive motor 31 and transmits the driving force to the rotating shaft around the pitch axis C of the connecting portion between the first link 10 and the second link 20. As a result, the second link 20 is rotationally driven in the front-rear direction of the user with respect to the first link 10.

角度検出部40は、第1のリンク10と第2のリンク20との連結部分に設けられている。角度検出部40は、第2のリンク20に対する第1のリンク20のピッチ軸C周りの回転角度を検出し、検出信号を制御部50に出力する。ここで、第1のリンク10に対する第2のリンク20の回転角度は、利用者の膝の屈曲角度として扱うことができる。 The angle detection unit 40 is provided at a connecting portion between the first link 10 and the second link 20. The angle detection unit 40 detects the rotation angle of the first link 20 with respect to the second link 20 around the pitch axis C, and outputs a detection signal to the control unit 50. Here, the rotation angle of the second link 20 with respect to the first link 10 can be treated as the flexion angle of the user's knee.

腰装着部80は、ベルト81、収納ボックス82を備えている。ベルト81は、利用者の腰に着脱可能な構成とされている。収納ボックス82は、ベルト81に設けられている。収納ボックス82には、駆動モータ31等の電源であるバッテリ、及び制御部50等が搭載されている制御基板が格納されている。収納ボックス82に収納されているバッテリ及び制御基板は、角度検出部40に配線83を介して接続されている。 The waist mounting portion 80 includes a belt 81 and a storage box 82. The belt 81 is configured to be removable from the waist of the user. The storage box 82 is provided on the belt 81. The storage box 82 stores a battery that is a power source for the drive motor 31 and the like, and a control board on which the control unit 50 and the like are mounted. The battery and the control board housed in the storage box 82 are connected to the angle detection unit 40 via the wiring 83.

制御部50は、角度検出部40からの検出信号に基づいて、駆動部30の駆動モータ31を制御する。 The control unit 50 controls the drive motor 31 of the drive unit 30 based on the detection signal from the angle detection unit 40.

(着座動作の制御方法)
次に、着座動作補助装置1を用いた着座動作の制御方法を説明する。まず、着座動作の制御方法で用いられるパラメータを説明する。次に、本実施形態の着座動作の制御方法の概要を、グラフを用いて説明する。その後、フローチャート図を用いて詳細に説明する。
(Control method for seating motion)
Next, a method of controlling the seating motion using the seating motion assisting device 1 will be described. First, the parameters used in the seating motion control method will be described. Next, an outline of the seating motion control method of the present embodiment will be described with reference to a graph. After that, it will be described in detail with reference to a flowchart.

(パラメータ)
図4は、実施形態1に係る着座動作補助装置の制御方法を説明するための説明図である。図4に示すように、第1のリンク10と第2のリンク20とがなす角度を角度αとする。利用者が立位の場合の角度は、角度α=180[°]である。ここで角度θを、角度θ=角度α−180[°]と定義する。利用者が、立位の場合には、角度θ=0[°]である。立位の場合の角度θを着座開始角度θstartとする。
(Parameter)
FIG. 4 is an explanatory diagram for explaining a control method of the seating operation assisting device according to the first embodiment. As shown in FIG. 4, the angle formed by the first link 10 and the second link 20 is defined as the angle α. The angle when the user is standing is the angle α = 180 [°]. Here, the angle θ is defined as the angle θ = the angle α-180 [°]. When the user is standing, the angle θ = 0 [°]. The angle θ in the standing position is defined as the seating start angle θstart.

利用者が着座を終了した場合には、第1のリンク10と第2のリンク20とがなす角度αは、例えば、90[°]である。また、その場合には、角度θは、−90[°]である。このように、利用者が立位の状態から着座の状態に変化する場合に、角度αは、180[°]から90[°]まで変化し、角度θは、0[°]から−90[°]まで変化する。よって、利用者が立位の状態から着座の状態に変化する場合に、角度αも角度θも小さくなる。着座の終了を判断する場合の角度θを着座終了角度θendとする。したがって、角度θが着座終了角度θendよりも小さい場合に着座を終了する。なお、着座開始角度θstartは、0[°]でなくてもよいし、着座終了角度θendは、−90[°]でなくてもよい。 When the user finishes sitting, the angle α formed by the first link 10 and the second link 20 is, for example, 90 [°]. In that case, the angle θ is −90 [°]. In this way, when the user changes from the standing state to the sitting state, the angle α changes from 180 [°] to 90 [°], and the angle θ changes from 0 [°] to −90 [°]. °]. Therefore, when the user changes from the standing state to the sitting state, both the angle α and the angle θ become small. The angle θ when determining the end of seating is defined as the seating end angle θend. Therefore, when the angle θ is smaller than the seating end angle θend, the seating ends. The seating start angle θstart does not have to be 0 [°], and the seating end angle θend does not have to be −90 [°].

制御部50は、利用者の着座動作を補助する場合には、角度が小さくなるように駆動部30を制御する。このような、角度が小さくなるように駆動部30を制御することを角度制御という。よって、制御部50は、利用者の着座動作を補助する場合には、角度制御を実行する。一方、制御部50は、角度が所定のダンパ制御遷移角度θdamよりも小さい角度では、ダンパ制御を実行する。ダンパ制御とは、着座の際の衝撃を弱めるようにする制御をいう。 The control unit 50 controls the drive unit 30 so that the angle becomes smaller when assisting the seating motion of the user. Controlling the drive unit 30 so that the angle becomes smaller is called angle control. Therefore, the control unit 50 executes the angle control when assisting the sitting motion of the user. On the other hand, the control unit 50 executes the damper control at an angle smaller than the predetermined damper control transition angle θdam. Damper control refers to control that reduces the impact when sitting.

図4に示すように、所定のダンパ制御遷移角度θdamとして、着座開始角度θstartと、着座終了角度θendとの間の角度から選択する。ダンパ制御遷移角度θdamよりも小さい角度、すなわち、ダンパ制御遷移角度θdamよりも屈曲側では、制御部50は、ダンパ制御を実行する。一方、制御部50は、ダンパ制御遷移角度θdam以上の角度、すなわち、ダンパ制御遷移角度θdamよりも伸展側では、基本的には、角度制御を実行する。角度制御では、目標制御角度θrefが設定される。 As shown in FIG. 4, the predetermined damper control transition angle θdam is selected from the angle between the seating start angle θstart and the seating end angle θend. The control unit 50 executes damper control at an angle smaller than the damper control transition angle θdam, that is, on the bending side of the damper control transition angle θdam. On the other hand, the control unit 50 basically executes angle control at an angle equal to or greater than the damper control transition angle θdam, that is, on the extension side of the damper control transition angle θdam. In the angle control, the target control angle θref is set.

(着座動作の制御方法の概要)
次に、本実施形態の着座動作の制御方法の概要を、グラフを用いて説明する。図5及び図6は、実施形態1に係る着座動作補助装置の制御方法における角度制御を例示したグラフであり、横軸は、時間を示し、縦軸は、角度θを示す。実線は、目標制御角度θrefであり、点線は、検出された角度θcurである。なお、検出された角度θcurを単に角度θcurともいう。
(Overview of seating motion control method)
Next, an outline of the seating motion control method of the present embodiment will be described with reference to a graph. 5 and 6 are graphs illustrating angle control in the control method of the seating motion assisting device according to the first embodiment, in which the horizontal axis represents time and the vertical axis represents angle θ. The solid line is the target control angle θref, and the dotted line is the detected angle θcur. The detected angle θcur is also simply referred to as an angle θcur.

図5及び図6に示すように、制御部50は、検出された角度θcurが小さくなるように駆動部30を制御する角度制御を実行する。角度制御において、目標制御角度θrefを、例えば、時間に比例して小さくなるように設定する。なお、目標制御角度θrefの設定は、時間に相関して小さくなれば、比例して小さくなる設定に限らない。 As shown in FIGS. 5 and 6, the control unit 50 executes angle control for controlling the drive unit 30 so that the detected angle θcur becomes smaller. In the angle control, the target control angle θref is set to decrease in proportion to the time, for example. The setting of the target control angle θref is not limited to the setting that decreases proportionally as long as it decreases in correlation with time.

制御部50は、目標制御角度θrefに、検出された角度θcurが追随するように、駆動部30を制御する。角度θcurが、ダンパ制御遷移角度θdamまで小さくなるまでは、制御部50は、基本的には、角度制御を実行する。一方、角度θcurが、ダンパ制御遷移角度θdamよりも小さくなったときは、制御部50は、ダンパ制御を開始する。制御部50は、角度θcurが、着座終了角度θendになるまで、ダンパ制御を行う。 The control unit 50 controls the drive unit 30 so that the detected angle θcur follows the target control angle θref. The control unit 50 basically executes the angle control until the angle θcur becomes smaller than the damper control transition angle θdam. On the other hand, when the angle θcur becomes smaller than the damper control transition angle θdam, the control unit 50 starts damper control. The control unit 50 performs damper control until the angle θcur becomes the seating end angle θend.

図5に示すように、検出された角度θcurが、目標制御角度θrefに追随するように駆動部30を制御する際に、屈曲動作が勝り、角度θcurが、目標制御角度θrefよりも小さくなる場合がある。そして、目標制御角度θrefと検出された角度θcurとの偏差(|θref−θcur|)が、所定の偏差量よりも大きくなる場合がある。所定の偏差量を、例えば、ダンパ制御遷移偏差角度Δθdamという。このような場合には、制御部50は、ダンパ制御遷移角度θdamまで屈曲していなくても、ダンパ制御に遷移する。 As shown in FIG. 5, when the driving unit 30 is controlled so that the detected angle θcur follows the target control angle θref, the bending motion is superior and the angle θcur becomes smaller than the target control angle θref. There is. Then, the deviation between the target control angle θref and the detected angle θcur (| θref−θcur |) may be larger than the predetermined deviation amount. The predetermined deviation amount is referred to as, for example, the damper control transition deviation angle Δθdam. In such a case, the control unit 50 transitions to the damper control even if it is not bent to the damper control transition angle θdam.

例えば、利用者の体重が想定以上の場合、または、利用者が勢いをつけて着座しようとした場合に、検出された角度θcurが、ダンパ制御遷移角度θdamに至ったタイミングにおいて、既に勢いがつき、ダンパ制御が実行されたとしても、利用者を十分にゆっくりした速度で着座させることが困難な場合がある。 For example, when the weight of the user is heavier than expected, or when the user tries to sit with momentum, the detected angle θcur has already gained momentum at the timing when the damper control transition angle θdam is reached. Even if the damper control is executed, it may be difficult to seat the user at a sufficiently slow speed.

しかしながら、本実施形態では、検出された角度θcurが、ダンパ制御遷移角度θdamに至る前のダンパ制御遷移角度θdam以上の場合でも、目標制御角度θrefが検出された角度θcurよりも大きく、且つ、目標制御角度θrefと検出された角度θcurとの偏差(|θref−θcur|)が、所定の偏差量(ダンパ制御遷移偏差角度Δθdam)を超える場合は、制御部50は、ダンパ制御を実行する。よって、ダンパ制御による効果が低減することを抑制することができる。 However, in the present embodiment, even when the detected angle θcur is equal to or greater than the damper control transition angle θdam before reaching the damper control transition angle θdam, the target control angle θref is larger than the detected angle θcur and the target. When the deviation between the control angle θref and the detected angle θcur (| θref−θcur |) exceeds a predetermined deviation amount (damper control transition deviation angle Δθdam), the control unit 50 executes damper control. Therefore, it is possible to suppress the reduction of the effect of the damper control.

また、図6に示すように、目標制御角度θrefに、検出された角度θcurを追随させるように駆動部30を制御する際に、駆動部30の追随が甘く不十分な場合がある。そして、検出された角度θcurがダンパ制御遷移角度θdam以上において、目標制御角度θrefが検出された角度θcurよりも小さく、且つ、目標制御角度θrefと検出された角度θcurとの偏差(|θref−θcur|)が、所定の屈曲保持偏差角度Δθholdを超える場合には、目標制御角度θrefを変化させずに保持する。その間に、検出された角度θcurが、保持した目標制御角度θrefに追いつくようにする。 Further, as shown in FIG. 6, when the drive unit 30 is controlled so as to follow the detected angle θcur to the target control angle θref, the follow-up of the drive unit 30 may be loose and insufficient. Then, when the detected angle θcur is equal to or larger than the damper control transition angle θdam, the target control angle θref is smaller than the detected angle θcur, and the deviation between the target control angle θref and the detected angle θcur (| θref−θcur). When |) exceeds a predetermined bending holding deviation angle Δθhold, the target control angle θref is held unchanged. In the meantime, the detected angle θcur catches up with the held target control angle θref.

そして、保持された目標制御角度θrefと検出された角度θcurとの偏差(|θref−θcur|)が、所定の屈曲再開偏差角度Δθbenよりも小さくなった場合には、目標制御角度θrefの変化を再開する。これにより、制御部50は、検出された角度θcurが、目標制御角度θrefに追随するように角度制御を再開し、駆動部30に対して屈曲動作を再開させる。 Then, when the deviation between the held target control angle θref and the detected angle θcur (| θref−θcur |) becomes smaller than the predetermined bending restart deviation angle Δθben, the change in the target control angle θref is changed. resume. As a result, the control unit 50 restarts the angle control so that the detected angle θcur follows the target control angle θref, and causes the drive unit 30 to restart the bending operation.

このように、本実施形態では、検出された角度θcurが、ダンパ制御遷移角度θdam以上の場合に、目標制御角度θrefが角度θcurよりも小さく、且つ、目標制御角度θrefと角度θcurとの偏差が屈曲保持偏差角度を超える場合は、目標制御角度θrefを保持する。このようにして、目標制御角度θrefと角度θcurとの偏差を小さくするので、過度なアシスト力が利用者に加わることを抑制することができる。 As described above, in the present embodiment, when the detected angle θcur is equal to or larger than the damper control transition angle θdam, the target control angle θref is smaller than the angle θcur, and the deviation between the target control angle θref and the angle θcur is large. When the bending holding deviation angle is exceeded, the target control angle θref is held. In this way, since the deviation between the target control angle θref and the angle θcur is reduced, it is possible to suppress the excessive assist force from being applied to the user.

(着座動作の制御方法の詳細)
次に、本実施形態の着座動作の制御方法を、フローチャートを用いて説明する。図7は、実施形態1に係る着座動作補助装置1を用いた着座動作の制御方法を例示したフローチャート図である。
(Details of seating motion control method)
Next, the method of controlling the seating motion of the present embodiment will be described with reference to a flowchart. FIG. 7 is a flowchart illustrating a method of controlling a seating motion using the seating motion assisting device 1 according to the first embodiment.

図7に示すように、本実施形態の着座の制御方法においては、動作状態判定部51、着座制御部52、ダンパ制御部53に区分してもよい。動作状態判定部51は、着座動作補助装置の動作状態を判定する。具体的には、角度検出器40によって検出した角度θcurから着座動作補助装置1の動作状態を判定する。着座制御部52は、動作状態判定部51において判定した動作状態に応じて着座制御を切り替える。ダンパ制御部53は、ダンパ制御を実行する。 As shown in FIG. 7, in the seating control method of the present embodiment, the operation state determination unit 51, the seating control unit 52, and the damper control unit 53 may be classified. The operation state determination unit 51 determines the operation state of the seating operation assisting device. Specifically, the operating state of the seating operation assisting device 1 is determined from the angle θcur detected by the angle detector 40. The seating control unit 52 switches the seating control according to the operating state determined by the operating state determining unit 51. The damper control unit 53 executes damper control.

まず、図7のステップS11に示すように、制御部50は、目標制御角度θrefが、検出された角度θcurよりも大きいか(θref>θcur?)を判断する。また、目標制御角度θrefと角度θcurとの偏差、すなわち、目標制御角度θrefと角度θcurとの差の絶対値が、所定の偏差量(ダンパ制御遷移偏差角度Δθdam)よりも大きいか(|θref−θcur|>Δθdam?)を判断する。目標制御角度θrefが、角度θcur以下の場合、または、目標制御角度θrefと角度θcurとの偏差がダンパ制御遷移偏差角度Δθdam以下の場合、または、両方の場合には、Noに進み、ステップS12に進む。 First, as shown in step S11 of FIG. 7, the control unit 50 determines whether the target control angle θref is larger than the detected angle θcur (θref> θcur?). Further, whether the deviation between the target control angle θref and the angle θcur, that is, the absolute value of the difference between the target control angle θref and the angle θcur is larger than a predetermined deviation amount (damper control transition deviation angle Δθdam) (| θref− θcur |> Δθdam?) Is determined. If the target control angle θref is less than or equal to the angle θcur, or if the deviation between the target control angle θref and the angle θcur is less than or equal to the damper control transition deviation angle Δθdam, or both, the process proceeds to No and proceeds to step S12. move on.

次に、図7のステップS12に示すように、制御部50は、目標制御角度θrefが、検出された角度θcurよりも小さいか(θref<θcur?)を判断する。また、目標制御角度θrefと角度θcurとの偏差が、所定の屈曲保持偏差角度Δθholdよりも大きいか(|θref−θcur|>Δθhold?)を判断する。目標制御角度θrefが、角度θcur以上の場合、または、目標制御角度θrefと角度θcurとの偏差が屈曲保持偏差角度Δθhold以下の場合、または、両方の場合には、Noに進み、ステップS13に進む。 Next, as shown in step S12 of FIG. 7, the control unit 50 determines whether the target control angle θref is smaller than the detected angle θcur (θref <θcur?). Further, it is determined whether the deviation between the target control angle θref and the angle θcur is larger than the predetermined bending holding deviation angle Δθhold (| θref−θcur |> Δθhold?). If the target control angle θref is greater than or equal to the angle θcur, or if the deviation between the target control angle θref and the angle θcur is less than or equal to the bending holding deviation angle Δθhold, or both, the process proceeds to No and the process proceeds to step S13. ..

そして、図7のステップS13に示すように、制御部50は、角度制御を実行する。具体的には、図5及び図6に示すように、制御部50は、時間とともに小さくなる目標制御角度θrefに追随するように、駆動部30を動作させる。駆動部30は、第1のリンク10と第2のリンク20とが屈曲するように角度θcurを小さくする。 Then, as shown in step S13 of FIG. 7, the control unit 50 executes the angle control. Specifically, as shown in FIGS. 5 and 6, the control unit 50 operates the drive unit 30 so as to follow the target control angle θref that decreases with time. The drive unit 30 reduces the angle θcur so that the first link 10 and the second link 20 bend.

次に、図7のステップS14に示すように、制御部50は、検出された角度θcurがダンパ制御遷移角度θdamよりも小さいか(θcur<θdam?)を判断する。角度θcurがダンパ制御遷移角度θdam以上の(Noの)場合には、ステップS11に戻る。 Next, as shown in step S14 of FIG. 7, the control unit 50 determines whether the detected angle θcur is smaller than the damper control transition angle θdam (θcur <θdam?). If the angle θcur is equal to or greater than the damper control transition angle θdam (No), the process returns to step S11.

一方、ステップS14において、検出された角度θcurが、ダンパ制御遷移角度θdamよりも小さい(Yesの)場合には、ステップS15に示すように、制御部50は、ダンパ制御を実行する。 On the other hand, in step S14, when the detected angle θcur is smaller than the damper control transition angle θdam (Yes), the control unit 50 executes the damper control as shown in step S15.

そして、ステップS16に示すように、制御部50は、検出された角度θcurが着座終了角度θendよりも小さいか(θcur<θend?)を判断する。角度θcurが着座終了角度θend以上の(Noの)場合には、ステップS15に戻り、制御部50は、ダンパ制御を継続する。 Then, as shown in step S16, the control unit 50 determines whether the detected angle θcur is smaller than the seating end angle θend (θcur <θend?). When the angle θcur is equal to or greater than the seating end angle θend (No), the process returns to step S15, and the control unit 50 continues damper control.

ステップS16において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 In step S16, when the detected angle θcur is smaller than the seating end angle θend (Yes), the seating is completed and the process is completed.

一方、ステップS11において、目標制御角度θrefが、検出された角度θcurよりも大きく、且つ、目標制御角度θrefと角度θcurとの偏差が、所定のダンパ制御遷移偏差角度Δθdamよりも大きい(Yesの)場合には、ステップS17に示すように、制御部50は、ダンパ制御を実行する。これは、図5で示した時間t=taの場合である。 On the other hand, in step S11, the target control angle θref is larger than the detected angle θcur, and the deviation between the target control angle θref and the angle θcur is larger than the predetermined damper control transition deviation angle Δθdam (Yes). In this case, as shown in step S17, the control unit 50 executes damper control. This is the case of the time t = ta shown in FIG.

そして、ステップS18に示すように、検出された角度θcurが着座終了角度θendよりも小さいか(θcur<θend?)を判断する。角度θcurが着座終了角度θend以上の(Noの)場合には、ステップS17に戻り、ダンパ制御を継続する。 Then, as shown in step S18, it is determined whether the detected angle θcur is smaller than the seating end angle θend (θcur <θend?). When the angle θcur is equal to or greater than the seating end angle θend (No), the process returns to step S17 and the damper control is continued.

ステップS18において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 In step S18, when the detected angle θcur is smaller than the seating end angle θend (Yes), the seating is completed and the process is completed.

ステップS11において、Noに進み、ステップS12において、目標制御角度θrefが、検出された角度θcurよりも小さく、且つ、目標制御角度θrefと角度θcurとの偏差が、屈曲保持偏差角度Δθholdよりも大きい(Yesの)場合には、ステップS19に示すように、目標制御角度θrefと角度θcurとの偏差が、屈曲再開偏差角度Δθbenよりも小さいか(|θref−θcur|<Δθben?)を判断する。 In step S11, the process proceeds to No. In step S12, the target control angle θref is smaller than the detected angle θcur, and the deviation between the target control angle θref and the angle θcur is larger than the bending holding deviation angle Δθhold ( In the case of Yes), as shown in step S19, it is determined whether the deviation between the target control angle θref and the angle θcur is smaller than the bending restart deviation angle Δθben (| θref−θcur | <Δθben?).

そして、目標制御角度θrefと検出された角度θcurとの偏差が、屈曲再開偏差角度Δθben以上の(Noの)場合には、ステップS20に示すように、制御部50は、目標制御角度θrefを保持する。そして、ステップS19に戻り再び判断する。 When the deviation between the target control angle θref and the detected angle θcur is equal to or greater than the bending restart deviation angle Δθben (No), the control unit 50 holds the target control angle θref as shown in step S20. do. Then, the process returns to step S19 and the determination is made again.

一方、目標制御角度θrefと検出された角度θcurとの偏差が、屈曲再開偏差角度Δθbenよりも小さい(Yesの)場合には、ステップS13に示すように、制御部50は、角度制御として屈曲動作を実行する。 On the other hand, when the deviation between the target control angle θref and the detected angle θcur is smaller than the bending restart deviation angle Δθben (Yes), the control unit 50 performs the bending operation as angle control as shown in step S13. To execute.

そして、ステップS14を経て、所定の処理を繰り返し、ステップS16またはステップS18において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 Then, the predetermined process is repeated through step S14, and if the detected angle θcur is smaller than the seating end angle θend (Yes) in step S16 or step S18, the seating is completed and the process is completed. ..

本実施形態によれば、検出された角度θcurがダンパ制御遷移角度θdamに至る前でも、角度θcurが目標制御角度θrefよりも小さい場合であって、目標制御角度θrefと角度θcurとの偏差が、所定の偏差量(ダンパ制御遷移偏差角度Δθdam)よりも大きい場合には、ダンパ制御に遷移させている。よって、ダンパ制御による効果が低減することを抑制することができる。 According to the present embodiment, even before the detected angle θcur reaches the damper control transition angle θdam, the angle θcur is smaller than the target control angle θref, and the deviation between the target control angle θref and the angle θcur is determined. When it is larger than a predetermined deviation amount (damper control transition deviation angle Δθdam), the transition is made to damper control. Therefore, it is possible to suppress the reduction of the effect of the damper control.

また、このようにすることで、角度制御からダンパ制御への切り替え時において、目標制御角度θrefと検出された角度θcurとの偏差を小さくすることができる。これにより、切り替え時の振動(ハンチング)を抑制することができる。 Further, by doing so, the deviation between the target control angle θref and the detected angle θcur can be reduced when switching from the angle control to the damper control. As a result, vibration (hunting) at the time of switching can be suppressed.

さらに、検出された角度θcurが、ダンパ制御遷移角度θdam以上の場合に、目標制御角度θrefが角度θcurよりも小さく、且つ、目標制御角度θrefと角度θcurとの偏差が屈曲保持偏差角度Δθholdを超える場合は、目標制御角度θrefを保持する。よって、目標制御角度θrefと角度θcurとの偏差を小さくするので、過度なアシスト力が利用者に加わることを抑制することができる。 Further, when the detected angle θcur is equal to or greater than the damper control transition angle θdam, the target control angle θref is smaller than the angle θcur, and the deviation between the target control angle θref and the angle θcur exceeds the bending holding deviation angle Δθhold. In the case, the target control angle θref is maintained. Therefore, since the deviation between the target control angle θref and the angle θcur is reduced, it is possible to suppress the excessive assist force from being applied to the user.

(実施形態2)
次に、実施形態2を説明する。本実施形態は、ダンパ制御遷移角度θdamに至る前でも、ダンパ制御に遷移させる制御方法である。図8は、実施形態2に係る着座動作補助装置を用いた着座動作の制御方法を例示したフローチャート図である。
(Embodiment 2)
Next, the second embodiment will be described. This embodiment is a control method for transitioning to damper control even before the damper control transition angle θdam is reached. FIG. 8 is a flowchart illustrating a method of controlling a seating motion using the seating motion assisting device according to the second embodiment.

まず、図8のステップS21に示すように、目標制御角度θrefが、検出された角度θcurよりも大きいか(θref>θcur?)を判断する。また、目標制御角度θrefと角度θcurとの偏差が、所定の偏差量(ダンパ制御遷移偏差角度Δθdam)よりも大きいか(|θref−θcur|>Δθdam?)を判断する。目標制御角度θrefが、角度θcur以下の場合、または、目標制御角度θrefと角度θcurとの偏差がダンパ制御遷移偏差角度Δθdam以下の場合、または、両方の場合には、Noに進み、ステップS22に進む。 First, as shown in step S21 of FIG. 8, it is determined whether the target control angle θref is larger than the detected angle θcur (θref> θcur?). Further, it is determined whether the deviation between the target control angle θref and the angle θcur is larger than a predetermined deviation amount (damper control transition deviation angle Δθdam?) (| θref−θcur |> Δθdam?). If the target control angle θref is less than or equal to the angle θcur, or if the deviation between the target control angle θref and the angle θcur is less than or equal to the damper control transition deviation angle Δθdam, or both, the process proceeds to No and proceeds to step S22. move on.

次に、図8のステップS22に示すように、制御部50は、角度制御として、駆動部30に対して屈曲動作を実行させる。制御部50は、目標制御角度θrefに追随するように、駆動部30を動作させる。 Next, as shown in step S22 of FIG. 8, the control unit 50 causes the drive unit 30 to perform a bending operation as angle control. The control unit 50 operates the drive unit 30 so as to follow the target control angle θref.

次に、図8のステップS23に示すように、検出された角度θcurがダンパ制御遷移角度θdamよりも小さいか(θcur<θdam?)を判断する。角度θcurがダンパ制御遷移角度θdam以上の(Noの)場合には、ステップS21に戻る。 Next, as shown in step S23 of FIG. 8, it is determined whether the detected angle θcur is smaller than the damper control transition angle θdam (θcur <θdam?). If the angle θcur is equal to or greater than the damper control transition angle θdam (No), the process returns to step S21.

一方、ステップS23において、検出された角度θcurが、ダンパ制御遷移角度θdamよりも小さい(Yesの)場合には、ステップS24に示すように、ダンパ制御を実行する。 On the other hand, if the detected angle θcur in step S23 is smaller than the damper control transition angle θdam (Yes), damper control is executed as shown in step S24.

そして、ステップS25に示すように、検出された角度θcurが着座終了角度θendよりも小さいか(θcur<θend?)を判断する。角度θcurが着座終了角度θend以上の(Noの)場合には、ステップS24に戻り、ダンパ制御を継続する。 Then, as shown in step S25, it is determined whether the detected angle θcur is smaller than the seating end angle θend (θcur <θend?). When the angle θcur is equal to or greater than the seating end angle θend (No), the process returns to step S24 and the damper control is continued.

ステップS25において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 In step S25, when the detected angle θcur is smaller than the seating end angle θend (Yes), the seating is completed and the process is completed.

一方、ステップS21において、目標制御角度θrefが、検出された角度θcurよりも大きく、且つ、目標制御角度θrefと角度θcurとの偏差が、所定のダンパ制御遷移偏差角度Δθdamよりも大きい(Yesの)場合には、ステップS26に示すように、ダンパ制御を実行する。 On the other hand, in step S21, the target control angle θref is larger than the detected angle θcur, and the deviation between the target control angle θref and the angle θcur is larger than the predetermined damper control transition deviation angle Δθdam (Yes). In that case, the damper control is executed as shown in step S26.

そして、ステップS27に示すように、検出された角度θcurが着座終了角度θendよりも小さいか(θcur<θend?)を判断する。角度θcurが着座終了角度θend以上の(Noの)場合には、ステップS26に戻り、ダンパ制御を継続する。 Then, as shown in step S27, it is determined whether the detected angle θcur is smaller than the seating end angle θend (θcur <θend?). When the angle θcur is equal to or greater than the seating end angle θend (No), the process returns to step S26 and the damper control is continued.

ステップS27において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 In step S27, when the detected angle θcur is smaller than the seating end angle θend (Yes), the seating is completed and the process is completed.

本実施形態では、検出された角度θcurが、ダンパ制御遷移角度θdamに至る前でも、ダンパ制御に遷移させている。よって、角度θcurに勢いが付く前に、ダンパ制御による抗力を発生させることができ、ダンパ制御による効果が低減することを抑制することができる。その他の効果は、実施形態1の記載に含まれている。 In the present embodiment, the detected angle θcur is transitioned to the damper control even before the damper control transition angle θdam is reached. Therefore, it is possible to generate a drag force by the damper control before the angle θcur gains momentum, and it is possible to suppress the reduction of the effect by the damper control. Other effects are included in the description of Embodiment 1.

(実施形態3)
次に、実施形態3を説明する。本実施形態は、目標制御角度θrefと検出された角度θcurとの偏差が屈曲保持偏差角度Δθholdを超える場合は、目標制御角度θrefを保持するものである。図9は、実施形態3に係る着座動作補助装置を用いた着座動作の制御方法を例示したフローチャート図である。
(Embodiment 3)
Next, the third embodiment will be described. In the present embodiment, when the deviation between the target control angle θref and the detected angle θcur exceeds the bending holding deviation angle Δθhold, the target control angle θref is maintained. FIG. 9 is a flowchart illustrating a method of controlling a seating motion using the seating motion assisting device according to the third embodiment.

まず、図9のステップS31に示すように、目標制御角度θrefが、検出された角度θcurよりも小さいか(θref<θcur?)を判断する。また、目標制御角度θrefと角度θcurとの偏差が、所定の屈曲保持偏差角度Δθholdよりも大きいか(|θref−θcur|>Δθhold?)を判断する。目標制御角度θrefが、角度θcur以上の場合、または、目標制御角度θrefと角度θcurとの偏差が屈曲保持偏差角度Δθhold以下の場合、または、両方の場合には、Noに進み、ステップS32に進む。 First, as shown in step S31 of FIG. 9, it is determined whether the target control angle θref is smaller than the detected angle θcur (θref <θcur?). Further, it is determined whether the deviation between the target control angle θref and the angle θcur is larger than the predetermined bending holding deviation angle Δθhold (| θref−θcur |> Δθhold?). If the target control angle θref is greater than or equal to the angle θcur, or if the deviation between the target control angle θref and the angle θcur is less than or equal to the bending holding deviation angle Δθhold, or both, the process proceeds to No and the process proceeds to step S32. ..

そして、図9のステップS32に示すように、制御部50は、角度制御として、屈曲動作を駆動部30に対して実行させる。制御部50は、目標制御角度θrefに追随するように、駆動部30を動作させる。駆動部30は、第1のリンク10と第2のリンク20とが屈曲するように検出された角度θcurを小さくさせる。 Then, as shown in step S32 of FIG. 9, the control unit 50 causes the drive unit 30 to execute the bending operation as the angle control. The control unit 50 operates the drive unit 30 so as to follow the target control angle θref. The drive unit 30 reduces the angle θcur detected so that the first link 10 and the second link 20 bend.

次に、図9のステップS33に示すように、制御部50は、検出された角度θcurがダンパ制御遷移角度θdamよりも小さいか(θcur<θdam?)を判断する。角度θcurがダンパ制御遷移角度θdam以上の(Noの)場合には、ステップS31に戻る。 Next, as shown in step S33 of FIG. 9, the control unit 50 determines whether the detected angle θcur is smaller than the damper control transition angle θdam (θcur <θdam?). If the angle θcur is equal to or greater than the damper control transition angle θdam (No), the process returns to step S31.

一方、ステップS33において、検出された角度θcurが、ダンパ制御遷移角度θdamよりも小さい(Yesの)場合には、ステップS34に示すように、制御部50は、ダンパ制御を実行する。 On the other hand, when the detected angle θcur in step S33 is smaller than the damper control transition angle θdam (Yes), the control unit 50 executes damper control as shown in step S34.

そして、ステップS35に示すように、検出された角度θcurが着座終了角度θendよりも小さいか(θcur<θend?)を判断する。角度θcurが着座終了角度θend以上の(Noの)場合には、ステップS34に戻り、ダンパ制御を継続する。 Then, as shown in step S35, it is determined whether the detected angle θcur is smaller than the seating end angle θend (θcur <θend?). When the angle θcur is equal to or greater than the seating end angle θend (No), the process returns to step S34 and the damper control is continued.

ステップS35において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 In step S35, when the detected angle θcur is smaller than the seating end angle θend (Yes), the seating is completed and the process is completed.

一方、ステップS31において、目標制御角度θrefが、検出された角度θcurよりも小さく、且つ、目標制御角度θrefと角度θcurとの偏差が、屈曲保持偏差角度Δθholdよりも大きい(Yesの)場合には、ステップS36に示すように、目標制御角度θrefと角度θcurとの偏差が、屈曲再開偏差角度Δθbenよりも小さいか(|θref−θcur|<Δθdan?)を判断する。 On the other hand, in step S31, when the target control angle θref is smaller than the detected angle θcur and the deviation between the target control angle θref and the angle θcur is larger than the bending holding deviation angle Δθhold (Yes). , As shown in step S36, it is determined whether the deviation between the target control angle θref and the angle θcur is smaller than the bending restart deviation angle Δθben (| θref−θcur | <Δθdan?).

そして、目標制御角度θrefと角度θcurとの偏差が、屈曲再開偏差角度Δθben以上の(Noの)場合には、ステップS37に示すように、目標制御角度θrefを保持する。そして、ステップS36に戻り再び判断する。 Then, when the deviation between the target control angle θref and the angle θcur is equal to or greater than the bending restart deviation angle Δθben (No), the target control angle θref is maintained as shown in step S37. Then, the process returns to step S36 and the determination is made again.

一方、目標制御角度θrefと検出された角度θcurとの偏差が、屈曲再開偏差角度Δθbenよりも小さい(Yesの)場合には、ステップS32に示すように、制御部50は、角度制御として、屈曲動作を駆動部30に実行させる。 On the other hand, when the deviation between the target control angle θref and the detected angle θcur is smaller than the bending restart deviation angle Δθben (Yes), as shown in step S32, the control unit 50 bends as angle control. The drive unit 30 is made to execute the operation.

そして、ステップS33を経て、所定の処理を繰り返し、ステップS35において、検出された角度θcurが着座終了角度θendよりも小さい(Yesの)場合には、着座が終了し、処理が完了する。 Then, the predetermined process is repeated through step S33, and when the detected angle θcur is smaller than the seating end angle θend (Yes) in step S35, the seating is completed and the process is completed.

本実施形態では、目標制御角度θrefと検出された角度θcurとの偏差を小さくするので、過度なアシスト力が利用者に加わることを抑制することができる。その他の効果は、実施形態1及び実施形態2の記載に含まれている。 In the present embodiment, since the deviation between the target control angle θref and the detected angle θcur is reduced, it is possible to suppress the excessive assist force from being applied to the user. Other effects are included in the description of Embodiment 1 and Embodiment 2.

以上、本発明に係る実施の形態を説明したが、上記の構成に限らず、本発明の技術的思想を逸脱しない範囲で、変更することが可能である。 Although the embodiment according to the present invention has been described above, the embodiment is not limited to the above configuration and can be changed without departing from the technical idea of the present invention.

例えば、実施形態1〜3において、動作状態判定に用いた角度に変えて、トルク演算値を用いた着座動作補助装置及び制御方法も、本発明の技術的思想の範囲である。 For example, in the first to third embodiments, the seating motion assisting device and the control method using the torque calculation value instead of the angle used for determining the operating state are also within the scope of the technical idea of the present invention.

1 着座動作補助装置
10 第1のリンク
11 上腿保持部
20 第2のリンク
30 駆動部
31 駆動モータ
32 減速機
40 角度検出部
50 制御部
51 動作状態判定部
52 着座制御部
53 ダンパ制御部
60 足裏載置部
61 載置部
62 アーム
70 膝装着部
71 アーチ
80 腰装着部
81 ベルト
82 収納ボックス
83 配線
C ピッチ軸
Δθben 屈曲再開偏差角度
Δθdam ダンパ制御遷移偏差角度
Δθhold 屈曲保持偏差角度
θcur 角度
θdam ダンパ制御遷移角度
θref 目標制御角度
1 Seating motion assisting device 10 First link 11 Upper thigh holding section 20 Second link 30 Drive section 31 Drive motor 32 Reducer 40 Angle detection section 50 Control section 51 Operation state determination section 52 Seating control section 53 Damper control section 60 Sole mounting part 61 Mounting part 62 Arm 70 Knee mounting part 71 Arch 80 Waist mounting part 81 Belt 82 Storage box 83 Wiring C Pitch axis Δθben Flexion restart deviation angle Δθdam Damper control transition deviation angle Δθhold Flexion holding deviation angle θcur Angle θdam Damper control transition angle θref Target control angle

Claims (3)

利用者の少なくとも一方の脚の大腿に装着される第1のリンクと、
前記第1のリンクとピッチ軸周りに伸展状態から屈曲状態まで回転可能に連結され、脚の下腿に装着される第2のリンクと、
前記第1のリンクに対して、前記第2のリンクを前記ピッチ軸周りに相対的に回転駆動させる駆動部と、
前記第2のリンクに対する前記第1のリンクの前記ピッチ軸周りの角度を検出する角度検出部と、
検出された前記角度が小さくなるように前記駆動部を制御する角度制御を実行しつつ、前記検出された角度が所定のダンパ制御遷移角度よりも小さい角度ではダンパ制御を実行する制御部と、
を備える着座動作補助装置であって、
前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、
目標制御角度が前記検出された角度よりも大きく、且つ、前記目標制御角度と前記検出された角度との偏差が、所定の偏差量を超える場合は、前記ダンパ制御を実行する、
着座動作補助装置。
A first link attached to the thigh of at least one leg of the user,
A second link that is rotatably connected to the first link around the pitch axis from an extended state to a bent state and is attached to the lower leg of the leg.
A drive unit that drives the second link to rotate relative to the first link with respect to the pitch axis.
An angle detection unit that detects the angle of the first link with respect to the second link around the pitch axis, and
A control unit that executes angle control that controls the drive unit so that the detected angle becomes smaller, and executes damper control at an angle where the detected angle is smaller than a predetermined damper control transition angle.
It is a seating motion assisting device equipped with
When the detected angle is equal to or greater than the damper control transition angle, the control unit may use the control unit.
When the target control angle is larger than the detected angle and the deviation between the target control angle and the detected angle exceeds a predetermined deviation amount, the damper control is executed.
Seating motion assist device.
前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、
前記目標制御角度が前記検出された角度よりも小さく、且つ、前記目標制御角度と前記検出された角度との偏差が、所定の屈曲保持偏差角度を超える場合には、前記目標制御角度を保持する、
請求項1に記載の着座動作補助装置。
When the detected angle is equal to or greater than the damper control transition angle, the control unit may use the control unit.
When the target control angle is smaller than the detected angle and the deviation between the target control angle and the detected angle exceeds a predetermined bending holding deviation angle, the target control angle is held. ,
The seating motion assisting device according to claim 1.
前記制御部は、前記検出された角度が前記ダンパ制御遷移角度以上の場合に、
保持された前記目標制御角度と前記検出された角度との偏差が、前記屈曲保持偏差角度よりも小さい屈曲再開偏差角度よりも小さい場合には、前記角度制御を再開する、
請求項2に記載の着座動作補助装置。
When the detected angle is equal to or greater than the damper control transition angle, the control unit may use the control unit.
When the deviation between the held target control angle and the detected angle is smaller than the bending restart deviation angle smaller than the bending holding deviation angle, the angle control is restarted.
The seating motion assisting device according to claim 2.
JP2017181091A 2017-09-21 2017-09-21 Seating motion assist device Active JP6930328B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017181091A JP6930328B2 (en) 2017-09-21 2017-09-21 Seating motion assist device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017181091A JP6930328B2 (en) 2017-09-21 2017-09-21 Seating motion assist device

Publications (2)

Publication Number Publication Date
JP2019055016A JP2019055016A (en) 2019-04-11
JP6930328B2 true JP6930328B2 (en) 2021-09-01

Family

ID=66106184

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017181091A Active JP6930328B2 (en) 2017-09-21 2017-09-21 Seating motion assist device

Country Status (1)

Country Link
JP (1) JP6930328B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7363552B2 (en) * 2020-02-12 2023-10-18 トヨタ自動車株式会社 walking aid device
JP7354965B2 (en) * 2020-08-28 2023-10-03 トヨタ自動車株式会社 walking aid device
JP7359108B2 (en) * 2020-08-28 2023-10-11 トヨタ自動車株式会社 walking aid device

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013090652A (en) * 2011-10-24 2013-05-16 Toyota Motor Corp Walking assist device and its controller, method, and program
JP5741375B2 (en) * 2011-10-26 2015-07-01 トヨタ自動車株式会社 Walking assistance device and control method thereof
JP6358853B2 (en) * 2014-05-23 2018-07-18 本田技研工業株式会社 Operation assistance device

Also Published As

Publication number Publication date
JP2019055016A (en) 2019-04-11

Similar Documents

Publication Publication Date Title
JP6930328B2 (en) Seating motion assist device
JP5083461B2 (en) Leg support device
JP5343708B2 (en) Landing timing specifying device and walking assist device
JP2008012224A (en) Walking assistance device
JP5954089B2 (en) Walking assist device
JP5565037B2 (en) Walking support device
JP2014073199A (en) Walking support device and walking support program
JP6238223B2 (en) Walking support device
JP5974919B2 (en) Evaluation device, evaluation method thereof, and walking assist device
JP5732270B2 (en) Operation assist device and program for operation assist control
JP5741375B2 (en) Walking assistance device and control method thereof
JP6017267B2 (en) Walking motion assist device
JP2017113304A (en) Oscillation joint device
JP6716970B2 (en) Gait training system
JP5747784B2 (en) Walking assistance device and control method thereof
JP2013208291A (en) Walking assistance device and walking assistance program
JP5477064B2 (en) Walking assist device
JP5772033B2 (en) Operation assist device and program for operation assist control
JP5968757B2 (en) Walking motion assist device
JP5741372B2 (en) Walking support device and control method thereof
JP2013208292A (en) Walking assistance device and walking assistance program
JP5549487B2 (en) Walking support device
WO2020100742A1 (en) Load reduction device, control device, load reduction method, and storage medium for storing program
JP2011143002A (en) Walking assist device
JP2017099796A (en) Walking assist device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200128

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201104

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201222

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: 20210713

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210726

R151 Written notification of patent or utility model registration

Ref document number: 6930328

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151