JP5948149B2 - Wheelchair that performs control based on rowing motion judgment - Google Patents
Wheelchair that performs control based on rowing motion judgment Download PDFInfo
- Publication number
- JP5948149B2 JP5948149B2 JP2012119492A JP2012119492A JP5948149B2 JP 5948149 B2 JP5948149 B2 JP 5948149B2 JP 2012119492 A JP2012119492 A JP 2012119492A JP 2012119492 A JP2012119492 A JP 2012119492A JP 5948149 B2 JP5948149 B2 JP 5948149B2
- Authority
- JP
- Japan
- Prior art keywords
- wheel
- speed
- wheelchair
- left wheel
- right wheel
- 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
- 230000001133 acceleration Effects 0.000 claims description 27
- 238000005259 measurement Methods 0.000 claims description 13
- 230000004044 response Effects 0.000 claims description 2
- 238000000034 method Methods 0.000 description 39
- 230000036461 convulsion Effects 0.000 description 12
- 230000006870 function Effects 0.000 description 11
- 238000010586 diagram Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 239000008186 active pharmaceutical agent Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000000843 powder Substances 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Electric Propulsion And Braking For Vehicles (AREA)
- Handcart (AREA)
Description
本発明は、車椅子に関し、さらに詳しくは、搭乗者の漕ぎ動作に応じて回転する左車輪及び右車輪を備える車椅子に関する。 The present invention relates to a wheelchair, and more particularly to a wheelchair including a left wheel and a right wheel that rotate in response to a passenger's rowing operation.
車椅子は、歩行が困難な高齢者、障害者の移動を補助するために用いられる。車椅子の搭乗者は、車輪に取り付けられたハンドリムを操作することにより、車椅子を前後方向に動かすことができる。搭乗者は、左車輪の回転速度と右車輪の回転速度とを調整することによって、車椅子を旋回させることができる。 The wheelchair is used to assist the movement of elderly people and persons with disabilities who are difficult to walk. A wheelchair occupant can move the wheelchair in the front-rear direction by operating a hand rim attached to the wheel. The passenger can turn the wheelchair by adjusting the rotation speed of the left wheel and the rotation speed of the right wheel.
車椅子が斜面上を水平に移動する場合、車椅子が、搭乗者の意図に反して下方向に移動する現象(片流れ現象)が発生する。たとえば、歩道が車道に向かって傾斜している場合、車椅子は、搭乗者の意図に関係なく、歩道から車道の方へ移動する。このように、搭乗者が、車椅子を意図通りに動かせないことがある。 When the wheelchair moves horizontally on the slope, a phenomenon (one-flow phenomenon) occurs in which the wheelchair moves downward against the passenger's intention. For example, when the sidewalk is inclined toward the roadway, the wheelchair moves from the sidewalk toward the roadway regardless of the intention of the passenger. Thus, the passenger may not be able to move the wheelchair as intended.
特許文献1には、左車輪及び右車輪にそれぞれ組み込まれたパウダブレーキを制御することによって、目標経路に沿って移動することができるパッシブ型移動台車が記載されている。しかし、特許文献1には、目標経路を設定する方法が具体的に記載されていない。
非特許文献1には、搭乗者が車椅子を漕いだときに発生する入力トルクの最大値と、入力トルクが最大値に達するまでの時間とを用いて、車椅子の走行軌道を推定することが記載されている。しかし、非特許文献1に記載されている方法は、搭乗者が車椅子を漕ぎ始めてから、入力トルクが最大値に達するまで、車椅子の走行軌道を制御することができない。
Non-Patent
また、非特許文献1に記載されている方法は、搭乗者が車椅子を操作することを前提としている。非特許文献1では、重力など、搭乗者の漕ぎ動作以外の要因によって車椅子が移動することが考慮されていない。
The method described in Non-Patent
本発明の目的は、搭乗者の漕ぎ動作以外の要因によって車椅子が移動する場合であっても、車輪の回転を制御できる車椅子を提供することである。 The objective of this invention is providing the wheelchair which can control rotation of a wheel even when a wheelchair moves by factors other than a passenger's rowing operation.
本発明の車椅子は、搭乗者の漕ぎ動作に応じて回転する左車輪及び右車輪を備える。本発明の車椅子は、第1速度取得部と、第2速度取得部と、漕ぎ動作判定部と、回転制御部とを備える。第1速度取得部は、左車輪の速度を取得する。第2速度取得部は、右車輪の速度を取得する。漕ぎ動作判定部は、第1速度取得部により取得された左車輪の速度と、第2速度取得部により取得された右車輪の速度とに基づいて、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する。回転制御部は、漕ぎ動作判定部による判定結果に応じて、左車輪及び右車輪の少なくとも一方の回転を制御する。 The wheelchair of the present invention includes a left wheel and a right wheel that rotate according to the rowing operation of the passenger. The wheelchair of the present invention includes a first speed acquisition unit, a second speed acquisition unit, a rowing operation determination unit, and a rotation control unit. The first speed acquisition unit acquires the speed of the left wheel. The second speed acquisition unit acquires the speed of the right wheel. The rowing operation determination unit is configured so that the occupant is at least one of the left wheel and the right wheel based on the speed of the left wheel acquired by the first speed acquisition unit and the speed of the right wheel acquired by the second speed acquisition unit. It is determined whether or not The rotation control unit controls the rotation of at least one of the left wheel and the right wheel according to the determination result by the rowing operation determination unit.
本発明によれば、漕ぎ動作判定部は、左車輪の速度と右車輪の速度とに基づいて、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する。回転制御部は、判定結果に応じて、左車輪及び右車輪の少なくとも一方の回転を制御する。これにより、搭乗者の漕ぎ動作以外の要因によって車椅子が移動する場合であっても、車輪の回転を制御することができる。 According to the present invention, the rowing operation determination unit determines whether the occupant has hit at least one of the left wheel and the right wheel based on the speed of the left wheel and the speed of the right wheel. The rotation control unit controls the rotation of at least one of the left wheel and the right wheel according to the determination result. Thereby, even if it is a case where a wheelchair moves by factors other than a passenger's rowing operation, rotation of a wheel can be controlled.
好ましくは、回転制御部は、漕ぎ動作判定部により搭乗者が左車輪及び右車輪を漕いでいないと判定された場合、左車輪及び右車輪の回転を停止させる。 Preferably, the rotation control unit stops the rotation of the left wheel and the right wheel when the rowing operation determination unit determines that the occupant does not stroke the left wheel and the right wheel.
本発明によれば、搭乗者が左車輪及び右車輪を漕いでいないと判定された場合、車椅子が停止する。これにより、車椅子が搭乗者の意図に反する動きをすることを防止できる。 According to the present invention, the wheelchair stops when it is determined that the passenger is not stroking the left wheel and the right wheel. Thereby, it can prevent that a wheelchair moves contrary to a passenger's intention.
好ましくは、本発明の車椅子はさらに、両側速度推定部を備える。両側速度推定部は、漕ぎ動作判定部により搭乗者が左車輪及び右車輪を漕いだと判定された場合、漕ぎ動作が開始された後の左車輪及び右車輪の平均速度を推定する。回転制御部は、推定された左車輪の平均速度と推定された右車輪の平均速度とを用いて、左車輪及び右車輪の少なくとも一方の回転を制御する。 Preferably, the wheelchair of the present invention further includes a both-side speed estimation unit. The both-side speed estimation unit estimates the average speed of the left wheel and the right wheel after the rowing operation is started when the rowing operation determination unit determines that the passenger has hit the left wheel and the right wheel. The rotation control unit controls the rotation of at least one of the left wheel and the right wheel using the estimated average speed of the left wheel and the estimated average speed of the right wheel.
本発明によれば、搭乗者が左車輪及び右車輪を漕いだと判定された場合、左車輪及び右車輪の平均速度が推定される。回転制御部は、左車輪及び右車輪の平均速度を用いて、左車輪及び右車輪の回転を制御する。これにより、搭乗者の意図する軌道に沿って車椅子を走行させることができる。 According to the present invention, when it is determined that the passenger has hit the left wheel and the right wheel, the average speed of the left wheel and the right wheel is estimated. The rotation control unit controls the rotation of the left wheel and the right wheel using the average speed of the left wheel and the right wheel. Thereby, a wheelchair can be run along the track which a passenger intends.
好ましくは、回転制御部は、取得された左車輪の速度と取得された右車輪の速度との実測比が、推定された左車輪の平均速度と推定された右車輪の平均速度との基準比に一致するように、左車輪及び右車輪の少なくとも一方の回転を制御する。これにより、搭乗者の意図する旋回半径に沿って車椅子を走行させることができる。 Preferably, the rotation control unit is configured such that an actual measurement ratio between the acquired left wheel speed and the acquired right wheel speed is a reference ratio between the estimated average speed of the left wheel and the estimated average speed of the right wheel. The rotation of at least one of the left wheel and the right wheel is controlled so as to coincide with. Thereby, a wheelchair can be run along the turning radius which a passenger intends.
本発明によれば、左車輪及び右車輪の回転が、左車輪の速度と右車輪の速度との実測比が、左車輪の平均速度と右車輪の平均速度との基準比に一致するように制御される。これにより、搭乗者の意図する軌道に沿って車椅子を走行させることができる。 According to the present invention, the rotation of the left wheel and the right wheel is such that the measured ratio between the speed of the left wheel and the speed of the right wheel matches the reference ratio of the average speed of the left wheel and the average speed of the right wheel. Be controlled. Thereby, a wheelchair can be run along the track which a passenger intends.
好ましくは、本発明の車椅子はさらに、片側速度推定部を備える。片側速度推定部は、漕ぎ動作判定部により搭乗者が左車輪及び右車輪の一方を漕いだと判定された場合、漕ぎ動作が開始された後の当該一方の車輪の平均速度を推定する。回転制御部は、取得された左車輪の速度と取得された右車輪の速度との実測比が、推定された一方の車輪の平均速度と漕ぎ動作が開始されたときの他方の車輪の速度との基準比に一致するように、左車輪及び右車輪の回転を制御する。 Preferably, the wheelchair of the present invention further includes a one-side speed estimation unit. The one-side speed estimation unit estimates an average speed of the one wheel after the rowing operation is started when it is determined by the rowing operation determination unit that the passenger has hit one of the left wheel and the right wheel. The rotation control unit is configured so that an actual measurement ratio between the acquired speed of the left wheel and the acquired speed of the right wheel is the estimated average speed of one wheel and the speed of the other wheel when the rowing operation is started. The rotation of the left wheel and the right wheel is controlled to match the reference ratio.
本発明によれば、搭乗者が一方の車輪を漕いだと判定された場合、一方の車輪の平均速度と、漕ぎ動作が開始されたときの他方の車輪との速度との基準比に基づいて、左車輪及び右車輪が制御される。これにより、搭乗者が一方の車輪のみを漕いだときであっても、搭乗者の意図する軌道に沿って車椅子を走行させることができる。 According to the present invention, when it is determined that the passenger has hit one of the wheels, based on the reference ratio between the average speed of one wheel and the speed of the other wheel when the rowing operation is started. The left wheel and the right wheel are controlled. Thereby, even when the passenger hits only one wheel, the wheelchair can be run along the track intended by the passenger.
好ましくは、本発明の車椅子はさらに、制御対象決定部を備える。制御対象決定部は、実測比を基準比と比較し、その比較結果に基づいて、左車輪及び右車輪のいずれを制御するかを決定する。回転制御部は、制御対象決定部により決定された車輪の回転を制御する。 Preferably, the wheelchair of the present invention further includes a control target determining unit. The control target determining unit compares the actual measurement ratio with the reference ratio, and determines which of the left wheel and the right wheel is controlled based on the comparison result. The rotation control unit controls the rotation of the wheel determined by the control target determining unit.
本発明によれば、回転制御部は、実測比を基準比と比較した結果に基づいて、左車輪及び右車輪のいずれか一方の回転を制御する。これにより、実測比を基準比に速やかに近づけることができる。 According to the present invention, the rotation control unit controls the rotation of one of the left wheel and the right wheel based on the result of comparing the actual measurement ratio with the reference ratio. Thereby, the actual measurement ratio can be brought close to the reference ratio quickly.
好ましくは、本発明の車椅子はさらに、片側速度推定部を備える。片側速度推定部は、漕ぎ動作判定部により搭乗者が左車輪及び右車輪の一方を漕いだと判定された場合、漕ぎ動作が開始された後の当該一方の車輪の平均速度を推定する。回転制御部は、一方の車輪の速度が速度推定部により推定された平均速度となるように、一方の車輪の回転を制御する。 Preferably, the wheelchair of the present invention further includes a one-side speed estimation unit. The one-side speed estimation unit estimates an average speed of the one wheel after the rowing operation is started when it is determined by the rowing operation determination unit that the passenger has hit one of the left wheel and the right wheel. The rotation control unit controls the rotation of one wheel so that the speed of the one wheel becomes the average speed estimated by the speed estimation unit.
本発明によれば、搭乗者が左車輪及び右車輪の一方を漕いだと判定された場合、一方の車輪の平均速度が推定される。一方の車輪の回転は、推定された平均速度となるように制御される。これにより、搭乗者が意図的に一方の車輪のみを漕いだ場合であっても、搭乗者の意図する軌道に沿って車椅子を走行させることができる。 According to the present invention, when it is determined that the occupant scoops one of the left wheel and the right wheel, the average speed of one wheel is estimated. The rotation of one wheel is controlled so that the estimated average speed is obtained. As a result, even when the passenger intentionally hits only one wheel, the wheelchair can be driven along the track intended by the passenger.
好ましくは、回転制御部は、他方の車輪の速度が、搭乗者が漕ぎ動作を開始したときの速度となるように、他方の車輪の回転を制御する。 Preferably, the rotation control unit controls the rotation of the other wheel so that the speed of the other wheel becomes the speed when the passenger starts the rowing operation.
本発明によれば、他方の車輪の速度を、搭乗者が漕ぎ動作を開始したときの速度に維持される。このため、一方の車輪の回転のみを制御する場合に比べて、搭乗者の意図する軌道に沿って車椅子を走行させることが容易となる。 According to the present invention, the speed of the other wheel is maintained at the speed when the passenger starts the rowing operation. For this reason, compared with the case where only the rotation of one wheel is controlled, it becomes easier to run the wheelchair along the track intended by the passenger.
好ましくは、本発明の車椅子はさらに、加速度取得部を備える。加速度取得部は、車椅子の前後方向の加速度を取得する。漕ぎ動作判定部は、加速度取得部により前方向の加速度が所定期間継続して取得された場合、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する。 Preferably, the wheelchair of the present invention further includes an acceleration acquisition unit. The acceleration acquisition unit acquires the longitudinal acceleration of the wheelchair. The rowing motion determination unit determines whether or not the occupant scoops at least one of the left wheel and the right wheel when the acceleration acquisition unit continuously acquires the forward acceleration for a predetermined period.
本発明によれば、漕ぎ動作判定部は、前方向の加速度が所定期間継続して取得された場合、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する。左車輪及び右車輪の速度が変化するたびに、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定することがないため、左車輪及び右車輪の回転を安定的に制御できる。 According to the present invention, the rowing motion determination unit determines whether or not the passenger has hit at least one of the left wheel and the right wheel when the acceleration in the forward direction is continuously acquired for a predetermined period. Each time the speed of the left wheel and the right wheel changes, it is possible to stably control the rotation of the left wheel and the right wheel because the occupant does not determine whether or not the left wheel or the right wheel is scooped. .
好ましくは、漕ぎ動作判定部は、取得された左車輪の速度の変化を、搭乗者の所定の漕ぎ動作によって生じると予測される左車輪及び右車輪の速度の予測変化と比較することにより、搭乗者が左車輪を漕いだか否かを判定し、取得された右車輪の速度の変化を前記予測変化と比較することにより、搭乗者が前記右車輪を漕いだか否かを判定する。 Preferably, the rowing motion determination unit compares the obtained change in the speed of the left wheel with the predicted change in the speed of the left wheel and the right wheel predicted to be caused by a predetermined rowing motion of the occupant. It is determined whether or not the passenger has hit the left wheel, and by comparing the obtained change in the speed of the right wheel with the predicted change, it is determined whether or not the passenger has hit the right wheel.
本発明によれば、漕ぎ動作判定部は、左車輪及び右車輪の速度の変化を予測変化と比較することにより、搭乗者が左車輪を漕いだか否かを判定し、搭乗者が右車輪を漕いだか否かを判定する。これにより、左車輪に対する漕ぎ動作の有無と、右車輪に対する漕ぎ動作の有無を個別に判定できる。 According to the present invention, the rowing operation determination unit determines whether or not the passenger has hit the left wheel by comparing the change in the speed of the left wheel and the right wheel with the predicted change. Judge whether it is ugly. Thereby, the presence or absence of the rowing operation for the left wheel and the presence or absence of the rowing operation for the right wheel can be individually determined.
好ましくは、漕ぎ動作判定部は、相違度算出部と、相違度比較部とを備える。相違度算出部は、取得された左車輪の速度の変化と予測変化との第1相違度を算出し、取得された右車輪の速度の変化と予測変化との第2相違度を算出する。相違度比較部は、算出された第1相違度が所定の範囲に存在する場合、搭乗者が左車輪を漕いだと判定し、算出された第2相違度が所定の範囲に存在する場合、搭乗者が右車輪を漕いだと判定する。 Preferably, the rowing operation determination unit includes a difference degree calculation unit and a difference degree comparison unit. The difference calculation unit calculates a first difference between the acquired change in the speed of the left wheel and the predicted change, and calculates a second difference between the acquired change in the speed of the right wheel and the predicted change. The difference degree comparison unit determines that the passenger has scooped the left wheel when the calculated first difference degree is within a predetermined range, and when the calculated second difference degree is within the predetermined range, It is determined that the passenger has hit the right wheel.
本発明によれば、搭乗者が左車輪を漕いだか否かが、左車輪の速度の変化と予測変化との第2相違度に基づいて判定される。搭乗者が右車輪を漕いだか否かが、右車輪の速度の変化と予測変化との第2相違度に基づいて判定される。これにより、左車輪に対する漕ぎ動作の有無と、右車輪に対する漕ぎ動作の有無とを高い精度で判定できる。 According to the present invention, whether or not the occupant has hit the left wheel is determined based on the second difference between the change in the speed of the left wheel and the predicted change. Whether or not the passenger has hit the right wheel is determined based on the second difference between the change in the speed of the right wheel and the predicted change. Thereby, the presence or absence of the rowing operation for the left wheel and the presence or absence of the rowing operation for the right wheel can be determined with high accuracy.
好ましくは、相違度算出部は、複数の予測変化を取得し、第1相違度及び第2相違度を予測変化ごとに算出する。相違度比較部は、各予測変化に対応する第1相違度のうち最小の第1相違度が所定の範囲に存在する場合、搭乗者が左車輪を漕いだと判定し、各予測変化に対応する第2相違度のうち最小の第2相違度が所定の範囲に存在する場合、搭乗者が右車輪を漕いだと判定する。 Preferably, the difference calculation unit acquires a plurality of prediction changes and calculates a first difference and a second difference for each prediction change. The dissimilarity comparison unit determines that the passenger scoops the left wheel when the minimum first dissimilarity among the first dissimilarities corresponding to each predictive change is within a predetermined range, and responds to each predictive change If the minimum second dissimilarity among the second dissimilarities to be present is within a predetermined range, it is determined that the passenger has scooped the right wheel.
本発明によれば、第1相違度及び第2相違度を予測変化ごとに算出し、最小の第1相違度及び最小の第2相違度を用いて、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する。これにより、搭乗者が左車輪及び右車輪の少なくとも一方を漕いだか否かを判定する精度を向上させることができる。 According to the present invention, the first dissimilarity and the second dissimilarity are calculated for each predicted change, and the passenger uses at least the left wheel and the right wheel using the minimum first dissimilarity and the minimum second dissimilarity. It is determined whether or not one is crawled. As a result, it is possible to improve the accuracy of determining whether or not the occupant scoops at least one of the left wheel and the right wheel.
本発明のプログラムは、本発明の車椅子が備える制御装置に用いられる。 The program of this invention is used for the control apparatus with which the wheelchair of this invention is provided.
以下、図面を参照し、本発明の実施の形態を詳しく説明する。図中同一又は相当部分には同一符号を付してその説明は繰り返さない。 Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. In the drawings, the same or corresponding parts are denoted by the same reference numerals and description thereof will not be repeated.
{車椅子の構造}
図1は、本実施の形態による車椅子1の背面図である。図2は、車椅子1の左側面図である。図3は、車椅子1の上面図である。図1〜図3を参照して、車椅子1は、ブレーキ17a,17bが左車輪12a及び右車輪12bにそれぞれ取り付けられたパッシブ型車椅子である。車椅子1は、ブレーキ17a,17bを用いて左車輪12a及び右車輪12bの回転を制御することにより、走行経路を制御できる。
{Wheelchair structure}
FIG. 1 is a rear view of a
車椅子1は、シート11と、左車輪12aと、右車輪12bと、ハンドリム13a,13bと、キャスタ14a,14bと、フレーム15と、回転角センサ16a,16bと、ブレーキ17a,17bと、制御装置2とを備える。
The
フレーム15は、車椅子1の本体を形成する。フレーム15には、シート11と、左車輪12aと、右車輪12bと、キャスタ14a、14bとが取り付けられる。左車輪12aは、車椅子1の左後輪である。右車輪12bは、車椅子1の右後輪である。ハンドリム13aは、左車輪12aの外側に取り付けられる。ハンドリム13bは、右車輪12bの外側に取り付けられる。キャスタ14aは、車椅子1の左前輪である。キャスタ14bは、車椅子1の右前輪である。
The
搭乗者は、シート11に座り、ハンドリム13a,13bを回すことにより、車椅子1を前後に移動させる。すなわち、搭乗者は、ハンドリム13aを回すことにより、左車輪12aを漕ぐことができ、ハンドリム13bを回すことにより、右車輪12bを漕ぐことができる。
The passenger moves the
回転角センサ16aは、左車輪12aの回転軸に取り付けられ、左車輪12aの回転位置を検出する。回転角センサ16bは、右車輪12bの回転軸に取り付けられ、右車輪12bの回転位置を検出する。ブレーキ17aは、左車輪12aに取り付けられ、左車輪12aの回転を抑制するためのブレーキトルクを発生させる。ブレーキ17bは、右車輪12bに取り付けられ、右車輪12bの回転を抑制するためのブレーキトルクを発生させる。回転角センサ16a,16bと、ブレーキ17a,17bとは、図示しない配線によって、制御装置2と接続される。
The
制御装置2は、左車輪12a及び右車輪12bの速度の変化に応じて、ブレーキ17a,17bを制御する装置である。制御装置2は、シート11の下に取り付けられる。制御装置2は、たとえば、マイクロコンピュータである。制御装置2の詳細については、後述する。
The
{制御装置2の構成}
図4は、制御装置2の構成を示す機能ブロック図である。図4を参照して、制御装置2は、CPU(Central Processing Unit)21と、RAM(Random Access Memory)22と、インタフェース23と、フラッシュメモリ24とを備える。
{Configuration of control device 2}
FIG. 4 is a functional block diagram showing the configuration of the
CPU21は、フラッシュメモリ24に格納されたプログラムを実行する。RAM22は、制御装置2のメインメモリである。CPU21は、プログラムをRAM22にロードし、ロードされたプログラムを実行して制御装置2を制御する。
The
フラッシュメモリ24は、書き換え可能な不揮発性の半導体メモリであり、車椅子制御プログラム3と、速度検出プログラム4と、複数のモデル化データ5と、左速度データ6と、右速度データ7とを格納する。フラッシュメモリ24に格納される各種データは、プログラムの動作に応じて、RAM22にロードされる。
The
車椅子制御プログラム3は、速度検出プログラム4により取得される左車輪12a及び右車輪12bの速度に基づいて、搭乗者が左車輪12a及び右車輪12bの少なくとも一方を漕いだか否かを判定する。車椅子制御プログラム3は、判定結果に応じて、左車輪12a及び右車輪12bの少なくとも一方を制御する。
The
速度検出プログラム4は、回転角センサ16aから出力される回転位置に基づいて、左車輪12aの速度を取得し、回転角センサ16bから出力される回転位置に基づいて、右車輪12bの速度を取得する。速度検出プログラム4は、角速度を検出してもよいし、車輪の接線方向の速度(以下、「線速度」と呼ぶ。)を取得してもよい。以下、特に説明のない限り、速度検出プログラム4が、線速度を検出する場合を説明する。図2を参照して、速度VLは、速度検出プログラム4により取得された左車輪12aの線速度であり、速度VRは、速度検出プログラム4により取得された右車輪12bの線速度である。
The speed detection program 4 acquires the speed of the
モデル化データ5は、搭乗者の所定の漕ぎ動作によって生じると予測される速度VL,VRの変化(予測変化)を記録したデータである。各モデル化データ5は、互いに異なる複数種類の漕ぎ動作に対応する予測変化を記録している。モデル化データ5の詳細は、後述する。
Modeled
左速度データ6は、速度検出プログラム4に取得された速度VLを時系列に記録したデータである。右速度データ7は、速度検出プログラム4に取得された速度VRを時系列に記録したデータである。 The left speed data 6 is data in which the speed VL acquired by the speed detection program 4 is recorded in time series. Right velocity data 7 is a data recorded in the time series velocity V R obtained in the speed detection program 4.
{制御装置2の動作の概略}
以下、制御装置2の動作の概略を説明する。
{Outline of operation of control device 2}
Hereinafter, an outline of the operation of the
制御装置2は、回転角センサ16aから入力される左車輪12aの回転位置に基づいて、速度VLを取得する。制御装置2は、回転角センサ16bから入力される右車輪12bの回転位置に基づいて、速度VRを取得する。
The
制御装置2は、速度VLの変化とモデル化データ5に記録された予測変化との相違度を左車輪12aの相違度として算出する。左車輪12aの相違度が所定の範囲に存在する場合、制御装置2は、搭乗者が左車輪12aを漕いだと判定する。同様に、制御装置2は、速度VRの変化と予測変化との相違度を右車輪12bの相違度として算出する。右車輪12bの相違度が所定の範囲に存在する場合、制御装置2は、搭乗者が右車輪12bを漕いだと判定する。
The
制御装置2は、判定結果に応じて、左車輪12a及び右車輪12bの少なくとも一方の回転を制御する。たとえば、制御装置2は、左車輪12aの回転を制御する場合、ブレーキ17aのブレーキトルクを調整する。ブレーキ17a,17bのブレーキトルクを調整することにより、車椅子1の走行経路を制御することができる。
The
このように、制御装置2は、速度VL,VRの変化に基づいて、搭乗者が左車輪12a及び右車輪12bの少なくとも一方を漕いだか否かを判定する。制御装置2は、判定結果に応じて左車輪12a及び右車輪12bの少なくとも一方の回転を制御する。これにより、漕ぎ動作以外の要因で車椅子1が移動する場合であっても、車椅子1の動きを制御することができる。
Thus, the
たとえば、制御装置2は、搭乗者が左車輪12a及び右車輪12bを漕いでいないと判定した場合、左車輪12a及び右車輪12bの回転を停止させる。搭乗者が車椅子1を漕いでいないにもかかわらず、車椅子1が動き始めた場合(車椅子1が斜面を下り始めた場合など)に、車椅子1を強制的に停止させることができる。
For example, when it is determined that the passenger does not scoop the
また、制御装置2は、搭乗者が左車輪12a及び右車輪12bを漕いだと判定した場合、搭乗者が漕ぎ動作を開始した後の左車輪12a及び右車輪12bの平均速度を推定する。制御装置2は、速度VLと速度VRとの比(実測比)が、推定された左車輪12aの平均速度と推定された右車輪12bの平均速度との比(基準比)に一致するように、左車輪12a及び右車輪12bの回転を制御する。すなわち、制御装置2は、車椅子1が、基準比に基づいて定められる旋回半径に沿って曲がることができるように、左車輪12a及び右車輪12bの回転を制御する。これにより、制御装置2は、搭乗者の意図する経路に沿って、車椅子1を移動させることができる。
Further, when it is determined that the occupant scoops the
{漕ぎ動作の判定の原理}
以下、搭乗者が左車輪12a及び右車輪12bの少なくとも一方を漕いだか否かを判定する原理を説明する。制御装置2は、左車輪12a及び右車輪12bが漕がれたか否かを車輪ごとに個別に判定する。以下、左車輪12aを例にして説明する。
{Principle of rowing judgment}
Hereinafter, the principle of determining whether or not the passenger has scooped at least one of the
左車輪12aの位置を示すパラメータとして、x(t)を定義する。x(t)は、時刻tにおける、車椅子1が移動する平面100(図3参照)上での左車輪12aの位置(左車輪12aの重心の位置)を示す。
X (t) is defined as a parameter indicating the position of the
本実施の形態では、躍度最小軌道モデルを搭乗者の漕ぎ動作に適用する。制御装置2は、速度VLの変化を、躍度最小軌道モデルにより得られる車輪の速度変化と比較することによって、搭乗者が左車輪12aを漕いだか否かを判定する。なお、躍度最小軌道モデルにより得られる車輪の速度変化は、左車輪12a及び右車輪12bで共通である。
In the present embodiment, the minimum jerk trajectory model is applied to the passenger's rowing operation. The
躍度最小軌道モデルにおいて、x(t)は、(式1)に示すように、評価関数Cjを最小にする関数として定義される。(式1)において、tfは、漕ぎ動作に要する時間である。d3(x)/dt3は、躍度である。
評価関数Cjが最小となる極値を有する場合、x(t)は、オイラーポアソン方程式を満たすため、x(t)は、(式2)で表わされる。(式2)より、x(t)は、5次式で表わされる。
次に、x(t)を(式2)から求めるための条件を設定する。搭乗者が、停止している車椅子1を漕ぎ、所望の位置に車椅子1を停止させると仮定する。つまり、搭乗者は、左車輪12aを回転させる動作と、左車輪12aの回転を停止させる動作とを、連続して行う。この仮定に基づいて、搭乗者が漕ぎ動作を開始したとき(t=0)における左車輪12aの位置をx0と設定し、搭乗者が漕ぎ動作を終了したとき(t=tf)における左車輪12aの位置をxfと設定する。漕ぎ動作の開始時(t=0)及び終了時(t=tf)における、左車輪12aの速度及び接線方向の加速度を0に設定する。
Next, conditions for determining x (t) from (Equation 2) are set. It is assumed that the passenger rides the
(式2)をこれらの設定の下で解くことにより、x(t)は、(式3)、(式4)で表わされる。
(式3)及び(式4)において、x0,xf,tfが、漕ぎ動作を特定するためのパラメータとなる。(式3)及び(式4)により示される車椅子1の予測軌道(躍度最小軌道モデルに基づく軌道)をx(xf,tf)(t)と定義する。また、左車輪12aの実際の軌道(実測軌道)をxreal(t)と定義する。下記(式5)に示すように、実測軌道xreal(t)を予測軌道x(xf,tf)(t)から差し引いた値の絶対値を積分する。(式5)により得られる積分値は、実測軌道が予測軌道と相違する度合いを示す。
積分値が予め定められた基準値よりも小さい場合、実測軌道が予測軌道に整合すると判定される。つまり、左車輪12aは、漕ぎ動作により移動したと判定される。積分値が基準値以上である場合、実測軌道は、予測軌道と整合しないと判定される。つまり、左車輪12aは、漕ぎ動作以外の要因により移動したと判定される。
When the integral value is smaller than a predetermined reference value, it is determined that the actually measured trajectory matches the predicted trajectory. That is, it is determined that the
各モデル化データ5に記録される左車輪12aの速度の変化(予測変化)を、上述した予測軌道から計算することができる。したがって、(式5)において、予測軌道x(xf,tf)(t)を予測変化に置き換え、実測軌道xreal(t)を速度VLの変化に置き換えることにより、積分値は、速度VLの変化と予測変化との相違度を示す。速度VLの変化と予測変化との相違度に基づいて、速度VLが漕ぎ動作により変化したか否かを判定することができる。
A change (predicted change) in the speed of the
様々なxf,tfを設定することにより、互いに異なる複数の予測軌道を計算できる。つまり、搭乗者が左車輪12aを強く漕いだり、弱い力でゆっくり漕いだりした場合など、搭乗者の様々な動作に応じた複数の予測軌道を計算できる。これらの予測軌道から、搭乗者の様々な動作に応じた複数の予測変化を計算できる。このようにして計算された複数の予測変化が、各モデル化データ5に記録される。
A plurality of different predicted trajectories can be calculated by setting various x f and t f . That is, a plurality of predicted trajectories can be calculated according to various movements of the passenger, such as when the passenger hits the
制御装置2は、複数のモデル化データ5を用いて、搭乗者が左車輪12aを漕いだか否かを判定する。制御装置2は、各モデル化データ5を用いて算出された複数の左車輪12aの相違度の中で、最小の相違度を選択する。最小の相違度がしきい値よりも小さければ、制御装置2は、搭乗者が左車輪12aを漕いだと判定する。
The
制御装置2は、搭乗者が右車輪12bを漕いだか否かを判定するときにも、左車輪12aと共通のモデル化データ5を使用する。右車輪12bの物理特性(半径など)は、左車輪12aの物理的特性が同じであるため、左車輪12aと同じ予測軌道が得られるためである。
The
{実測変化と予測変化との比較}
図5A及び図5Bは、漕ぎ動作により車椅子1が右旋回したときにおける各車輪の速度の変化を示すグラフである。図5Aは、左車輪12aの速度VLの変化を示す。図5Bは、右車輪12bの速度VRの変化を示す。図5A及び図5Bにおいて、速度VL,VRを実線で示し、予測変化を破線で示す。
{Comparison between actual and predicted changes}
5A and 5B are graphs showing changes in the speed of each wheel when the
図5A及び図5Bを参照して、車椅子1が右旋回しているため、速度VLが、速度VRよりも大きくなる。また、速度VL,VRが、予測変化にほぼ整合している。
With reference to FIGS. 5A and 5B, since the
なお、図5Aを参照して、1.75〜3.0秒の期間において、速度VLが、予測変化を上回る傾向にある。この理由は、躍度最小軌道モデルにおいて、搭乗者が左車輪12aを停止させる動作を行うことが考慮されているのに対して、実際の車椅子1の操作では、搭乗者が、車椅子1を漕ぐたびに、車輪を停止させることがないためである。図5Bを参照して、実測変化は、全ての期間において、予測変化を下回る傾向にある。この理由は、搭乗者が、車椅子1を右旋回させるために、右車輪12bの回転を抑制しようとしているためであると考えられる。
In addition, with reference to FIG. 5A, in the period of 1.75 to 3.0 seconds, the speed VL tends to exceed the predicted change. This is because, in the minimum jerk trajectory model, it is considered that the occupant performs an operation of stopping the
制御装置2は、速度VL,VRの立ち上がり期間(図5A及び図5Bに示す例では、0.1〜0.2秒の期間)に、速度VL,VRを予測変化と比較して相違度を算出する。この期間では、速度VL,VRは、予測変化にほぼ一致しているため、制御装置2は、速度VL,VRが漕ぎ動作により変化したか否かを高い精度で判定できる。
The
なお、搭乗者が左車輪12a及び右車輪12bを漕いで車椅子1を直進させる場合、速度VL,VRの比は、ほぼ1対1となる。速度VL,VRは、同一の予測変化に整合する。
Incidentally, if the rider is straight the
以下、制御装置2の動作について詳しく説明する。
Hereinafter, the operation of the
{各車輪の速度及び車椅子1の加速度の算出}
図6は、速度検出プログラム4のフローチャートである。以下、図6を参照して、速度検出プログラム4を実行する制御装置2の動作を説明する。
{Calculation of wheel speed and
FIG. 6 is a flowchart of the speed detection program 4. The operation of the
制御装置2は、左車輪12aの回転位置が回転角センサ16aから入力された場合(ステップS21においてYes)、入力された回転位置に基づいて、速度VLを計算する(ステップS22)。具体的には、制御装置2は、直前に入力された回転位置と、新たに入力された回転位置とから、左車輪12aの回転角の変化を算出する。制御装置2は、算出された回転角の変化と、回転位置との入力間隔と、左車輪12aの半径とから、速度VLを算出する。制御装置2は、算出された速度VLを左速度データ6に記録する(ステップS23)。
When the rotation position of the
一方、制御装置2は、左車輪12aの回転位置が入力されない場合(ステップS21においてNo)、右車輪12bの回転位置が回転角センサ16bから入力されたか否かを確認する(ステップS24)。右車輪12bの回転位置が入力されない場合(ステップS24においてNo)、制御装置2は、ステップS21に戻る。
On the other hand, when the rotation position of the
制御装置2は、右車輪12bの回転位置が入力された場合(ステップS24においてYes)、速度VRを算出する(ステップS25)。ステップS25の処理は、ステップS22の処理と同様である。制御装置2は、算出された速度VRを、右速度データ7に記録する(ステップS26)。
制御装置2は、ステップS23又はステップS26の後に、車椅子1の加速度を算出する(ステップS27)。具体的には、制御装置2は、左速度データ6に記録された過去2つの速度から、左車輪12aの矢印A方向(図3参照)の加速度を算出する。同様に、右車輪12bの加速度が算出される。制御装置2は、左車輪12a及び右車輪12bの加速度の平均値を、車椅子1の加速度として算出する。車椅子1の加速度は、RAM22に時系列に記録される。
The
制御装置2は、車椅子1の加速度を算出した後に、ステップS21に戻る。制御装置2は、電源が入力されている間、ステップS21〜S27の処理を繰り返し実行する。
After calculating the acceleration of the
{車輪の回転制御}
図7は、車椅子制御プログラム3のフローチャートである。以下、図7を参照して、車椅子制御プログラム3を実行する制御装置2の動作を説明する。制御装置2は、車椅子1が停止しているときに、車椅子制御プログラム3を開始すると仮定する。また、制御装置2は、車椅子制御プログラム3と並行して、速度検出プログラム4を実行している。
{Wheel rotation control}
FIG. 7 is a flowchart of the
制御装置2は、RAM22に記録された加速度を参照して、車椅子1の前方向(矢印A方向)の加速度がΔt1の期間継続して検出されたか否かを確認する(ステップS1)。Δt1は、たとえば、0.1秒である。
The
前方向の加速度が継続して検出された場合(ステップS1においてYes)、制御装置2は、搭乗者が車椅子1を漕いだ可能性があると判断し、ブレーキを解除する(ステップS2)。具体的には、制御装置2は、ブレーキの解除を指示する制御信号を、ブレーキ17a,17bに出力する。これにより、制御装置2は、ブレーキ17a,17bの影響を受けることなく、速度VL,VRを検出できる。
When forward acceleration is continuously detected (Yes in step S1), the
制御装置2は、マッチング処理(ステップS3)を実行することにより、複数のモデル化データ5に記録された予測変化の中から、速度VLの変化に最も整合する予測変化と、速度VRの変化に最も整合する予測変化とを決定する。
次に、制御装置2は、マッチング処理(ステップS3)の結果に基づいて、搭乗者が車椅子1を漕いだか否かを判定する(ステップS4)。搭乗者が車椅子1を漕いだと判定された場合、制御装置2は、左車輪12a及び右車輪12bの少なくとも一方の回転を制御する軌道制御処理を実行する(ステップS5)。これにより、制御装置2は、搭乗者の意図に応じた軌道に沿って、車椅子1を走行させることができる。搭乗者が車椅子1を漕いでいないと判定された場合、制御装置2は、車椅子1を緊急停止させる(ステップS45)。漕ぎ動作判定処理(ステップS4)の詳細は、後述する。
Next, based on the result of the matching process (step S3), the
制御装置2は、前方向の加速度をΔt1の期間継続して検出するまで(ステップS6においてYes)、軌道制御処理(ステップS5)を繰り返し実行する。搭乗者が車椅子1を漕ぐなどして、前方向への加速が新たに検出された場合(ステップS6においてYes)、制御装置2は、搭乗者が車椅子1を新たに漕いだかどうかを判定するために、ステップS2に戻る。
The
以下、車椅子制御プログラム3の各ステップを詳しく説明する。
Hereinafter, each step of the
{マッチング処理(ステップS3)}
図8は、図5Aに示すグラフの拡大図であり、0〜0.5秒の期間の速度VLの変化を示している。図8を参照して、期間Δt1(0〜0.1秒)は、前方向の加速度を検出するための期間である(ステップS1、図7参照)。0.1秒よりも後の期間において、ブレーキ17a,17bは、解除される(ステップS2)。制御装置2は、期間Δt1以降の車輪の速度を用いて、相違度を算出する。
{Matching process (step S3)}
FIG. 8 is an enlarged view of the graph shown in FIG. 5A, and shows the change in the speed VL during the period of 0 to 0.5 seconds. Referring to FIG. 8, a period Δt1 (0 to 0.1 second) is a period for detecting the acceleration in the forward direction (see step S1 and FIG. 7). In a period after 0.1 second, the
図9は、マッチング処理(ステップS3)のフローチャートである。制御装置2は、期間Δt2における速度VLを左速度データ6から取得し、期間Δt2における速度VRを右速度データ7から取得する(ステップS31)。また、制御装置2は、複数のモデル化データ5をフラッシュメモリ24からRAM22にロードすることにより、複数のモデル化データ5を取得する。ブレーキ17a,17bは、既に解除されているため(ステップS2)、期間Δt2における速度VL,VRは、ブレーキの影響を受けていない。
FIG. 9 is a flowchart of the matching process (step S3).
制御装置2は、全てのモデル化データ5を用いて相違度を計算したか否かを確認する(ステップS32)。制御装置2は、全てのモデル化データ5を使用していない場合(ステップS32においてNo)、相違度の計算に使用していないモデル化データ5を選択する(ステップS33)。
The
制御装置2は、期間Δt2における速度VLの変化と、選択されたモデル化データ5に記録されている予測変化との相違度を計算する(ステップS34)。モデル化データ5には、期間Δt2(t=0.1〜0.2秒)に対応する予測変化が記録されている。制御装置2は、速度VLを予測変化から差し引いた値の絶対値を合計することにより、相違度を算出する。制御装置2は、期間Δt2における速度VRの変化と、選択されたモデル化データ5に記録されている予測変化との相違度を計算する(ステップS35)。ステップS35の処理は、速度VRが用いられる点を除き、ステップS34と同様である。
The
制御装置2は、全てのモデル化データ5を使用するまで(ステップS32においてYes)、ステップS33〜S35を繰り返す。これにより、複数の左車輪12aの相違度と、複数の右車輪12bの相違度とが計算される。
The
制御装置2は、全てのモデル化データ5を使用した場合(ステップS32においてYes)、複数の左車輪12aの相違度の中から、最小の相違度(以下、「左最小相違度」と呼ぶ。)を選択する(ステップS36)。制御装置2は、複数の右車輪12bの相違度の中から、最小の相違度(以下、「右最小相違度」と呼ぶ。)を選択する。
When all the modeled
{漕ぎ動作判定処理(ステップS4)}
以下、図7を参照して、漕ぎ動作判定処理(ステップS4)を説明する。制御装置2は、マッチング処理(ステップS3)により選択された左最小相違度及び右最小相違度を、予め設定されたしきい値と比較する(ステップS41〜S43)。
{Rowing operation determination process (step S4)}
Hereinafter, the rowing operation determination process (step S4) will be described with reference to FIG. The
左最小相違度及び右最小相違度の両者がしきい値以上である場合(ステップS41においてYes)、制御装置2は、速度VL,VRの変化が躍度最小軌道モデルに整合しないと判断する。制御装置2は、速度VL,VRが搭乗者の漕ぎ動作以外の要因により変化したと判断し、車椅子1を緊急停止させる(ステップS45)。制御装置2は、最大のブレーキトルクを指示する信号をブレーキ17a,17bに出力する。
Determining if both of the left minimum dissimilarity and right minimum dissimilarity is equal to or greater than the threshold value (Yes in step S41),
右最小相違度のみがしきい値以上である場合(ステップS41においてNo、ステップS42においてYes)、制御装置2は、搭乗者が左車輪12aのみを漕いだと判定し、ステップS46を実行する。左最小相違度のみがしきい値以上である場合(ステップS41においてNo、ステップS42においてNo、ステップS43においてYes)、制御装置2は、搭乗者が右車輪12bのみを漕いだと判定し、ステップS47を実行する。ステップS46,S47の詳細は、後述する。
When only the right minimum dissimilarity is equal to or greater than the threshold value (No in step S41, Yes in step S42),
左最小相違度及び右最小相違度の両者がしきい値よりも小さい場合(ステップS41においてNo、ステップS42においてNo、ステップS43においてNo)、制御装置2は、搭乗者が左車輪12a及び右車輪12bを漕いだと判定する。制御装置2は、左車輪12a及び右車輪12bの平均速度を推定し、基準比を算出する(ステップS44)。基準比は、推定された左車輪12aの平均速度と、推定された右車輪12bの平均速度との比である。
When both of the left minimum dissimilarity and the right minimum dissimilarity are smaller than the threshold values (No in step S41, No in step S42, No in step S43), the
左車輪12aを例にして、平均速度の推定方法を詳しく説明する。各モデル化データ5は、躍度最小軌道モデルのパラメータxf,tfを記録している。xfは、搭乗者が漕ぎ動作を終了した時刻(t=tf)における車輪の位置である。
The method for estimating the average speed will be described in detail using the
制御装置2は、左最小相違度に対応するモデル化データ5から、xf,tfを抽出する。以下、左最小相違度に対応するモデル化データ5から抽出されたxf,tfを、xL_f,tL_fと記述する。制御装置2は、(式6)を用いて、左車輪12aの平均速度VL_estを推定する。
同様に、右車輪12bの平均速度VR_estは、(式7)で表わされる。(式7)において、xR_f,tR_fは、右最小相違度に対応するモデル化データ5から抽出されたxf,tfである。
制御装置2は、算出された平均速度VL_est,VR_estを用いて、基準比を算出する。基準比は、(式8)により求められる。(式8)において、DSは、基準比を示す。平均速度VL_est,VR_est及び基準比Dsは、軌道制御処理(ステップS5)で用いられる。
右最小相違度のみがしきい値以上である場合(ステップS42においてYes)、制御装置2は、ステップS46を実行する。制御装置2は、(式6)を用いて、平均速度VL_estを推定する。制御装置2は、モデル化データ5を用いて平均速度VR_estを推定できない。このため、制御装置2は、漕ぎ動作が開始されたとき(t=0秒)の速度VRを、平均速度VR_estに設定する。制御装置2は、(式8)を用いて、基準比Dsを算出する。なお、制御装置2は、平均速度VR_estとして、漕ぎ動作が開始されてから(t=0)、相違度の計算に用いられる速度VRの取得が終了するまで(t=0.2秒)のいずれかの速度VRを設定すればよい。
When only the right minimum dissimilarity is equal to or greater than the threshold value (Yes in step S42),
左最小相違度のみがしきい値以上である場合(ステップS43においてYes)、制御装置2は、ステップS47を実行する。制御装置2は、(式7)を用いて、平均速度VR_estを推定する。制御装置2は、モデル化データ5を用いて平均速度VL_estを推定できない。このため、制御装置2は、漕ぎ動作が開始されたとき(t=0秒)の速度VLを、平均速度VL_estに設定する。制御装置2は、(式8)を用いて、基準比Dsを算出する。なお、制御装置2は、平均速度VL_estとして、0〜0.2秒の期間のいずれかの速度VLを設定すればよい。
When only the left minimum dissimilarity is greater than or equal to the threshold value (Yes in step S43),
{軌道制御処理(ステップS5)}
以下、平均速度VL_est,VR_estが、ステップS44の処理により推定された場合を例にして、軌道制御処理(ステップS5)を説明する。
{Orbit control processing (step S5)}
Hereinafter, the trajectory control process (step S5) will be described by taking as an example the case where the average speeds V L_est and V R_est are estimated by the process of step S44.
最初に、搭乗者の意図する軌道を、基準比Dsに基づいて特定できる原理を説明する。図10は、車椅子1が左方向に旋回する場合における、速度VL,VRと、車椅子1の旋回半径Raとの関係を示す図である。図10を参照して、Tは、左車輪12aと右車輪12bとの距離を示す。図10に示す車椅子1は、図3に示す上面図に対応する。この場合、車椅子1の旋回半径Raは、(式9)で表わされる。
距離Tは固定値であるため、旋回半径Raは、速度VL,VRに依存する。すなわち、速度VLと速度VRとの比が一定であれば、車椅子1は、速度VL又は速度VRが変化したとしても、旋回半径Raを維持することができる。制御装置2は、速度VLと速度VRとの比を基準比に一致させるように、ブレーキ17a,17bを制御する。これにより、制御装置2は、車椅子1を、搭乗者の意図する旋回半径Raで走行させることができる。
Since the distance T is a fixed value, the turning radius R a, the velocity V L, it depends on V R. That is, if the ratio between the velocity V L and the speed V R is constant, the
図11は、軌道制御処理(ステップS5)のフローチャートである。図11を参照して、制御装置2は、実測比Dcを算出する(ステップS51)。実測比Dcは、現在の速度VLと現在の速度VRとの比である。実測比Dcは、(式10)で表わされる。
制御装置2は、実測比Dcを基準比Dsと比較して、左車輪12a及び右車輪12bのいずれを制御するかを決定する(ステップS52)。つまり、制御装置2は、実測比Dcを基準比Dsに一致させるためには、左車輪12a及び右車輪12bのいずれにブレーキをかける必要があるかを判定する。
制御装置2は、基準比Dsが実測比Dcよりも大きい場合、速度VLが過剰であると判定する。制御装置2は、速度VLを抑制するために、ブレーキ17aを制御することを決定する。つまり、左車輪12aが、制御対象として決定される。一方、制御装置2は、基準比Dsが実測比Dcよりも小さい場合、速度VRが過剰であると判定する。制御装置2は、速度VRを抑制するために、ブレーキ17bを制御することを決定する。つまり、右車輪12bが、制御対象として決定される。
The
右車輪12bが制御対象に決定された場合(ステップS53においてYes)、制御装置2は、右車輪12bの目標速度VR_refを決定する(ステップS54)。目標速度VR_refは、(式11)で表わされる。
(式11)において、速度VLが、左車輪12aの目標速度VL_refとして代入される。速度VLを基準比Dsの逆数に乗算することにより、目標速度VR_refを算出することができる。制御装置2は、算出された目標速度VR_refを用いて、ブレーキ17bを制御する(ステップS55)。制御装置2は、算出された目標速度VR_refに基づいて、ブレーキ17bのブレーキトルクを決定し、決定したブレーキトルクに対応する制御信号をブレーキ17bに出力する。
In (Equation 11), the speed V L is substituted as the target speed V L_ref the
一方、左車輪12aが制御対象に決定された場合(ステップS53においてNo)、制御装置2は、目標速度VL_refを決定する(ステップS56)。目標速度VL_refは、(式12)で表わされる。
(式12)において、速度VRが、目標速度VR_refとして代入される。速度VLを基準比Dsに乗算することにより、目標速度VL_refを算出することができる。制御装置2は、算出された目標速度VL_refを用いて、ブレーキ17aを制御する(ステップS57)。制御装置2は、算出された目標速度VL_refに基づいて、ブレーキ17aのブレーキトルクを決定し、決定したブレーキトルクに対応する制御信号をブレーキ17aに出力する。
In (Equation 12), the speed V R is substituted as the target speed V R_ref. By multiplying the speed V L by the reference ratio D s , the target speed V L_ref can be calculated. The
前方向の加速度が継続して検出されるまで(ステップS6においてYes,図6参照)、軌道制御処理(ステップS5)が繰り返し実行される。制御装置2は、フィードバック制御により、実測比Dcを基準比Dsに近づけることにより、搭乗者の意図する軌道に沿って、車椅子1を走行させることができる。
The trajectory control process (step S5) is repeatedly executed until the forward acceleration is continuously detected (Yes in step S6, see FIG. 6). The
前方向の加速度が継続して検出された場合、制御装置2は、マッチング処理(ステップS3)を新たに実行する。このとき、マッチング処理を開始(t=0.1秒)するときの速度VL,VRが、モデル化データ5に記録される予測変化の初期速度(V=0)に一致しない場合がある。この場合、制御装置は、t=0.1秒における速度VL,VRを予測変化に加算して、マッチング処理を実行する。
When forward acceleration is continuously detected, the
また、搭乗者が左車輪12aのみを漕いだと判定した場合、搭乗者が右車輪12bのみを漕いだと判定した場合も同様の処理が実行される。これにより、搭乗者が一方の車輪を漕いだ場合であっても、制御装置2は、搭乗者の意図する経路に沿って車椅子1を走行させることができる。車椅子が斜面を水平に走行しているときに、搭乗者が左車輪12a及び右車輪12bのいずれか一方を漕ぐことが考えられる。このような場合に、制御装置2は、実測比Dcを基準比Dsに近づけるように、左車輪12a及び右車輪12bの回転を制御することにより、搭乗者の意図に沿った経路で車椅子1を走行させることができる。
The same process is also executed when it is determined that the passenger has scooped only the
以上説明したように、制御装置2は、速度VL,VRの変化が躍度最小軌道モデルに整合するかどうかを判定する。これにより、搭乗者が車椅子1を漕いでいないときに、車椅子1が移動を開始したとしても、車椅子1を適切に制御できる。また、制御装置2は、搭乗者が左車輪12a及び右車輪12bの少なくとも一方を漕いだと判定した場合、実測比Dcを基準比Dsに近づけるように、左車輪12a及び右車輪12bの少なくとも一方の回転を制御する。これにより、制御装置2は、搭乗者の意図する軌道に沿って、車椅子1を走行させることができる。
As described above, the
なお、上記実施の形態において、搭乗者が左車輪12aのみを漕いだと判定した場合(ステップS42においてYes)、又は、搭乗者が右車輪12bのみを漕いだと判定した場合(ステップS43においてYes)、基準比Dsが算出される例を説明したが、これに限られない。この場合、制御装置2は、搭乗者により漕がれた一方の車輪を平均速度に維持するようにブレーキを制御してもよい。他方の車輪の速度は、ユーザが漕ぎ動作を介したときの速度に維持される。たとえば、搭乗者が車椅子1を左方向に急旋回させる場合、左車輪12aはほとんど回転しないため、基準比Dsを算出することができないと考えられる。このように、制御装置2は、基準比Dsを算出することなく、車輪の回転を制御してもよい。
In the above-described embodiment, when it is determined that the passenger scoops only the
上記実施の形態において、車椅子1が、ブレーキ17a,17bを備える例を説明したが、これに限られない。車椅子1は、ブレーキ17a,17bに代えて、左車輪12a及び右車輪12bをそれぞれ駆動させるモータを備えてもよい。あるいは、ブレーキ及びモータが、左車輪12a及び右車輪12bのそれぞれに取り付けられてもよい。つまり、制御装置2は、ブレーキ又はモータを制御することにより、左車輪12a及び右車輪12bの回転を制御することができればよい。
In the said embodiment, although the
上記実施の形態において、制御装置2は、マッチング処理(ステップS3)の結果に応じて、緊急停止(ステップS45)又は軌道制御処理(ステップS5)を実行する例を説明したが、これに限られない。たとえば、車椅子制御プログラム3において、軌道制御処理(ステップS5)を省略してもよい。この場合、制御装置2は、左最小相違度及び右最小相違度がしきい値以上である場合に限り(ステップS41においてYes)、左車輪12a及び右車輪12bの回転を制御して、車椅子1を緊急停止させる(ステップS45)。これにより、車椅子1が搭乗者の意図に関係なく動き出すことを防止できる。あるいは、制御装置2は、緊急停止(ステップS45)を省略してもよい。
In the said embodiment, although the
上記実施の形態において、制御装置2は、回転角センサ16a,16bを用いて、速度VL,VRを取得する例を説明したが、これに限られない。制御装置2は、回転角センサ16a,16bに代えて、左車輪12a及び右車輪12bに角速度センサをそれぞれ取り付けてもよい。この場合であっても、制御装置2は、速度VL,VRを取得することができる。
In the above embodiment, the
上記実施の形態において、制御装置2は、左車輪12a及び右車輪12bの線速度を用いて、左車輪12a及び右車輪12bの回転を制御する例を説明したが、これに限られない。制御装置2は、左車輪12a及び右車輪12bの角速度を用いて、左車輪12a及び右車輪12bの回転を制御してもよい。
In the said embodiment, although the
上記実施の形態において、制御装置2は、軌道制御処理(ステップS5)を実行するときに、左車輪12a及び右車輪12bのいずれか一方の回転を制御する例を説明した。しかし、制御装置2は、左車輪12a及び右車輪12bの両者の回転を制御することによって、実測比Dcを基準比Dsに近づけてもよい。
In the said embodiment, when the
上記実施の形態において、制御装置2は、左最小相違度及び右最小相違度がしきい値よりも小さい場合(ステップS43においてNo)、実測比Dcが基準比Dsに一致するように、左車輪12a及び右車輪12bの一方の車輪の回転を制御する例を説明した(ステップS5)。しかし、制御装置2は、左最小相違度及び右最小相違度がしきい値よりも小さい場合(ステップS43においてNo)、軌道制御処理(ステップS5)において、下記の処理を実行してもよい。制御装置2は、左車輪12aの速度VLが平均速度VL_estとなるようにブレーキ17aを制御し、右車輪12bの速度VRが平均速度VR_estとなるようにブレーキ17bを制御する。すなわち、制御装置2は、搭乗者が左車輪12a及び右車輪12bを漕いだと判定した場合(ステップS43においてNo)、平均速度VL_est,VR_estを用いて、左車輪12a及び右車輪12bの少なくとも一方の回転を制御すればよい。
In the above embodiment, the
上記実施の形態において、予測変化が、躍度最小軌道モデルにより得られる例を説明したが、躍度最小軌道モデル以外のモデルを用いて、予測変化を計算してもよい。つまり、予測変化は、搭乗者の漕ぎ動作をモデル化した関数により得ることができればよい。 In the above embodiment, an example in which the predicted change is obtained by the minimum jerk trajectory model has been described. However, the predictive change may be calculated using a model other than the minimum jerk trajectory model. That is, it is only necessary that the predicted change can be obtained by a function modeling the passenger's rowing motion.
上記実施の形態において、制御装置2は、左車輪12aの相違度を算出し(ステップS34)、左車輪12aの相違度に基づいて、搭乗者が左車輪12aを漕いだか否かを判定する例を説明した(ステップS4)。しかし、制御装置2は、相違度を算出する方法以外の方法を用いて、搭乗者が左車輪12aを漕いだか否かを判定してもよい。たとえば、制御装置2は、速度VLの変化に整合する予測変化を、最小二乗法を用いて特定することができた場合、搭乗者が左車輪12aを漕いだと判定してもよい。すなわち、制御装置2は、速度VLの変化を予測変化と比較することにより、搭乗者が左車輪12aを漕いだか否かを判定すればよい。右車輪12bについても同様である。
In the above embodiment, the
上記実施の形態において、制御装置2は、フラッシュメモリ24に記憶されているモデル化データ5を取得する例を説明した。しかし、制御装置2は、予め設定された関数を用いて、予測変化を生成してもよい。たとえば、制御装置2には、搭乗者の漕ぎ動作をモデル化することにより得られた関数f(t)が設定されている。制御装置2は、期間Δt2における予測変化を関数f(t)から生成し、生成した予測変化を速度VL,VRと比較すればよい。この場合、フラッシュメモリ24は、複数種類の関数f(t)を記憶してもよい。あるいは、フラッシュメモリ24は、1つの関数f(t)を記憶し、関数f(t)に含まれる定数に関して、様々な値を記憶してもよい。この場合、制御装置2は、複数の予測変化を1つの関数f(t)から取得することができる。
In the above-described embodiment, the example in which the
上記実施の形態において、車椅子制御プログラム3及び速度検出プログラム4が、マイクロコンピュータにインストールされている例を説明した。これらのプログラムをインストールする方法は、特に限定されない。たとえば、車椅子制御プログラム3は、ネットワークに接続されたサーバからダウンロードされ、マイクロコンピュータにインストールされてもよい。あるいは、車椅子制御プログラム3を記録したコンピュータ読み取り可能な媒体(たとえば、光ディスク、USB(Universal Serial Bus)メモリ、フレキシブルディスクなど)が配布されている場合、車椅子制御プログラム3は、その媒体からマイクロコンピュータにインストールされてもよい。
In the said embodiment, the
上記実施の形態において、制御装置2がマイクロコンピュータである場合を例に説明したが、これに限られない。制御装置2は、ハードウェア回路により構成されてもよい。
In the above embodiment, the case where the
以上、本発明の実施の形態を説明したが、上述した実施の形態は本発明を実施するための例示に過ぎない。よって、本発明は上述した実施の形態に限定されることなく、その趣旨を逸脱しない範囲内で上述した実施の形態を適宜変形して実施することが可能である。 While the embodiments of the present invention have been described above, the above-described embodiments are merely examples for carrying out the present invention. Therefore, the present invention is not limited to the above-described embodiment, and can be implemented by appropriately modifying the above-described embodiment without departing from the spirit thereof.
1 車椅子
2 制御装置
3 車椅子制御プログラム
4 速度検出プログラム
5 モデル化データ
12a 左車輪
12b 右車輪
13a,13b ハンドリム
16a,16b 回転角センサ
17a,17b ブレーキ
DESCRIPTION OF
Claims (12)
前記左車輪の速度を取得する第1速度取得部と、
前記右車輪の速度を取得する第2速度取得部と、
前記第1速度取得部により取得された左車輪の速度の変化を、前記搭乗者の所定の漕ぎ動作によって生じると予測される前記左車輪及び前記右車輪の速度の予測変化と比較することにより、前記搭乗者が前記左車輪を漕いだか否かを判定し、前記第2取得部により取得された右車輪の速度の変化を前記予測変化と比較することにより、前記搭乗者が前記右車輪を漕いだか否かを判定する漕ぎ動作判定部と、
前記漕ぎ動作判定部による判定結果に応じて、前記左車輪及び前記右車輪の少なくとも一方の回転を制御する回転制御部とを備える車椅子。 A wheelchair comprising a left wheel and a right wheel that rotate in response to a passenger's rowing operation,
A first speed acquisition unit for acquiring the speed of the left wheel;
A second speed acquisition unit for acquiring the speed of the right wheel;
By comparing the change in the speed of the left wheel acquired by the first speed acquisition unit with the predicted change in the speed of the left wheel and the right wheel predicted to be caused by the predetermined rowing operation of the occupant, It is determined whether or not the passenger has hit the left wheel, and the change in the speed of the right wheel acquired by the second acquisition unit is compared with the predicted change, so that the passenger can hit the right wheel. A rowing motion determination unit for determining whether or not
A wheelchair comprising: a rotation control unit that controls rotation of at least one of the left wheel and the right wheel according to a determination result by the rowing operation determination unit.
前記回転制御部は、前記漕ぎ動作判定部により前記搭乗者が前記左車輪及び前記右車輪を漕いでいないと判定された場合、前記左車輪及び前記右車輪の回転を停止させる、車椅子。 The wheelchair according to claim 1,
The rotation control unit is a wheelchair that stops rotation of the left wheel and the right wheel when the rowing operation determination unit determines that the occupant is not stroking the left wheel and the right wheel.
前記漕ぎ動作判定部により前記搭乗者が前記左車輪及び前記右車輪を漕いだと判定された場合、前記漕ぎ動作が開始された後の前記左車輪及び前記右車輪の平均速度を推定する両側速度推定部を備え、
前記回転制御部は、前記推定された左車輪の平均速度と前記推定された右車輪の平均速度とを用いて、前記左車輪及び前記右車輪の少なくとも一方の回転を制御する、車椅子。 The wheelchair according to claim 1 or 2, further comprising:
Both-side speeds for estimating an average speed of the left wheel and the right wheel after the rowing operation is started when it is determined by the rowing operation determination unit that the passenger has hit the left wheel and the right wheel. With an estimator,
The rotation control unit controls a rotation of at least one of the left wheel and the right wheel by using the estimated average speed of the left wheel and the estimated average speed of the right wheel.
前記回転制御部は、前記取得された左車輪の速度と前記取得された右車輪の速度との実測比が、前記推定された左車輪の平均速度と前記推定された右車輪の平均速度との基準比に一致するように、前記左車輪及び前記右車輪の少なくとも一方の回転を制御する、車椅子。 A wheelchair according to claim 3,
The rotation control unit is configured so that an actual measurement ratio between the acquired speed of the left wheel and the acquired speed of the right wheel is an average speed of the estimated left wheel and the estimated average speed of the right wheel. A wheelchair that controls rotation of at least one of the left wheel and the right wheel so as to coincide with a reference ratio.
前記漕ぎ動作判定部により前記搭乗者が前記左車輪及び前記右車輪の一方を漕いだと判定された場合、前記漕ぎ動作が開始された後の当該一方の車輪の平均速度を推定する片側速度推定部を備え、
前記回転制御部は、前記取得された左車輪の速度と前記取得された右車輪の速度との実測比が、前記推定された一方の車輪の平均速度と前記漕ぎ動作が開始されたときの他方の車輪の速度との基準比に一致するように、前記左車輪及び前記右車輪の回転を制御する、車椅子。 The wheelchair according to claim 1 or 2, further comprising:
One-side speed estimation for estimating an average speed of the one wheel after the rowing operation is started when it is determined by the rowing operation determination unit that the passenger has hit one of the left wheel and the right wheel. Part
The rotation control unit is configured so that an actual measurement ratio between the acquired speed of the left wheel and the acquired speed of the right wheel is equal to the estimated average speed of the one wheel and the other when the rowing operation is started. A wheelchair that controls the rotation of the left wheel and the right wheel so as to coincide with a reference ratio with the speed of the wheel.
前記実測比を前記基準比と比較し、その比較結果に基づいて、前記左車輪及び前記右車輪のいずれを制御するかを決定する制御対象決定部を備え、
前記回転制御部は、前記制御対象決定部により決定された車輪の回転を制御する、車椅子。 The wheelchair according to claim 4 or 5, further comprising:
A control object determining unit that compares the actual measurement ratio with the reference ratio and determines which of the left wheel and the right wheel to control based on the comparison result;
The said rotation control part is a wheelchair which controls rotation of the wheel determined by the said control object determination part.
前記漕ぎ動作判定部により前記搭乗者が前記左車輪及び前記右車輪の一方を漕いだと判定された場合、前記漕ぎ動作が開始された後の当該一方の車輪の平均速度を推定する片側速度推定部を備え、
前記回転制御部は、前記一方の車輪の速度が前記速度推定部により推定された平均速度となるように、前記一方の車輪の回転を制御する、車椅子。 The wheelchair according to claim 1 or 2, further comprising:
One-side speed estimation for estimating an average speed of the one wheel after the rowing operation is started when it is determined by the rowing operation determination unit that the passenger has hit one of the left wheel and the right wheel. Part
The rotation control unit is a wheelchair that controls the rotation of the one wheel so that the speed of the one wheel becomes an average speed estimated by the speed estimation unit.
前記回転制御部は、他方の車輪の速度が、前記搭乗者が漕ぎ動作を開始したときの速度となるように、前記他方の車輪の回転を制御する、車椅子。 A wheelchair according to claim 7,
The rotation control unit is a wheelchair that controls the rotation of the other wheel so that the speed of the other wheel becomes a speed when the passenger starts the rowing operation.
前記車椅子の前後方向の加速度を取得する加速度取得部を備え、
前記漕ぎ動作判定部は、前記加速度取得部により前方向の加速度が所定期間継続して取得された場合、前記搭乗者が前記左車輪及び前記右車輪の少なくとも一方を漕いだか否かを判定する、車椅子。 The wheelchair according to any one of claims 1 to 8, further comprising:
An acceleration acquisition unit for acquiring acceleration in the front-rear direction of the wheelchair;
The rowing motion determination unit determines whether or not the passenger has hit at least one of the left wheel and the right wheel when the acceleration acquisition unit continuously acquires a forward acceleration for a predetermined period. wheelchair.
前記漕ぎ動作判定部は、
前記取得された左車輪の速度の変化と前記予測変化との第1相違度を算出し、前記取得された右車輪の速度の変化と前記予測変化との第2相違度を算出する相違度算出部と、
前記算出された第1相違度が所定の範囲に存在する場合、前記搭乗者が前記左車輪を漕いだと判定し、前記算出された第2相違度が前記所定の範囲に存在する場合、前記搭乗者が前記右車輪を漕いだと判定する相違度比較部とを含む、車椅子。 The wheelchair according to claim 1 ,
The rowing motion determination unit
A difference calculation for calculating a first difference between the obtained change in the speed of the left wheel and the predicted change and calculating a second difference between the change in the speed of the acquired right wheel and the predicted change And
When the calculated first difference is within a predetermined range, it is determined that the occupant has scooped the left wheel, and when the calculated second difference is within the predetermined range, A wheelchair including a difference comparison unit that determines that a passenger scoops the right wheel.
前記相違度算出部は、複数の予測変化を取得し、前記第1相違度及び前記第2相違度を予測変化ごとに算出し、
前記相違度比較部は、各予測変化に対応する第1相違度のうち最小の第1相違度が前記所定の範囲に存在する場合、前記搭乗者が前記左車輪を漕いだと判定し、各予測変化に対応する第2相違度のうち最小の第2相違度が前記所定の範囲に存在する場合、前記搭乗者が前記右車輪を漕いだと判定する、車椅子。 A wheelchair according to claim 10 ,
The difference calculation unit obtains a plurality of prediction changes, calculates the first difference and the second difference for each prediction change,
The difference degree comparison unit determines that the occupant scoops the left wheel when a minimum first difference degree among the first difference degrees corresponding to each prediction change exists in the predetermined range, A wheelchair that determines that the occupant has scooped the right wheel when a minimum second difference among the second differences corresponding to the predicted change is within the predetermined range.
前記左車輪の速度を取得するステップと、
前記右車輪の速度を取得するステップと、
前記取得された左車輪の速度の変化を、前記搭乗者の所定の漕ぎ動作によって生じると予測される前記左車輪及び前記右車輪の速度の予測変化と比較することにより、前記搭乗者が前記左車輪を漕いだか否かを判定するステップと、
前記取得された右車輪の速度の変化を前記予測変化と比較することにより、前記搭乗者が前記右車輪を漕いだか否かを判定するステップと、
前記左車輪を漕いだか否かの判定結果及び前記右車輪を漕いだか否かの判定結果に応じて、前記左車輪の回転及び前記右車輪の少なくとも一方の回転を制御するステップとを実行させるためのプログラム。 A computer that is mounted on a wheelchair equipped with a left wheel and a right wheel that rotates in accordance with a passenger's rowing operation and operates as a control device that controls the rotation of the left wheel and the right wheel,
Obtaining the speed of the left wheel;
Obtaining the speed of the right wheel;
By comparing the obtained change in the speed of the left wheel with a predicted change in the speed of the left wheel and the right wheel that is predicted to be caused by a predetermined rowing motion of the occupant, the occupant Determining whether or not the wheel has been hit,
Determining whether the occupant scooped the right wheel by comparing the obtained change in speed of the right wheel with the predicted change;
Controlling the rotation of the left wheel and the rotation of at least one of the right wheel according to the determination result of whether or not the left wheel is hit and the determination result of whether or not the right wheel is hit. Program.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012119492A JP5948149B2 (en) | 2012-05-25 | 2012-05-25 | Wheelchair that performs control based on rowing motion judgment |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012119492A JP5948149B2 (en) | 2012-05-25 | 2012-05-25 | Wheelchair that performs control based on rowing motion judgment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2013244156A JP2013244156A (en) | 2013-12-09 |
| JP5948149B2 true JP5948149B2 (en) | 2016-07-06 |
Family
ID=49844426
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2012119492A Active JP5948149B2 (en) | 2012-05-25 | 2012-05-25 | Wheelchair that performs control based on rowing motion judgment |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5948149B2 (en) |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4350811B2 (en) * | 1997-07-30 | 2009-10-21 | ヤマハ発動機株式会社 | Auxiliary powered wheelchair |
| JPH1156917A (en) * | 1997-08-21 | 1999-03-02 | Yamaha Motor Co Ltd | Auxiliary powered wheelchair |
-
2012
- 2012-05-25 JP JP2012119492A patent/JP5948149B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2013244156A (en) | 2013-12-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20150066328A1 (en) | Walking assistance moving vehicle | |
| CN113543858B (en) | Method and device for controlling a mobile device using an estimated gait trajectory | |
| JP2012025378A5 (en) | Parking support control device and parking support control method | |
| CN104114442B (en) | Systems and methods for controlling sliding | |
| CN108698656B (en) | System for assisting bicycling by sending haptic feedback to cyclist | |
| JPWO2014061108A1 (en) | Center of gravity estimation apparatus and center of gravity estimation method | |
| JP6183331B2 (en) | Vehicle travel control device | |
| JP6794099B2 (en) | Power-assisted vehicles, control methods, and programs | |
| JP4978622B2 (en) | Inverted moving body and method for judging abnormality thereof | |
| CN105122168A (en) | Moving body control device, moving body control method, and control program | |
| JP4811075B2 (en) | Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method | |
| JP2015153407A5 (en) | ||
| JP6984558B2 (en) | Vehicle driving support device | |
| JP6586856B2 (en) | Control method and control apparatus for electric vehicle | |
| KR20130057571A (en) | Movement obstacle avoidance method of autonomous vehicle | |
| JP5948149B2 (en) | Wheelchair that performs control based on rowing motion judgment | |
| JP6841411B2 (en) | Walking assistance vehicle and walking assistance system | |
| EP3308761B1 (en) | Electric vehicle and method of breaking the same | |
| KR101871160B1 (en) | Method for torque vectoring of vehicle mounting in-wheel motors | |
| CN109910871A (en) | A kind of vehicle stabilization householder method and auxiliary device | |
| JP6252783B2 (en) | Pedestrian detection device for vehicles | |
| JP3979340B2 (en) | Braking control device | |
| JP5644442B2 (en) | Center of gravity position estimation device, method, and input device | |
| JP4961880B2 (en) | Vehicle route calculation apparatus and vehicle route calculation method | |
| JP5772373B2 (en) | Inverted moving body control device and control method thereof |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20141205 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20151007 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20151104 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20151211 |
|
| 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: 20160524 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160606 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5948149 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |