(57)【特許請求の範囲】
【請求項１】
車両の角速度を検出する角速度検出システムであって、
前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサと、
前記移動量検出センサの出力に基づき前記２箇所の移動量を算出する移動量算出手段と、
算出された前記移動量に基づき前記車両の角速度を算出する手段と、
算出された前記移動量に基づき前記車両の中心位置の移動量を算出する手段と、
算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出する手段とを含み、
前記移動量算出手段は、前記移動量検出センサの出力を蓄積して、周期的に生成される信号に応答してこの蓄積結果に基づいて前記移動量の算出をなし、前記信号の発生周期に応じて、求める角速度の精度が変更可能に構成されていることを特徴とする角速度検出システム。
【請求項２】
車両の角速度を検出する角速度検出方法であって、
前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサの出力を蓄積し、求める角速度の精度に応じた周期で生成される信号に応答してこの蓄積結果に基づいて前記２箇所の移動量を算出する移動量算出ステップと、
算出された前記移動量に基づき前記車両の角速度を算出するステップと、
算出された前記移動量に基づき前記車両の中心位置の移動量を算出するステップと、
算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出するステップとを含むことを特徴とする角速度検出方法。
【請求項３】
車両の角速度を検出する角速度検出方法をコンピュータに実行させるためのプログラムであって、
前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサの出力を蓄積し、求める角速度の精度に応じた周期で生成される信号に応答してこの蓄積結果に基づいて前記２箇所の移動量を算出する移動量算出処理と、
算出された前記移動量に基づき前記車両の角速度を算出する処理と、
算出された前記移動量に基づき前記車両の中心位置の移動量を算出する処理と、
算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出する処理とを含むことを特徴とするプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は角速度検出システム及びその方法並びにプログラムに関し、特に車載用のナビゲーション機能に用いて好適な角速度検出方式に関するものである。
【背景技術】
【０００２】
車載用のナビゲーション機能や携帯電話機でのナビゲーション機能などの出現により、位置と方向に関する製品やサービスの需要が高まりつつある。その中で、位置についてはＧＰＳのＦＭ多重電波による補正などを用いた技術が確立されつつあるが、方向については、地磁気や振動子などから角速度を検出して方向検出するようになっている。
【０００３】
なお、角速度を検出する技術として、特許文献１や２に開示のものがある。
【特許文献１】特開平１１−１０８６６７号公報
【特許文献２】特開平０６−２９４８０５号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
地磁気や振動子などから角速度を検出する従来技術には、次のような問題点がある。地磁気や振動子では、機械的な動作が必要となり、耐久性、動作速度の点において、現時点では限界がある。
【０００５】
そこで、本発明は機械的な動作を介することなく角度変化を検出することが可能な角速度検出システム及びその方法並びにプログラムを提供することを目的とする。
【課題を解決するための手段】
【０００６】
本発明による角速度検出システムは、車両の角速度を検出する角速度検出システムであって、前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサと、前記移動量検出センサの出力に基づき前記２箇所の移動量を算出する移動量算出手段と、算出された前記移動量に基づき前記車両の角速度を算出する手段と、算出された前記移動量に基づき前記車両の中心位置の移動量を算出する手段と、算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出する手段とを含み、前記移動量算出手段は、前記移動量検出センサの出力を蓄積して、周期的に生成される信号に応答してこの蓄積結果に基づいて前記移動量の算出をなし、前記信号の発生周期に応じて、求める角速度の精度が変更可能に構成されていることを特徴とする。
【０００７】
本発明による角速度検出方法は、車両の角速度を検出する角速度検出方法であって、前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサの出力を蓄積し、求める角速度の精度に応じた周期で生成される信号に応答してこの蓄積結果に基づいて前記２箇所の移動量を算出する移動量算出ステップと、算出された前記移動量に基づき前記車両の角速度を算出するステップと、算出された前記移動量に基づき前記車両の中心位置の移動量を算出するステップと、算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出するステップとを含むことを特徴とする。
【０００８】
本発明によるプログラムは、車両の角速度を検出する角速度検出方法をコンピュータに実行させるためのプログラムであって、前記車両の車幅中心線と後輪の車軸との交差する位置と、前記車両の車幅中心線と前輪の車軸との交差する位置の２箇所の各々に設けられた光学式の移動量検出センサの出力を蓄積し、求める角速度の精度に応じた周期で生成される信号に応答してこの蓄積結果に基づいて前記２箇所の移動量を算出する移動量算出処理と、算出された前記移動量に基づき前記車両の角速度を算出する処理と、算出された前記移動量に基づき前記車両の中心位置の移動量を算出する処理と、算出された前記車両の中心位置の移動量と前記車両の角速度とをカーナビゲーションシステムへ送出する処理とを含むことを特徴とする。
【発明の効果】
【０００９】
本発明による第一の効果は、磁気方位センサ、ガスレートセンサによる角速度検出に比べて、レスポンスが良いということである。その理由は、磁気方位センサ、ガスレートセンサのように、絶対位置を示す固定針が地磁気やガスなどで中空の物体が完全に固定されないため、速い動作に追従できるためである。
【００１０】
本発明による第２の効果は、振動に強いということである。その理由は、移動量検出センサとして、光学式のセンサを利用することにより、機械的なセンサが省かれるためである。
【発明を実施するための最良の形態】
【００１１】
以下に、図面を参照しつつ本発明について詳細に説明する。先ず、図１を用いて本発明の原理を説明する。図１において、ある移動物体１に２個の移動量検出センサＡ１，Ａ２が固定的に取付けられている。この物体１が矢印Ｂに示す如く移動して物体１’の位置にきたとすると、センサＡ１，Ａ２も、それぞれセンサＡ１’，Ａ２’の位置に移動することになる。このときのセンサＡ１，Ａ２，Ａ１’，Ａ２’の各々の移動量を下記の如く表す。
【００１２】
Ａ１からＡ１’への横方向（ｘ方向）への移動量：Δｘ１
Ａ１からＡ１’への縦方向（ｙ方向）への移動量：Δｙ１
Ａ２からＡ２’への横方向（ｘ方向）への移動量：Δｘ２
Ａ２からＡ２’への縦方向（ｙ方向）への移動量：Δｙ２
【００１３】
なお、これら２位置間の移動量は、各センサ内に予め設けられているタイマー機能により、時間ｔ１とｔ２との短時間（単位時間）における移動量として検出されるものとする。
【００１４】
これらの移動量を用いて、物体１が物体１’へ移動したときの向きの角速度ωを次式で求めることができる。
ω＝ｔａｎ-1｛（Δｙ２―Δｙ１）／（Δｘ２−Δｘ１）｝
この式は短時間での変化のみに適用可能であり、長時間の変化、すなわち方向θを算出するには、このωを時間積分すれば良いことになる。
【００１５】
移動量検出センサは、パーソナルコンピュータなどに使用されるポインティングデバイスであるマウスとして主流になっている光学式マウスによる移動量検出と同じ原理のセンサを用いることができる。このセンサとしては、イメージスキャナ機能を有し、短時間内において、２つの画像を比較して、どの方向にどれだけ動いたかを検出する機能を有しているものである。
【００１６】
次に、図２、図３を参照して本発明の実施の形態について説明する。なお、図１と同等部分は同一符号により示している。図１において、移動物体１は車両であり、この車両１が矢印Ｂの方向に移動して車両１’の位置にきたものとする。車両１には、その移動量を検出する移動量検出センサＡ１が、車幅中心線と後輪１１の車軸との交差する位置に取付けられており、また移動量検出センサＡ２が、車幅中心線と前輪１２の車軸との交差する位置に取付けられている。
【００１７】
これらセンサＡ１，Ａ２の各出力は計算機（コンピュータ）３０へ入力されている。なお、移動量検出センサＡ１，Ａ２は、前述した如く、底面から画像センサにより底面の画像を撮影して、どの方向にどれだけ移動したかを検出するようになっているものとする。
【００１８】
計算機３０は、図３に示す如く、移動量検出センサＡ１，Ａ２からの移動量を蓄積して、単位時間当りの移動量を算出する移動量算出部３１と、移動量算出部３１に対して、予め設定された一定時間毎に信号を送出するタイマー部３２と、移動量算出部３１から得られる移動量を用いて、角度変化（角速度）を算出し、カーナビゲーションシステムなどの外部機器（図示せず）へ送出する角速度算出部３３とにより構成されている。
【００１９】
図４は本発明の実施の形態の動作を示すシーケンス図である。図２に示した如く、車両１は、前輪が操舵されて、矢印Ｂに示すように、右前方向に移動していく。このとき、移動量検出センサＡ１は、横方向移動量Δｘ１及び縦方向移動量Δｙ１を移動量算出部３１へ送出する（ステップＳ１）。同時に、移動量検出センサＡ２も、横方向の移動量Δｘ２及び縦方向移動量Δｙ２を移動量算出部３１へ送出する（ステップＳ２）。
【００２０】
移動量算出部３１は、各センサから送られてきた移動量を蓄積し続ける（ステップＳ３）。このとき、タイマー部３２より一定時間毎に信号が送出されているものとする（ステップＳ４）。この信号を受信した移動量算出部３１は、蓄積している移動量を以下のような形にして角速度算出部３３へ送出する（ステップＳ５）。
【００２１】
車両１から車両１’の移動量検出センサＡ１による横方向移動量：Δｘ１
車両１から車両１’の移動量検出センサＡ１による縦方向移動量：Δｙ１
車両１から車両１’の移動量検出センサＡ２による横方向移動量：Δｘ２
車両１から車両１’の移動量検出センサＡ２による縦方向移動量：Δｙ２
【００２２】
角速度算出部３３は、
ω＝ｔａｎ-1｛（Δｙ２−Δｙ１）／（Δｘ２−Δｘ１）｝
なる式により角速度を算出する（ステップＳ６）。そして、角速度を算出すると、移動量算出部３１に蓄積されている移動量Δｘ１，Δｙ１，Δｘ２，Δｙ２を消去するよう指示する（ステップＳ７）。この算出された角速度は、外部機器へ送出されることになる（ステップＳ８）。外部機器では、上記のωを次式の如く時間積分することにより、角度θが算出される。
θ＝∫（ω）ｄｔ  （ｔの変化は任意）
【００２３】
なおタイマー部３２の信号の発生周期に応じて、求める角速度の精度を変更することが可能になる。
【００２４】
次に、本発明の他の実施の形態について、図５、図６を参照して説明する。なお、図５、図６において、図２、図３と同等部分には同一符号を付している。本実施の形態においては、計算機３０において、車両１の中心位置Ｃの移動量を算出して外部機器へこれを送出する位置変化算出部３４が、先の実施の形態に追加されている。こうすることにより、角速度のみならず、その物体（車両）１の中心Ｃが移動した量も算出することが可能となる。
【００２５】
図５を参照すると、車両１には、移動量検出センサＡ１，Ａ２が設けられていることは図２の例と同じである。図６を参照すると、計算機３０には、移動量算出部３１、タイマー部３２、角速度算出部３３の他に、更に、移動量算出部３１により得られた移動量から、車両１の位置変化を算出し、外部機器へ送出する位置変化算出部３４が設けられている。
【００２６】
図７は本実施の形態の動作を示すシーケンス図である。車両１は、前輪が操舵されて、図５の矢印Ｂに示す如く、右前方へ移動する。このとき、移動量検出センサＡ１は横方向移動量Δｘ１、縦方向移動量Δｙ１を、移動量算出部３１へ送出する（ステップＳ１）。同時に、移動量検出センサＡ２は横方向移動量Δｘ２、縦方向移動量Δｙ２を、移動量算出部３１へ送出する（ステップＳ２）。移動量算出部３１は移動量を蓄積し続ける（ステップＳ３）。
【００２７】
このとき、タイマー部３２により一定時間毎の信号が発生されており（ステップＳ４）、この信号を受信した移動量算出部３１は蓄積された移動量を以下のような形にして、角速度算出部３３と位置変化算出部３４とに送出する（ステップＳ５）。
【００２８】
車両１から車両１’の移動量検出センサＡ１による横方向移動量：Δｘ１
車両１から車両１’の移動量検出センサＡ１による縦方向移動量：Δｙ１
車両１から車両１’の移動量検出センサＡ２による横方向移動量：Δｘ２
車両１から車両１’の移動量検出センサＡ２による縦方向移動量：Δｙ２
【００２９】
位置変化算出部３４は、下記の計算により、車両の中心位置Ｃが変化した横方向の移動量Δｘ３と縦方向の移動量Δｙ３を算出する（ステップＳ９）。
Δｘ３＝（Δｘ１＋Δｘ２）／２
Δｙ３＝（Δｙ１＋Δｙ２）／２
【００３０】
位置変化算出部３４は、算出した位置変化量を外部機器へ送信する（ステップＳ１０）。
【００３１】
角速度算出部３３の動作は図４に示したステップＳ６〜ステップＳ８の動作と同一であるので、その説明は省略する。
【００３２】
上述の実施の形態においては、物体として車両について述べたが、移動する物体であれば、車両に限定されるものではない。また、計算機３０の動作は予めその動作手順をプログラムとしてＲＯＭなどの記録媒体に記録しておき、これをコンピュータにより読取らせて実行することができることは明らかである。
【図面の簡単な説明】
【００３３】
【図１】本発明の原理を説明するための図である。
【図２】本発明の一実施の形態における車両１の移動状態とその移動量を説明する図である。
【図３】図１の計算機３０の例を示す図である。
【図４】本発明の一実施の形態の動作を示すシーケンス図である。
【図５】本発明の他の実施の形態における車両１の移動状態とその移動量を説明する図である。
【図６】図５の計算機３０の例を示す図である。
【図７】本発明の他の実施の形態の動作を示すシーケンス図である。
【符号の説明】
【００３４】
１，１’  車両
１１  後輪
１２  前輪
３０，３０’  計算機
３１  移動量算出部
３２  タイマー部
３３  角速度算出部
【図１】
0004839920.tif 000002
【図２】
0004839920.tif 000003
【図３】
0004839920.tif 000004
【図４】
0004839920.tif 000005
【図５】
0004839920.tif 000006
【図６】
0004839920.tif 000007
【図７】
0004839920.tif 000008