JPH04218788A - 超音波センサを使用した移動体の座標算出方法 - Google Patents
超音波センサを使用した移動体の座標算出方法Info
- Publication number
- JPH04218788A JPH04218788A JP41157390A JP41157390A JPH04218788A JP H04218788 A JPH04218788 A JP H04218788A JP 41157390 A JP41157390 A JP 41157390A JP 41157390 A JP41157390 A JP 41157390A JP H04218788 A JPH04218788 A JP H04218788A
- Authority
- JP
- Japan
- Prior art keywords
- ultrasonic
- receiving
- timing
- microcomputer
- transmission
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims description 10
- 230000005540 biological transmission Effects 0.000 claims abstract description 25
- 238000009434 installation Methods 0.000 claims abstract description 19
- 238000005259 measurement Methods 0.000 claims description 16
- 238000012545 processing Methods 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 5
- 238000001514 detection method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【０００１】
【産業上の利用分野】この発明は、超音波を距離計測に
使用することにより、超音波送信源である移動体の座標
上の位置を算出する座標算出方法に関するものである。
使用することにより、超音波送信源である移動体の座標
上の位置を算出する座標算出方法に関するものである。
【０００２】
【従来の技術】移動ロボットや各種搬送装置のリモート
制御においては、対象とする移動体の移動状況を常時監
視すると共にその起動と停止並びに各種動作をリモート
制御し、かつ、周辺環境における障害物等との距離を測
定することにより接触や衝突等のトラブルの発生を防止
することが肝要である。従って、対象とする移動体は予
め定められたルート上を制御信号によって移動させるも
のとし、その各種動作も極めて制限されたものであった
。また、舞台照明等に使用されている調光装置において
は、舞台上における被写体の移動やプレイの進行状況に
応じて照明の色彩や明暗を変化させると共に照射範囲を
適宜調整することが肝要である。このため舞台の上部や
側面，床面等に設けられた多数の照明装置を一括してリ
モート制御していた。舞台上における被写体の位置や移
動のタイミング等が大略定まっている場合には、調光装
置をプログラム制御することもできるが、その場合にお
いても微調整は操作者によって行う必要があった。
制御においては、対象とする移動体の移動状況を常時監
視すると共にその起動と停止並びに各種動作をリモート
制御し、かつ、周辺環境における障害物等との距離を測
定することにより接触や衝突等のトラブルの発生を防止
することが肝要である。従って、対象とする移動体は予
め定められたルート上を制御信号によって移動させるも
のとし、その各種動作も極めて制限されたものであった
。また、舞台照明等に使用されている調光装置において
は、舞台上における被写体の移動やプレイの進行状況に
応じて照明の色彩や明暗を変化させると共に照射範囲を
適宜調整することが肝要である。このため舞台の上部や
側面，床面等に設けられた多数の照明装置を一括してリ
モート制御していた。舞台上における被写体の位置や移
動のタイミング等が大略定まっている場合には、調光装
置をプログラム制御することもできるが、その場合にお
いても微調整は操作者によって行う必要があった。
【０００３】
【発明が解決しようとする課題】監視用テレビカメラや
赤外線装置による監視は夫々の監視装置と移動体との相
対位置関係を観測しチェックするものであって、移動体
の移動軌跡を正確に把握することはできないので、移動
ロボットのリモート制御において許容される移動体の移
動範囲は狭く限定されており、また舞台照明等に使用さ
れている調光装置の制御を簡易化したり省力化すること
は困難であった。この発明は上述した問題点を解消する
ためになされたものであって、超音波センサを利用する
ことによって移動体の時々刻々における移動を予め設定
した直交座標上の座標成分の変化として捕らえ、移動体
の移動軌跡を正確に把握できる超音波センサを使用した
移動体の座標算出方法を提供しようとするものである。
赤外線装置による監視は夫々の監視装置と移動体との相
対位置関係を観測しチェックするものであって、移動体
の移動軌跡を正確に把握することはできないので、移動
ロボットのリモート制御において許容される移動体の移
動範囲は狭く限定されており、また舞台照明等に使用さ
れている調光装置の制御を簡易化したり省力化すること
は困難であった。この発明は上述した問題点を解消する
ためになされたものであって、超音波センサを利用する
ことによって移動体の時々刻々における移動を予め設定
した直交座標上の座標成分の変化として捕らえ、移動体
の移動軌跡を正確に把握できる超音波センサを使用した
移動体の座標算出方法を提供しようとするものである。
【０００４】
【課題を解決するための手段】上述した課題を解決する
ために、この発明による超音波センサを使用した移動体
の座標算出方法は、送信側（移動体側）に設けられた送
信装置から電波／光等に変換されたタイミングパルスを
出力すると共に、同じく前記送信側（移動体側）に設け
られた超音波送信装置から前記タイミングパルスと同一
のタイミングの超音波信号を出力する送信手段と、受信
側（固定設置側）に設けられた受信装置およびＮ個の超
音波受信装置によって受信した電波／光等および超音波
信号を夫々前記タイミングパルスおよびＮ個の超音波出
力パルスに変換する受信手段と、前記電波／光等から変
換したタイミングパルスとマイコンからの測定イネーブ
ル信号をＮ個の論理回路に入力させることによりＮ個の
カウンタを同時にスタートさせ、さらに、前記Ｎ個の超
音波受信センサにより受信した超音波出力パルスを夫々
Ｎ個の論理回路に入力させることによってＮ個の論理回
路から測定完了割り込み信号をマイコンに入力させ、こ
のマイコンが読み込んだ前記Ｎ個のカウンタのカウント
値に基づきマイコンに内蔵したプログラムによって前記
送信側（移動体側）と前記受信側（固定設置側）に設け
たＮ個の超音波受信センサとの夫々の直線距離を算出す
る距離計測手段と、前記受信側（固定設置側）に設けら
れたＮ個の超音波受信センサに予め設定してある直交座
標の座標軸成分と前記距離計測手段によって得られた直
線距離情報に基づいて、前記マイコンに内蔵したプログ
ラムにより送信側（移動体側）の前記直交座標上の座標
軸成分を算出する座標算出手段とによって構成した。な
お、送信側（移動体側）が複数個である場合には、電波
／光等のタイミングパルスおよび超音波信号に夫々異な
った周波数を割り当て、受信側（固定設置側）において
は夫々の周波数に対応した複数個の電波／光等の受信装
置および夫々Ｎ個の超音波受信装置によって受信し、前
記夫々Ｎ個の論理回路とカウンタに前記受信信号を夫々
入力させることにより複数個の送信側（移動体側）と夫
々Ｎ個の超音波受信センサとの直線距離を算出し、さら
に、予め設定した複数個の直交座標に複数個の送信側（
移動体側）の座標軸成分を算出させる。
ために、この発明による超音波センサを使用した移動体
の座標算出方法は、送信側（移動体側）に設けられた送
信装置から電波／光等に変換されたタイミングパルスを
出力すると共に、同じく前記送信側（移動体側）に設け
られた超音波送信装置から前記タイミングパルスと同一
のタイミングの超音波信号を出力する送信手段と、受信
側（固定設置側）に設けられた受信装置およびＮ個の超
音波受信装置によって受信した電波／光等および超音波
信号を夫々前記タイミングパルスおよびＮ個の超音波出
力パルスに変換する受信手段と、前記電波／光等から変
換したタイミングパルスとマイコンからの測定イネーブ
ル信号をＮ個の論理回路に入力させることによりＮ個の
カウンタを同時にスタートさせ、さらに、前記Ｎ個の超
音波受信センサにより受信した超音波出力パルスを夫々
Ｎ個の論理回路に入力させることによってＮ個の論理回
路から測定完了割り込み信号をマイコンに入力させ、こ
のマイコンが読み込んだ前記Ｎ個のカウンタのカウント
値に基づきマイコンに内蔵したプログラムによって前記
送信側（移動体側）と前記受信側（固定設置側）に設け
たＮ個の超音波受信センサとの夫々の直線距離を算出す
る距離計測手段と、前記受信側（固定設置側）に設けら
れたＮ個の超音波受信センサに予め設定してある直交座
標の座標軸成分と前記距離計測手段によって得られた直
線距離情報に基づいて、前記マイコンに内蔵したプログ
ラムにより送信側（移動体側）の前記直交座標上の座標
軸成分を算出する座標算出手段とによって構成した。な
お、送信側（移動体側）が複数個である場合には、電波
／光等のタイミングパルスおよび超音波信号に夫々異な
った周波数を割り当て、受信側（固定設置側）において
は夫々の周波数に対応した複数個の電波／光等の受信装
置および夫々Ｎ個の超音波受信装置によって受信し、前
記夫々Ｎ個の論理回路とカウンタに前記受信信号を夫々
入力させることにより複数個の送信側（移動体側）と夫
々Ｎ個の超音波受信センサとの直線距離を算出し、さら
に、予め設定した複数個の直交座標に複数個の送信側（
移動体側）の座標軸成分を算出させる。
【０００５】
【作用】受信側（固定設置側）に設けられたＮ個の超音
波受信センサの直交座標における座標軸成分は超音波受
信センサの設置数に応じて図７，図８，図９に示すよう
になる。図７はＮ＝２の場合であり、超音波受信センサ
Ｒ１ Ｒ２ と送信点（移動体）Ｓとの直線距離を夫々
Ｌ１ とＬ２ とし、Ｒ１ は直交座標の原点Ｏ上の高
さＨの点にあり、またＲ２ はＹ軸上にありＲ１ とＲ
２ の距離はＹとすると、前記送信点Ｓの座標軸成分は
波受信センサの直交座標における座標軸成分は超音波受
信センサの設置数に応じて図７，図８，図９に示すよう
になる。図７はＮ＝２の場合であり、超音波受信センサ
Ｒ１ Ｒ２ と送信点（移動体）Ｓとの直線距離を夫々
Ｌ１ とＬ２ とし、Ｒ１ は直交座標の原点Ｏ上の高
さＨの点にあり、またＲ２ はＹ軸上にありＲ１ とＲ
２ の距離はＹとすると、前記送信点Ｓの座標軸成分は
【数１】
と
【数２】
によって表せる。図８はＮ＝３の場合であり、超音波受
信センサＲ１ ，Ｒ２ ，Ｒ３ と送信点Ｓとの直線距
離を夫々Ｌ１ ，Ｌ２ ，Ｌ３ とし、Ｒ１ は直交座
標の原点Ｏ上にあり、Ｒ２ はＹ軸上にあってＲ１ と
Ｒ２ との距離をＹ，Ｒ３ はＸ軸上にありＲ１ とＲ
３ との距離をＸとすると、前記送信点Ｓの座標軸成分
は
信センサＲ１ ，Ｒ２ ，Ｒ３ と送信点Ｓとの直線距
離を夫々Ｌ１ ，Ｌ２ ，Ｌ３ とし、Ｒ１ は直交座
標の原点Ｏ上にあり、Ｒ２ はＹ軸上にあってＲ１ と
Ｒ２ との距離をＹ，Ｒ３ はＸ軸上にありＲ１ とＲ
３ との距離をＸとすると、前記送信点Ｓの座標軸成分
は
【数３】
と
【数４】
によって表せる。図９はＮ＝４の場合であり、この場合
の直交座標の原点ＯはＮ＝２，３における直交座標の座
標軸成分（
の直交座標の原点ＯはＮ＝２，３における直交座標の座
標軸成分（
【数５】
）の位置とし、送信点Ｓと超音波受信センサＲ１ ，Ｒ
２ ，Ｒ３ ，Ｒ４ との直線距離を夫々Ｌ１ ，Ｌ２
，Ｌ３ ，Ｌ４ とし、Ｒ１ とＲ３ は共にＸ軸上
にあって原点Ｏとの距離は夫々
２ ，Ｒ３ ，Ｒ４ との直線距離を夫々Ｌ１ ，Ｌ２
，Ｌ３ ，Ｌ４ とし、Ｒ１ とＲ３ は共にＸ軸上
にあって原点Ｏとの距離は夫々
【数６】
であり、かつ原点Ｏに対して対称の位置にある。またＲ
２ とＲ３は共にＹ軸上にあって原点Ｏとの距離は共に
２ とＲ３は共にＹ軸上にあって原点Ｏとの距離は共に
【数７】
であり、かつ原点Ｏに対して対称の位置にある。この場
合における送信点Ｓの座標軸成分は
合における送信点Ｓの座標軸成分は
【数８】
と
【数９】
によって表せる。
【０００６】
【実施例】以下、この発明に係る一実施例を図１によっ
て説明する。
て説明する。
【０００７】図１は超音波センサを使用した移動体の座
標算出方法における回路構成を示すブロック図であり、
送信タイミングコントロール部１から出力されるタイミ
ングパルスは増幅器６を介して送信機７へ入力され、電
波／光等に変換されて送信装置８から送信される。また
、超音波センサ用発振器２から出力される超音波出力パ
ルスは前記送信タイミングコントロール部１からのタイ
ミングパルスと共に論理回路３へ入力され、前記タイミ
ングパルスと同一のタイミングの超音波信号を送信回路
４と超音波送信センサ５を介して送信される。
標算出方法における回路構成を示すブロック図であり、
送信タイミングコントロール部１から出力されるタイミ
ングパルスは増幅器６を介して送信機７へ入力され、電
波／光等に変換されて送信装置８から送信される。また
、超音波センサ用発振器２から出力される超音波出力パ
ルスは前記送信タイミングコントロール部１からのタイ
ミングパルスと共に論理回路３へ入力され、前記タイミ
ングパルスと同一のタイミングの超音波信号を送信回路
４と超音波送信センサ５を介して送信される。
【０００８】固体設置側に設けられた電波／光等の受信
装置９と受信機１０により前記電波／光等はタイミング
パルスに変換され、増幅器１２を介してマイコン１７の
測定イネーブル信号と共に論理回路１４１ 〜１４Ｎ
へ入力される。また、固体設置側に設けられたＮ個の超
音波受信センサ１１１ 〜１１Ｎ に夫々入力した超音
波信号は前記タイミングパルスと同一のタイミングの超
音波出力パルスに夫々変換され、前記Ｎ個の超音波受信
センサ１１１ 〜１１Ｎ に夫々直列接続したＮ個の受
信回路１３１ 〜１３Ｎ を介して前記Ｎ個の論理回路
１４１ 〜１４Ｎ へ入力される。
装置９と受信機１０により前記電波／光等はタイミング
パルスに変換され、増幅器１２を介してマイコン１７の
測定イネーブル信号と共に論理回路１４１ 〜１４Ｎ
へ入力される。また、固体設置側に設けられたＮ個の超
音波受信センサ１１１ 〜１１Ｎ に夫々入力した超音
波信号は前記タイミングパルスと同一のタイミングの超
音波出力パルスに夫々変換され、前記Ｎ個の超音波受信
センサ１１１ 〜１１Ｎ に夫々直列接続したＮ個の受
信回路１３１ 〜１３Ｎ を介して前記Ｎ個の論理回路
１４１ 〜１４Ｎ へ入力される。
【０００９】前記Ｎ個の論理回路１４１ 〜１４Ｎ は
電波／光等のタイミングパルスおよびマイコン１７から
の測定イネーブル信号を入力すると、夫々直列接続され
たカウンタ１５１ 〜１５Ｎ のカウントを同時にスタ
ートさせる。電波／光等の伝播時間は超音波の伝播時間
に比べて無視してよく、送信側（移動体側）から受信側
（固定設置側）までの直線距離は超音波の伝播時間に比
例するので、設置点が異なる超音波受信センサへの超音
波伝播時間は異なったものとなり、その状況は図２に示
す通りである。従って、前記Ｎ個の論理回路１４１ 〜
１４Ｎ は夫々の受信回路１３１ 〜１３Ｎ から超音
波出力パルスＲ１ 〜ＲＮ を入力すると、夫々異なっ
たタイミングＴ１ 〜ＴＮ で測定完了割り込み信号１
〜Ｎをマイコン１７へ送出する。
電波／光等のタイミングパルスおよびマイコン１７から
の測定イネーブル信号を入力すると、夫々直列接続され
たカウンタ１５１ 〜１５Ｎ のカウントを同時にスタ
ートさせる。電波／光等の伝播時間は超音波の伝播時間
に比べて無視してよく、送信側（移動体側）から受信側
（固定設置側）までの直線距離は超音波の伝播時間に比
例するので、設置点が異なる超音波受信センサへの超音
波伝播時間は異なったものとなり、その状況は図２に示
す通りである。従って、前記Ｎ個の論理回路１４１ 〜
１４Ｎ は夫々の受信回路１３１ 〜１３Ｎ から超音
波出力パルスＲ１ 〜ＲＮ を入力すると、夫々異なっ
たタイミングＴ１ 〜ＴＮ で測定完了割り込み信号１
〜Ｎをマイコン１７へ送出する。
【００１０】前記マイコン１７は測定完了割り込み信号
を入力すると該当するカウンタのカウント数を読み込む
ので、Ｎ個の超音波受信センサからの受信タイミングに
応じてマイコン１７が読み込んだカウンタ１５１ 〜１
５Ｎのカウント数は異なったものとなる。図４はカウン
タ数が３個の場合におけるマイコン１７によるカウント
数読み込みを示すフローチャートである。図４において
、測定完了割り込み信号を入力する度に該当するカウン
タのカウント数を逐次読み込み（１０３〜１０８）、全
ての測定完了割り込み処理が終了する（１１０）と測定
イネーブル信号はＯＦＦ（１１１）となる。図５はマイ
コン１７に内蔵されたプログラムにより距離計算処理を
行うフローチャートであり、計測カウント値セット（１
２０）、計測用ＯＳＣ周波数セット（１２１）、音速パ
ラメータセット（１２２）が逐次セットされると、内蔵
プログラムにより送信点と超音波受信センサとの直線距
離の計算（１２３）を行い、さらに、音速は環境条件（
気温，湿度等）によって変化するので補正する必要があ
り、補正計算処理（１２４）を行う。
を入力すると該当するカウンタのカウント数を読み込む
ので、Ｎ個の超音波受信センサからの受信タイミングに
応じてマイコン１７が読み込んだカウンタ１５１ 〜１
５Ｎのカウント数は異なったものとなる。図４はカウン
タ数が３個の場合におけるマイコン１７によるカウント
数読み込みを示すフローチャートである。図４において
、測定完了割り込み信号を入力する度に該当するカウン
タのカウント数を逐次読み込み（１０３〜１０８）、全
ての測定完了割り込み処理が終了する（１１０）と測定
イネーブル信号はＯＦＦ（１１１）となる。図５はマイ
コン１７に内蔵されたプログラムにより距離計算処理を
行うフローチャートであり、計測カウント値セット（１
２０）、計測用ＯＳＣ周波数セット（１２１）、音速パ
ラメータセット（１２２）が逐次セットされると、内蔵
プログラムにより送信点と超音波受信センサとの直線距
離の計算（１２３）を行い、さらに、音速は環境条件（
気温，湿度等）によって変化するので補正する必要があ
り、補正計算処理（１２４）を行う。
【００１１】Ｎ個の超音波受信センサＲ１ 〜ＲＮ の
位置は予め設定した直交座標の座標軸成分として与えて
おき、この座標情報をマイコン１７の内蔵プログラムに
格納しておく。図７，図８，図９はＮ＝２，３，４の場
合の座標を示す斜視図である。図６は送信点Ｓの座標軸
成分を計算処理するフローチャートであり、空間の大き
さのパラメータであるＸ，Ｙ，Ｈをセット（１２５）し
、超音波センサの数Ｎをセット（１２６）するとＮ＝２
，３，４の場合は（１２７１ 〜１２７３ ）によって
送信点Ｓの座標軸成分（ｘ，ｙ）を算出（１２８）する
。マイコンによる座標検出処理のフローを総括すると図
３に示す通りである。なお、Ｎが４より多い場合にはＮ
＝２，３，４の場合の座標検出処理方法を適宜組み合わ
せて対応させる。
位置は予め設定した直交座標の座標軸成分として与えて
おき、この座標情報をマイコン１７の内蔵プログラムに
格納しておく。図７，図８，図９はＮ＝２，３，４の場
合の座標を示す斜視図である。図６は送信点Ｓの座標軸
成分を計算処理するフローチャートであり、空間の大き
さのパラメータであるＸ，Ｙ，Ｈをセット（１２５）し
、超音波センサの数Ｎをセット（１２６）するとＮ＝２
，３，４の場合は（１２７１ 〜１２７３ ）によって
送信点Ｓの座標軸成分（ｘ，ｙ）を算出（１２８）する
。マイコンによる座標検出処理のフローを総括すると図
３に示す通りである。なお、Ｎが４より多い場合にはＮ
＝２，３，４の場合の座標検出処理方法を適宜組み合わ
せて対応させる。
【００１２】前記図７，図８，図９において示した座標
はＮ＝２，３，４の場合における夫々の一実施例を示し
たものであって、前記座標における超音波受信センサ設
置点Ｒ１ ，Ｒ２ ，Ｒ３ ，Ｒ４ および座標原点０
を前記実施例とは異なる位置に任意に設定することもで
きる。また、送信側（移動体側）が複数個である場合に
は夫々異なる周波数に対応した送／受信装置を設置すれ
ばよく、その回路構成と作動は上述した実施例と同一の
ものを複数個備えたものであるので、説明は省略する。
はＮ＝２，３，４の場合における夫々の一実施例を示し
たものであって、前記座標における超音波受信センサ設
置点Ｒ１ ，Ｒ２ ，Ｒ３ ，Ｒ４ および座標原点０
を前記実施例とは異なる位置に任意に設定することもで
きる。また、送信側（移動体側）が複数個である場合に
は夫々異なる周波数に対応した送／受信装置を設置すれ
ばよく、その回路構成と作動は上述した実施例と同一の
ものを複数個備えたものであるので、説明は省略する。
【００１３】
【発明の効果】以上説明したように、この発明に係る超
音波センサを使用した移動体の座標算出方法は、超音波
の伝播時間に対してその伝播時間を無視しうる通信手段
である電波／光等と超音波とを同時に送信側（移動体側
）から送信し、前記電波／光等を受信すると共に、予め
設定した座標軸成分を与えられているＮ個の超音波受信
センサを備えた受信側（固定設置側）において超音波を
受信し、前記電波／光等の受信によってスタートしたＮ
個のカウンタのカウント数を超音波の受信によってマイ
コンに読み込ませ、超音波伝播時間を利用して前記送信
側（移動体側）とＮ個の受信側（固定設置側）の直線距
離を算出し、さらに、各受信側（固定設置側）に与えら
れている座標軸成分情報と前記直線距離情報に基づいて
送信側（移動体側）の座標軸成分を算出するものである
。従って、送信側（移動体側）の移動状況を常時正確に
把握できるので受信側（固定設置側）からの制御は容易
になり、移動体の動作や移動の調整を精密に行うことが
できる。また、固定設置側に設ける制御装置に対しマイ
コンから移動体の時々刻々の情報を与えることができる
ので、前記制御装置の追従特性を向上させることができ
る。従って前記制御装置の操作者の省力化もしくは無人
化にも役立ち、技能を有しない者を使用することも可能
となる。なお、送信側（移動体側）が複数ある場合には
、夫々の送／受信周波数（超音波および電波／光等）を
変更すると共に受信側（固定設置側）には夫々の周波数
に対応する受信装置，論理回路，カウンタ等を設置する
。
音波センサを使用した移動体の座標算出方法は、超音波
の伝播時間に対してその伝播時間を無視しうる通信手段
である電波／光等と超音波とを同時に送信側（移動体側
）から送信し、前記電波／光等を受信すると共に、予め
設定した座標軸成分を与えられているＮ個の超音波受信
センサを備えた受信側（固定設置側）において超音波を
受信し、前記電波／光等の受信によってスタートしたＮ
個のカウンタのカウント数を超音波の受信によってマイ
コンに読み込ませ、超音波伝播時間を利用して前記送信
側（移動体側）とＮ個の受信側（固定設置側）の直線距
離を算出し、さらに、各受信側（固定設置側）に与えら
れている座標軸成分情報と前記直線距離情報に基づいて
送信側（移動体側）の座標軸成分を算出するものである
。従って、送信側（移動体側）の移動状況を常時正確に
把握できるので受信側（固定設置側）からの制御は容易
になり、移動体の動作や移動の調整を精密に行うことが
できる。また、固定設置側に設ける制御装置に対しマイ
コンから移動体の時々刻々の情報を与えることができる
ので、前記制御装置の追従特性を向上させることができ
る。従って前記制御装置の操作者の省力化もしくは無人
化にも役立ち、技能を有しない者を使用することも可能
となる。なお、送信側（移動体側）が複数ある場合には
、夫々の送／受信周波数（超音波および電波／光等）を
変更すると共に受信側（固定設置側）には夫々の周波数
に対応する受信装置，論理回路，カウンタ等を設置する
。
【図１】この発明による超音波センサを使用した移動体
の座標算出方法の回路構成を示すブロック図。
の座標算出方法の回路構成を示すブロック図。
【図２】電波／光と超音波のタイミングパルスの波形図
。
。
【図３】座標検出処理を示すフローチャート。
【図４】カウント数読み込み処理を示すフローチャート
。
。
【図５】距離計測処理を示すフローチャート。
【図６】座標計算処理を示すフローチャート。
【図７】超音波センサを２個設置した場合の座標を示す
斜視図。
斜視図。
【図８】超音波センサを３個設置した場合の座標を示す
斜視図。
斜視図。
【図９】超音波センサを４個設置した場合の座標を示す
斜視図。
斜視図。
１ 送信タイミングコントロール部
２ 超音波センサ用ＯＳＣ
４ 送信回路
５ 超音波送信センサ
７ 送信機
８ 送信装置
９ 受信装置
１０ 受信機
１１１〜１１Ｎ 超音波受信センサ６，１２ 増
幅器 １３１ 〜１３Ｎ 受信回路 ３，１４１ 〜１４Ｎ 論理回路 １５１ 〜１５Ｎ カウンタ １６ 計測用ＯＳＣ １７ マイコン
幅器 １３１ 〜１３Ｎ 受信回路 ３，１４１ 〜１４Ｎ 論理回路 １５１ 〜１５Ｎ カウンタ １６ 計測用ＯＳＣ １７ マイコン
Claims (2)
- 【請求項１】 送信側（移動体側）に設けられた送信
タイミングコントロール部から出力されるタイミングパ
ルスを電波／光等に変換し送信装置を介して送信すると
共に、前記タイミングパルスと同一のタイミングにより
超音波センサ用発振器からの超音波出力パルスを超音波
信号に変換し送信回路を介して送信する送信手段と、受
信側（固定設置側）に設けられた受信装置により受信し
た前記電波／光等を前記タイミングパルスに変換すると
共に、同じく受信側（固定設置側）に設けられたＮ個の
超音波受信センサにより受信した前記超音波信号を前記
Ｎ個の超音波受信センサに夫々直列接続されたＮ個の受
信回路を介して前記タイミングパルスと同一のタイミン
グの超音波出力パルスに変換する受信手段と、前記Ｎ個
の受信回路に夫々直列接続されたＮ個の論理回路に前記
電波／光等から変換したタイミングパルスおよびマイコ
ンからの測定イネーブル信号を夫々入力させることによ
り前記Ｎ個の論理回路に夫々直列接続したＮ個のカウン
タを同時にスタートさせ、さらに、受信した前記超音波
出力パルスを前記Ｎ個の論理回路に入力させることによ
り夫々の前記論理回路が出力する測定完了割り込み信号
を前記マイコンに入力させ、このマイコンが読み取った
前記Ｎ個のカウンタの夫々のカウント値に基づき、マイ
コンに内蔵したプログラムによって送信側（移動体側）
と受信側（固定設置側）に設けられたＮ個の超音波受信
センサとの夫々の直線距離を算出する距離計測手段と、
予め設定した直交座標における前記Ｎ個の超音波受信セ
ンサの座標軸成分情報と前記距離計測手段によって得ら
れた直線距離情報とに基づき、前記マイコンに内蔵した
プログラムにより前記送信側（移動体側）の前記直交座
標上における座標軸成分を算出する座標選出手段と、に
よって構成したことを特徴とする超音波センサを使用し
た移動体の座標算出方法。 - 【請求項２】 複数個の送信側（移動体側）から夫々
異なる周波数の電波／光等のタイミングパルスおよび超
音波信号を送信する送信手段と、前記複数個の電波／光
等のタイミングパルスの周波数に夫々対応した複数個の
受信装置および前記複数個の超音波信号の周波数に対応
した夫々Ｎ個の超音波受信装置により受信する受信手段
と、前記受信手段により受信した複数個の電波／光等の
タイミングパルス及び夫々Ｎ個の超音波信号を夫々Ｎ個
の論理回路とカウンタへ入力させることにより、前記複
数個の送信側（移動体側）と受信側（固定設置側）に設
けられた夫々Ｎ個の超音波受信センサとの直線距離をマ
イコンに内蔵したプログラムにより算出する距離計測手
段と、前記距離計測手段による夫々の直線距離情報およ
び夫々Ｎ個の超音波センサに予め設定した直交座標上の
座標軸成分情報に基づいて、前記マイコンに内蔵したプ
ログラムにより前記複数個の送信側（移動体側）の前記
直交座標上における座標成分を算出する座標算出手段と
、によって構成したことを特徴とする請求項１に記載の
超音波センサを使用した移動体の座標算出方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP41157390A JPH04218788A (ja) | 1990-12-18 | 1990-12-18 | 超音波センサを使用した移動体の座標算出方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP41157390A JPH04218788A (ja) | 1990-12-18 | 1990-12-18 | 超音波センサを使用した移動体の座標算出方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH04218788A true JPH04218788A (ja) | 1992-08-10 |
Family
ID=18520556
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP41157390A Pending JPH04218788A (ja) | 1990-12-18 | 1990-12-18 | 超音波センサを使用した移動体の座標算出方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH04218788A (ja) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005043337A (ja) * | 2003-07-23 | 2005-02-17 | Lg Electronics Inc | 移動ロボットの位置を検出する方法及びその装置 |
| DE10331321B4 (de) * | 2003-07-10 | 2006-05-04 | Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. | Vorrichtung und Verfahren zur dreidimensionalen Objekterfassung |
| DE10333012B4 (de) * | 2003-03-07 | 2007-05-10 | Pepperl + Fuchs Gmbh | Ultraschalltriangulationssystem mit wenigstens einem Ultraschallsender und Verfahren hierzu |
| JP2007127663A (ja) * | 2005-01-12 | 2007-05-24 | Matsushita Electric Works Ltd | 動線計測システム |
| JP2013029406A (ja) * | 2011-07-28 | 2013-02-07 | Nippon Telegr & Teleph Corp <Ntt> | 位置計測装置及びその方法 |
| JP2017106861A (ja) * | 2015-12-11 | 2017-06-15 | 三井造船株式会社 | 木造構造物検査システム及び木造構造物検査方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59224583A (ja) * | 1983-06-02 | 1984-12-17 | Mitsubishi Electric Corp | 無人移動車の位置検出装置 |
| JPH02102477A (ja) * | 1988-10-08 | 1990-04-16 | Honda Motor Co Ltd | 超音波測距装置 |
-
1990
- 1990-12-18 JP JP41157390A patent/JPH04218788A/ja active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59224583A (ja) * | 1983-06-02 | 1984-12-17 | Mitsubishi Electric Corp | 無人移動車の位置検出装置 |
| JPH02102477A (ja) * | 1988-10-08 | 1990-04-16 | Honda Motor Co Ltd | 超音波測距装置 |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE10333012B4 (de) * | 2003-03-07 | 2007-05-10 | Pepperl + Fuchs Gmbh | Ultraschalltriangulationssystem mit wenigstens einem Ultraschallsender und Verfahren hierzu |
| DE10331321B4 (de) * | 2003-07-10 | 2006-05-04 | Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. | Vorrichtung und Verfahren zur dreidimensionalen Objekterfassung |
| JP2005043337A (ja) * | 2003-07-23 | 2005-02-17 | Lg Electronics Inc | 移動ロボットの位置を検出する方法及びその装置 |
| JP2007127663A (ja) * | 2005-01-12 | 2007-05-24 | Matsushita Electric Works Ltd | 動線計測システム |
| JP2013029406A (ja) * | 2011-07-28 | 2013-02-07 | Nippon Telegr & Teleph Corp <Ntt> | 位置計測装置及びその方法 |
| JP2017106861A (ja) * | 2015-12-11 | 2017-06-15 | 三井造船株式会社 | 木造構造物検査システム及び木造構造物検査方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR100561855B1 (ko) | 로봇용 로컬라이제이션 시스템 | |
| IL122079A (en) | Ultrasound system for positioning and tracking | |
| GB2456773A (en) | Sensing the position of a mobile object relative to a fixed object via ultrasound and infrared | |
| JP2007500348A (ja) | 超音波を用いる距離の測定方法と装置 | |
| CN101163984A (zh) | 用于跟踪对象的rf系统 | |
| US4894810A (en) | Method and a device for measuring a distance by means of ultrasonic pulses | |
| KR20090076721A (ko) | 로봇 청소기의 위치 인식 방법 | |
| JP2005069892A (ja) | 移動体の自己位置算出システム | |
| JPH10282204A (ja) | 移動体の位置検出設備 | |
| CN101511041A (zh) | 遥控器位置检测装置、遥控器位置检测系统及检测方法 | |
| CN110865378A (zh) | 一种防串扰的超声测距装置、系统及方法 | |
| JPH04218788A (ja) | 超音波センサを使用した移動体の座標算出方法 | |
| KR100580278B1 (ko) | 이동체의 위치 및 방향 추정을 위한 초음파 센서 시스템 | |
| WO1987004799A1 (en) | Measuring apparatus | |
| Hwang et al. | A simple ultrasonic GPS system for indoor mobile robot system using kalman filtering | |
| Sato et al. | Absolute positioning control of indoor flying robot using ultrasonic waves and verification system | |
| Stączek | Digital signal processing in ultrasonic based navigation system for mobile robots | |
| US11579277B2 (en) | Position detection system and processing device | |
| WO2017125925A1 (en) | Method and system for real-time detection and location of multiple independently moving objects | |
| JPH086703A (ja) | 遠隔入力装置 | |
| KR20050095401A (ko) | 음파 또는 초음파의 전달시간을 이용한 삼차원 공간위치파악장치 | |
| JPH0720223A (ja) | 無人搬送車の測位装置 | |
| Stancovici et al. | Relative positioning system using inter-robot ultrasonic localization turret | |
| Wirnitzer et al. | Interference cancelation in ultrasonic sensor arrays by stochastic coding and adaptive filtering | |
| KR101356323B1 (ko) | 초음파 측정 장치 및 초음파 측정 방법 |