JPH0412433B2 - - Google Patents
Info
- Publication number
- JPH0412433B2 JPH0412433B2 JP58224189A JP22418983A JPH0412433B2 JP H0412433 B2 JPH0412433 B2 JP H0412433B2 JP 58224189 A JP58224189 A JP 58224189A JP 22418983 A JP22418983 A JP 22418983A JP H0412433 B2 JPH0412433 B2 JP H0412433B2
- Authority
- JP
- Japan
- Prior art keywords
- ultrasonic
- robot
- data
- distance
- room
- 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.)
- Expired - Lifetime
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic or infrasonic waves
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Description
【発明の詳細な説明】
〔発明の利用分野〕
本発明は、走行ロボツトに係り、特に走行ロボ
ツトの位置を正確に検知することのできる位置認
識装置に関するものである。
ツトの位置を正確に検知することのできる位置認
識装置に関するものである。
従来の走行ロボツトに設けられているロボツト
位置認識装置は、回転計で車輪の回転数を測定し
て走行距離と進行方向を計算し、それらの値から
走行ロボツトの位置を演算する方式であつた。
位置認識装置は、回転計で車輪の回転数を測定し
て走行距離と進行方向を計算し、それらの値から
走行ロボツトの位置を演算する方式であつた。
しかし従来の車輪回転数を測定する方式だと、
走行している床面状態により車輪がスリツプし
て、走行ロボツトの走行距離や進行方向の計測に
誤差が生じ、かつロボツトの位置はそれらの累積
計算で求めるため、ロボツトの位置を正確に認識
できない欠点があつた。
走行している床面状態により車輪がスリツプし
て、走行ロボツトの走行距離や進行方向の計測に
誤差が生じ、かつロボツトの位置はそれらの累積
計算で求めるため、ロボツトの位置を正確に認識
できない欠点があつた。
そこで本発明の目的は、従来技術の欠点をなく
し、走行ロボツトの位置を正確に認識することの
できる位置認識装置を提供するにある。
し、走行ロボツトの位置を正確に認識することの
できる位置認識装置を提供するにある。
本発明は、走行ロボツトの位置を、走行してい
る部屋の形状に対して相対的に認識することと
し、指向性の鋭い超音波を反射する送信器とそれ
を受信する受信器を設け、これらの超音波送受信
器の超音波送受信方向を90゜ずらせて複数個配置
し、かつ複数個の超音波送受信器を同一軸を中心
に回転させる構成とする。そして部屋の壁から反
射して来た超音波を受信することにより壁までの
距離と、ロボツトの進行方向あるいは基準方向に
対する壁の超音波反射面位置の方向を測定する。
る部屋の形状に対して相対的に認識することと
し、指向性の鋭い超音波を反射する送信器とそれ
を受信する受信器を設け、これらの超音波送受信
器の超音波送受信方向を90゜ずらせて複数個配置
し、かつ複数個の超音波送受信器を同一軸を中心
に回転させる構成とする。そして部屋の壁から反
射して来た超音波を受信することにより壁までの
距離と、ロボツトの進行方向あるいは基準方向に
対する壁の超音波反射面位置の方向を測定する。
ところで一般家庭、オフイス、工場、病院、学
校などの走行ロボツトが使用される部屋、空間は
矩形である場合がほとんどである。したがつてこ
れら矩形の部屋の中に走行ロボツトを置き、ロボ
ツトに設置した前記超音波送受信器で周囲の壁か
らの超音波の反射を受信して壁までの距離と方向
を測定すると、90゜ずれた壁のデータが４個得ら
れるはずである。
校などの走行ロボツトが使用される部屋、空間は
矩形である場合がほとんどである。したがつてこ
れら矩形の部屋の中に走行ロボツトを置き、ロボ
ツトに設置した前記超音波送受信器で周囲の壁か
らの超音波の反射を受信して壁までの距離と方向
を測定すると、90゜ずれた壁のデータが４個得ら
れるはずである。
本発明は、上記90゜ずれた壁からのデータを90゜
ずらせて配置した超音波送受信器で同時に測定す
ることで、走行ロボツトの位置を部屋の矩形形状
に対して相対的に認識し、かつ部屋の４方の壁に
ついての方向と距離のデータを同時に得ること
で、ロボツトの位置を正確に把握できるようにし
た。
ずらせて配置した超音波送受信器で同時に測定す
ることで、走行ロボツトの位置を部屋の矩形形状
に対して相対的に認識し、かつ部屋の４方の壁に
ついての方向と距離のデータを同時に得ること
で、ロボツトの位置を正確に把握できるようにし
た。
以下、本発明の一実施例を図面に従つて説明す
る。第１図は、本発明の超音波送受信器を備えた
走行ロボツトの構成を示す平面図、第２図は、第
１図の超音波送受信器で得られたデータから走行
ロボツトの位置を演算する位置認識装置のブロツ
ク図である。第３図はロボツト位置認識装置を示
す図、第４図は、ロボツト位置認識のアルゴリズ
ムのフローチヤートである。第１図で、１は走行
ロボツトの本体、２，３，４，５は本体１を走行
させる車輪、６は本体１に取りつけ図は省略する
が回転装置で矢印７の方向に回軸する回転軸、８
は本体１の上部に位置し回転軸６に固定された超
音波送受信器を取りつけるための送受信器フレー
ム、９は送受信器フレーム８に固定され指向性の
鋭い超音波をａの方向に発射するための超音波送
信器、１０は前記超音波送信器９の超音波発射方
向と同一方向ａにその受信方向を有した超音波受
信器で、超音波送信器９からａの方向に発射され
た指向性の鋭い超音波が物体１１の面で反射さ
れ、ａ方向と反対の方向に返つて来た超音波を受
信する超音波受信器である。１２は、指向性の鋭
い超音波を前記超音波送信器９および超音波受信
器１０の超音波送受信方向ａより90゜ずれたｂの
方向に発射するための超音波送信器である。１３
は前記超音波送信器１２の送信方向ｂにその受信
方向を有した超音波受信器である。同様に、１４
は９と反対方向ｃの方向に指向性の鋭い超音波を
発射する超音波送信器で、１５は前記超音波送信
器１４の送信方向ｃにその受信方向を有した超音
波受信器である。また同様に１６は１２と反対方
向ｄの方向に指向性の鋭い超音波を発射する超音
波送信器で、１７は前記超音波送信器１６の送信
方向ｄにその受信方向を有した超音波受信器であ
る。そして超音波送信器９，１２，１４，１６お
よび超音波受信器１０，１３，１５，１７は、前
記送受信器フレーム８に固定し、回転軸６を中心
に矢印７の方向に回転する。１８は走行ロボツト
の本体１の進行方向である。
る。第１図は、本発明の超音波送受信器を備えた
走行ロボツトの構成を示す平面図、第２図は、第
１図の超音波送受信器で得られたデータから走行
ロボツトの位置を演算する位置認識装置のブロツ
ク図である。第３図はロボツト位置認識装置を示
す図、第４図は、ロボツト位置認識のアルゴリズ
ムのフローチヤートである。第１図で、１は走行
ロボツトの本体、２，３，４，５は本体１を走行
させる車輪、６は本体１に取りつけ図は省略する
が回転装置で矢印７の方向に回軸する回転軸、８
は本体１の上部に位置し回転軸６に固定された超
音波送受信器を取りつけるための送受信器フレー
ム、９は送受信器フレーム８に固定され指向性の
鋭い超音波をａの方向に発射するための超音波送
信器、１０は前記超音波送信器９の超音波発射方
向と同一方向ａにその受信方向を有した超音波受
信器で、超音波送信器９からａの方向に発射され
た指向性の鋭い超音波が物体１１の面で反射さ
れ、ａ方向と反対の方向に返つて来た超音波を受
信する超音波受信器である。１２は、指向性の鋭
い超音波を前記超音波送信器９および超音波受信
器１０の超音波送受信方向ａより90゜ずれたｂの
方向に発射するための超音波送信器である。１３
は前記超音波送信器１２の送信方向ｂにその受信
方向を有した超音波受信器である。同様に、１４
は９と反対方向ｃの方向に指向性の鋭い超音波を
発射する超音波送信器で、１５は前記超音波送信
器１４の送信方向ｃにその受信方向を有した超音
波受信器である。また同様に１６は１２と反対方
向ｄの方向に指向性の鋭い超音波を発射する超音
波送信器で、１７は前記超音波送信器１６の送信
方向ｄにその受信方向を有した超音波受信器であ
る。そして超音波送信器９，１２，１４，１６お
よび超音波受信器１０，１３，１５，１７は、前
記送受信器フレーム８に固定し、回転軸６を中心
に矢印７の方向に回転する。１８は走行ロボツト
の本体１の進行方向である。
さて、第２図で、９，１２，１４，１６は第１
図で述べた超音波送信器、１０，１３，１５，１
７は第１図で述べた超音波受信器である。１９は
超音波送信器および超音波受信器と接続したＩ／
Ｏポートである。２０は、第１図の超音波送信器
９，１２，１４，１６の超音波発射方向および超
音波受信器１０，１３，１５，１７の超音波受信
方向である。ａ，ｂ，ｃ，ｄ方向とロボツト本体
１の進行方向１８との角度を測定する送受信器回
転角度測定器（第１図の構成での説明は省略して
あるが、例えばエンコーダを用いれば良い。）で
ある。２１は、送受信器回転角度測定器２０と接
続されたＩ／Ｏポートである。２２はロボツト位
置を演算するCPUなどの位置演算装置である。
そしてＩ／Ｏポート１９およびＩ／Ｏポート２１
と、位置演算装置２２とは、データバス２３で接
続されている。
図で述べた超音波送信器、１０，１３，１５，１
７は第１図で述べた超音波受信器である。１９は
超音波送信器および超音波受信器と接続したＩ／
Ｏポートである。２０は、第１図の超音波送信器
９，１２，１４，１６の超音波発射方向および超
音波受信器１０，１３，１５，１７の超音波受信
方向である。ａ，ｂ，ｃ，ｄ方向とロボツト本体
１の進行方向１８との角度を測定する送受信器回
転角度測定器（第１図の構成での説明は省略して
あるが、例えばエンコーダを用いれば良い。）で
ある。２１は、送受信器回転角度測定器２０と接
続されたＩ／Ｏポートである。２２はロボツト位
置を演算するCPUなどの位置演算装置である。
そしてＩ／Ｏポート１９およびＩ／Ｏポート２１
と、位置演算装置２２とは、データバス２３で接
続されている。
次に動作を説明する。第１図で、走行ロボツト
の本体１を、車輪２，３，４，５を駆動して進行
方向１８の方向に走行させる。同時に回転軸６を
反時計方向（矢印７）の方向に回転させておく
と、送受信器フレーム８に取り付けた超音波送信
器９，１２，１４，１６および超音波受信器１
０，１３，１５，１７は、超音波送受信方向ａ，
ｂ，ｃ，ｄは90゜ずれた状態で回転する。超音波
送信器９，１２，１４，１６と超音波受信器１
０，１３，１５，１７で得られる超音波送信信号
と受信信号はＩ／Ｏポート１９を経由して、ロボ
ツト位置演算装置２２に入力される。一方、レー
ダ回転角度測定器２０で得られる、第１図で示し
た超音波送信器９，１２，１４，１６及び超音波
受信器１０，１３，１５，１７の超音波送信方向
ａ，ｂ，ｃ，ｄのロボツト進行方向１８に対する
角度のデータ信号は第２図でＩ／Ｏポート２１を
経由して、位置演算装置２２に入力される。そし
て位置演算装置２２では、第４図のアルゴリズム
フローチヤートで示す演算処理を行い、ロボツト
の位置を求める。第４図の説明をする前に、部屋
の形について述べる。一般に、走行ロボツトが使
用される工場、家庭、オフイス、病院、学校など
の部屋は矩形である。
の本体１を、車輪２，３，４，５を駆動して進行
方向１８の方向に走行させる。同時に回転軸６を
反時計方向（矢印７）の方向に回転させておく
と、送受信器フレーム８に取り付けた超音波送信
器９，１２，１４，１６および超音波受信器１
０，１３，１５，１７は、超音波送受信方向ａ，
ｂ，ｃ，ｄは90゜ずれた状態で回転する。超音波
送信器９，１２，１４，１６と超音波受信器１
０，１３，１５，１７で得られる超音波送信信号
と受信信号はＩ／Ｏポート１９を経由して、ロボ
ツト位置演算装置２２に入力される。一方、レー
ダ回転角度測定器２０で得られる、第１図で示し
た超音波送信器９，１２，１４，１６及び超音波
受信器１０，１３，１５，１７の超音波送信方向
ａ，ｂ，ｃ，ｄのロボツト進行方向１８に対する
角度のデータ信号は第２図でＩ／Ｏポート２１を
経由して、位置演算装置２２に入力される。そし
て位置演算装置２２では、第４図のアルゴリズム
フローチヤートで示す演算処理を行い、ロボツト
の位置を求める。第４図の説明をする前に、部屋
の形について述べる。一般に、走行ロボツトが使
用される工場、家庭、オフイス、病院、学校など
の部屋は矩形である。
この部屋の形が矩形であることを前提にして、
第３図と第４図により、位置演算装置２２で行う
ロボツト位置認識のアルゴリズムを説明する。第
３図で、ロボツトの走行する矩形の部屋をOPQR
とし、走行ロボツトがＡ点からＢ点に動いたとす
る。その場合、位置演算装置２２では、第４図に
示すように、まず第２図の超音波送信器９，１
２，１４，１６と超音波受信器１０，１３，１
５，１７とで得られる超音波の発信信号と受信信
号とにより、超音波が発信されてから受信される
までの時間を計算する。この時間は位置演算装置
２２の内部クロツクのカウントで求める。次に上
記超音波の発信から受信までの時間と超音波速度
330m／ｓとをかけることで、第１図の回転軸６
から物体１１までの距離ｌを計算する。なおロボ
ツトの位置は回転軸６で考える。次に送受信器回
転角度測定器２０からの信号より、超音波送受信
器が第１図のロボツト進行方向から物体を検出す
るまでの時間を、位置演算装置２２の内部クロツ
クのカウントして求め、その時間と送受信器の回
転角速度ωo／ｓとをかけることにより、第１図
の物体１１のロボツト進行方向１８に対する角度
θを計算する。次に、物体を超音波の反射で検出
した時の回転角度測定器による角度データのうち
90゜ずれたデータ、すなわち第１図の超音波送信
器９，１２，１４，１６および超音波受信器１
０，１３，１５，１７で同時に得られるデータを
捜す。したがつて、ロボツトが第３図の矩形の部
屋OPQRのＡ点にあるとすれば、上記で捜した
90゜ずれた角度データに対応した距離データは、
la，lb，lc，ldである。そこで、基準になる座標を
第３図に示すように、Ａ点から距離laの物体位置
ａを通り線分Aaに対する垂直線ORをｙ軸とし、
Ａ点から距離lbの物体位置ｂを通り線分Abに対
する垂直線OPをｘ軸とし、ORとOPの交点を原
点Ｏとする座標を設定する。したがつてＡ点の座
標（x0，y0）は（la，lb）となる。次に上記座標
設定ずみかを判断する。そして座標が設定されて
いなければ、前記90゜ずれた物体検出の角度デー
タに対応した物体までの距離のデータla，lb，lc，
ldより部屋の形状を第３図のＡ点における矩形
OPQRと予測し、上記ｘ軸ｙ軸および原点とする
座標を設定する。上記座標がすでに設定されてい
れば、すなわち第３図のＢ点の座標を求める場
合、前記90゜ずれた角度と対応する距離のうち矩
形の部屋OPQRの壁までの距離と一致する距離デ
ータ、Ｂ点でのle，lf，lｇ，lhを捜し、Ｂ点の座
標（ｘ，ｙ）を（le，lf）とする。さらに、Ｂ点
の座標（ｘ，ｙ）を出発点Ａ点の座標（x0，y0）
と置き換え、第４図のアルゴリズムフローチヤー
トの処理を最初に戻し、ロボツトの位置Ｂ点の座
標（ｘ，ｙ）を次々に求める。以上の第３図と第
４図のアルゴリズムで走行ロボツトの位置を矩形
OPQRの部屋に対して相対的に認識する。
第３図と第４図により、位置演算装置２２で行う
ロボツト位置認識のアルゴリズムを説明する。第
３図で、ロボツトの走行する矩形の部屋をOPQR
とし、走行ロボツトがＡ点からＢ点に動いたとす
る。その場合、位置演算装置２２では、第４図に
示すように、まず第２図の超音波送信器９，１
２，１４，１６と超音波受信器１０，１３，１
５，１７とで得られる超音波の発信信号と受信信
号とにより、超音波が発信されてから受信される
までの時間を計算する。この時間は位置演算装置
２２の内部クロツクのカウントで求める。次に上
記超音波の発信から受信までの時間と超音波速度
330m／ｓとをかけることで、第１図の回転軸６
から物体１１までの距離ｌを計算する。なおロボ
ツトの位置は回転軸６で考える。次に送受信器回
転角度測定器２０からの信号より、超音波送受信
器が第１図のロボツト進行方向から物体を検出す
るまでの時間を、位置演算装置２２の内部クロツ
クのカウントして求め、その時間と送受信器の回
転角速度ωo／ｓとをかけることにより、第１図
の物体１１のロボツト進行方向１８に対する角度
θを計算する。次に、物体を超音波の反射で検出
した時の回転角度測定器による角度データのうち
90゜ずれたデータ、すなわち第１図の超音波送信
器９，１２，１４，１６および超音波受信器１
０，１３，１５，１７で同時に得られるデータを
捜す。したがつて、ロボツトが第３図の矩形の部
屋OPQRのＡ点にあるとすれば、上記で捜した
90゜ずれた角度データに対応した距離データは、
la，lb，lc，ldである。そこで、基準になる座標を
第３図に示すように、Ａ点から距離laの物体位置
ａを通り線分Aaに対する垂直線ORをｙ軸とし、
Ａ点から距離lbの物体位置ｂを通り線分Abに対
する垂直線OPをｘ軸とし、ORとOPの交点を原
点Ｏとする座標を設定する。したがつてＡ点の座
標（x0，y0）は（la，lb）となる。次に上記座標
設定ずみかを判断する。そして座標が設定されて
いなければ、前記90゜ずれた物体検出の角度デー
タに対応した物体までの距離のデータla，lb，lc，
ldより部屋の形状を第３図のＡ点における矩形
OPQRと予測し、上記ｘ軸ｙ軸および原点とする
座標を設定する。上記座標がすでに設定されてい
れば、すなわち第３図のＢ点の座標を求める場
合、前記90゜ずれた角度と対応する距離のうち矩
形の部屋OPQRの壁までの距離と一致する距離デ
ータ、Ｂ点でのle，lf，lｇ，lhを捜し、Ｂ点の座
標（ｘ，ｙ）を（le，lf）とする。さらに、Ｂ点
の座標（ｘ，ｙ）を出発点Ａ点の座標（x0，y0）
と置き換え、第４図のアルゴリズムフローチヤー
トの処理を最初に戻し、ロボツトの位置Ｂ点の座
標（ｘ，ｙ）を次々に求める。以上の第３図と第
４図のアルゴリズムで走行ロボツトの位置を矩形
OPQRの部屋に対して相対的に認識する。
次に、以上で得られたＡ点（x0，y0）の座標
（la，lb）とＢ点（ｘ，ｙ）の座標（le，lf）のデ
ータを使つたロボツトの走行制御の１例を述べ
る。第３図で、Ａ点ではＺの方向にロボツトを走
行させたいとする。したがつてＡ点のロボツト進
行方向は、角度θAの方向とする。しかし、実際に
はＺの方向（点線AZ）からずれてＢ点まで走行
し、Ｂ点での進行方向θBは、 θB＝tan-1ｙ−y0／ｘ−x0＝tan-1lf−lb／le−laに
なつたとす る。そこで、ロボツトがAZ線上を走行するよう
に、制御するには、Ａ点からＢ点までの距離Ｌは
√（−）2＋（−）2であるから、次に
めざす
位置をAZ線上のＢ点からの距離がＬであるＤ点
と設定し、Ｂ点での進行方向を上記θBから、Ｂ点
から上記Ｄ点の方向θDに進行方向を変える制御を
行う。この制御に関しては従来公知であるのでこ
こでは詳述しない。ただし、この例は、ロボツト
がほぼ定速で走行している場合である。次に、第
１図の超音波送信器および超音波受信器の組を、
その超音波発信および受信方向を90゜ずらせて２
個以上設ける必要性について述べる。本発明の走
行ロボツトの位置認識は、ロボツトを走行させる
部屋が矩形であると限定して、部屋の直交する壁
を基準にロボツトの位置を認識する方式である。
したがつて、前記Ｂ点の座標（ｘ，ｙ）を求める
のに第３図のｅ点とｆ点についてのデータが必要
なことからわかるように、超音波送受信器は90゜
ずらせて少なくとも２個設ける必要がある。もし
超音波送受信器を１個だけ設けけて、それを回転
して部屋の壁についての距離と方向のデータを測
定した場合、ロボツトの位置認識に誤差を生じ
る。その理由を説明すると、壁から超音波が反射
して帰つて来るまでの時間は、例えば3m離れた
壁（往復6m）については約18m secである。し
たがつて、3m離れた壁のデータを測定するのに
演算処理時間を含めると約20m secかかる。そこ
で、角度を1゜分割でデータを取つて行くと、矩形
の部屋のある壁のデータを測定してから直交した
次の壁のデータを測定するまでに1.8secかかる。
この間に走行ロボツトは、例えば速度30cm／sec
で走つているとすれば、次の直交する壁のデータ
を測定するまでにロボツトは約54cmも走行するの
でロボツトの位置の認識は54cmの誤差を生じる。
これに対して上記した超音波送受信器をその送受
信方向を90゜ずらせて２個設置すると、矩形の部
屋のある壁のデータを測定してから、直交した他
の壁のデータを測定するまでの時間は超音波の反
射して来る時間差だけである。例えばある壁まで
の距離が1mで直交する他の壁までの距離が4mと
すると、ある壁のデータを測定してから直交した
他の壁のデータを測定するまでの時間は、超音波
が壁から反射して来る時間差20m secだけで、ほ
ぼ同時にデータが測定でき、その間にロボツトが
走行する距離は、走行走度を30cm／ｓとすると約
６mmで、ほぼ無視できる誤差である。
（la，lb）とＢ点（ｘ，ｙ）の座標（le，lf）のデ
ータを使つたロボツトの走行制御の１例を述べ
る。第３図で、Ａ点ではＺの方向にロボツトを走
行させたいとする。したがつてＡ点のロボツト進
行方向は、角度θAの方向とする。しかし、実際に
はＺの方向（点線AZ）からずれてＢ点まで走行
し、Ｂ点での進行方向θBは、 θB＝tan-1ｙ−y0／ｘ−x0＝tan-1lf−lb／le−laに
なつたとす る。そこで、ロボツトがAZ線上を走行するよう
に、制御するには、Ａ点からＢ点までの距離Ｌは
√（−）2＋（−）2であるから、次に
めざす
位置をAZ線上のＢ点からの距離がＬであるＤ点
と設定し、Ｂ点での進行方向を上記θBから、Ｂ点
から上記Ｄ点の方向θDに進行方向を変える制御を
行う。この制御に関しては従来公知であるのでこ
こでは詳述しない。ただし、この例は、ロボツト
がほぼ定速で走行している場合である。次に、第
１図の超音波送信器および超音波受信器の組を、
その超音波発信および受信方向を90゜ずらせて２
個以上設ける必要性について述べる。本発明の走
行ロボツトの位置認識は、ロボツトを走行させる
部屋が矩形であると限定して、部屋の直交する壁
を基準にロボツトの位置を認識する方式である。
したがつて、前記Ｂ点の座標（ｘ，ｙ）を求める
のに第３図のｅ点とｆ点についてのデータが必要
なことからわかるように、超音波送受信器は90゜
ずらせて少なくとも２個設ける必要がある。もし
超音波送受信器を１個だけ設けけて、それを回転
して部屋の壁についての距離と方向のデータを測
定した場合、ロボツトの位置認識に誤差を生じ
る。その理由を説明すると、壁から超音波が反射
して帰つて来るまでの時間は、例えば3m離れた
壁（往復6m）については約18m secである。し
たがつて、3m離れた壁のデータを測定するのに
演算処理時間を含めると約20m secかかる。そこ
で、角度を1゜分割でデータを取つて行くと、矩形
の部屋のある壁のデータを測定してから直交した
次の壁のデータを測定するまでに1.8secかかる。
この間に走行ロボツトは、例えば速度30cm／sec
で走つているとすれば、次の直交する壁のデータ
を測定するまでにロボツトは約54cmも走行するの
でロボツトの位置の認識は54cmの誤差を生じる。
これに対して上記した超音波送受信器をその送受
信方向を90゜ずらせて２個設置すると、矩形の部
屋のある壁のデータを測定してから、直交した他
の壁のデータを測定するまでの時間は超音波の反
射して来る時間差だけである。例えばある壁まで
の距離が1mで直交する他の壁までの距離が4mと
すると、ある壁のデータを測定してから直交した
他の壁のデータを測定するまでの時間は、超音波
が壁から反射して来る時間差20m secだけで、ほ
ぼ同時にデータが測定でき、その間にロボツトが
走行する距離は、走行走度を30cm／ｓとすると約
６mmで、ほぼ無視できる誤差である。
さらに本実施例で超音波送受信器を４個設置し
た理由は、部屋の中に物があつて、ある方向の壁
についてのデータが得られない場合、少なくとも
２方の壁のデータが得られるようにするためであ
る。
た理由は、部屋の中に物があつて、ある方向の壁
についてのデータが得られない場合、少なくとも
２方の壁のデータが得られるようにするためであ
る。
次に本実施例の効果について述べる。本実施例
によれば、90゜ずらした超音波送受信器で部屋の
壁から超音波の反射して来る時間より、壁までの
距離と方向のデータが得られた時点での走行ロボ
ツトの位置を矩形の部屋に対して相対的に認識す
るので、従来技術の走行している床面状態により
車輪がスリツプして車輪の回転数と実際に走つた
距離や進行方向の計測に誤差が生じたり、車輪の
回転数の累積計算した場合の累積誤差がないの
で、ロボツトの位置を正確に認識できる効果があ
る。
によれば、90゜ずらした超音波送受信器で部屋の
壁から超音波の反射して来る時間より、壁までの
距離と方向のデータが得られた時点での走行ロボ
ツトの位置を矩形の部屋に対して相対的に認識す
るので、従来技術の走行している床面状態により
車輪がスリツプして車輪の回転数と実際に走つた
距離や進行方向の計測に誤差が生じたり、車輪の
回転数の累積計算した場合の累積誤差がないの
で、ロボツトの位置を正確に認識できる効果があ
る。
本実施例では、超音波送受信器を90゜ずらせて
４個設置する例について説明した。この４個とし
た理由は矩形の部屋に対応させて、４方の壁から
の超音波の反射を同時に受信できるようにしたい
ためである。しかし第３図の走行ロボツトの位置
Ｂの（ｘ，ｙ）の座標は、少なくとも直交する２
方の壁についてのデータすなわちleとlf，・lfと
lｇ・lｇとlh・lhとleのいずれかが測定されれば求
めることができる。したがつて、本発明の超音波
送受信器は、その送受信方向を90゜ずらせて少な
くとも２個以上（２個、３個、４個）すなわち複
数個設ければよいが、部屋の壁との間に物がある
場合、部屋の壁についてのデータが得られないこ
とが考えられるので安全性を考え４個としたもの
である。
４個設置する例について説明した。この４個とし
た理由は矩形の部屋に対応させて、４方の壁から
の超音波の反射を同時に受信できるようにしたい
ためである。しかし第３図の走行ロボツトの位置
Ｂの（ｘ，ｙ）の座標は、少なくとも直交する２
方の壁についてのデータすなわちleとlf，・lfと
lｇ・lｇとlh・lhとleのいずれかが測定されれば求
めることができる。したがつて、本発明の超音波
送受信器は、その送受信方向を90゜ずらせて少な
くとも２個以上（２個、３個、４個）すなわち複
数個設ければよいが、部屋の壁との間に物がある
場合、部屋の壁についてのデータが得られないこ
とが考えられるので安全性を考え４個としたもの
である。
なお本発明の超音波送受信器の数を例えば45゜
ずつずらせて８個すなわち90゜ずらせた４個の組
を２組設けたり、30゜ずらせて12個すなわち90゜ず
らせた組を３組設けたり、さらに増して４組、５
組などとすることは、90゜ずらせた超音波受信器
を複数個備えた構成の組合せなので本発明の範中
に入るものである。以上のように超音波送受信器
の数を増すと価格の面では不利であるが、部屋の
壁との間に数多くの物体がある場合に部屋の壁か
らのデータをより確実に得ることができ、ロボツ
トの位置を正確に認識できる効果がある。
ずつずらせて８個すなわち90゜ずらせた４個の組
を２組設けたり、30゜ずらせて12個すなわち90゜ず
らせた組を３組設けたり、さらに増して４組、５
組などとすることは、90゜ずらせた超音波受信器
を複数個備えた構成の組合せなので本発明の範中
に入るものである。以上のように超音波送受信器
の数を増すと価格の面では不利であるが、部屋の
壁との間に数多くの物体がある場合に部屋の壁か
らのデータをより確実に得ることができ、ロボツ
トの位置を正確に認識できる効果がある。
本発明によれば、走行ロボツトの位置を正確に
認識できる効果がある。なぜなら、一般に家庭、
オフイス、工場、病院、学校などの部屋や廊下な
どの形は矩形である。したがつて、矩形の部屋の
中で本発明のロボツト位置認識装置を備えた走行
ロボツトを走らせた場合、超音波送受信方向を
90゜ずらせた複数個の超音波送受信器で、超音波
が発射されてから部屋の壁から反射されて受信器
で受信されるまでの時間と超音波速度より、部屋
の壁までの距離と方向を測定し、第３図に示すよ
うに、矩形の部屋の少なくとも直交した２方の壁
についての距離と方向のデータが得られた時点で
の走行ロボツトの位置が誤差の累積がなく認識で
きるので、従来技術における車輪の回転数を回転
計で測定し、走行距離と進行方向を累積計算し
て、それらの値からロボツトの位置を計算で求め
る場合の走行している床面状態により車輪のスリ
ツプが生じ、走行距離、走行方向に誤差が生じ
て、求めたロボツトの位置の計算に誤差が累積し
てロボツトの位置を正しく認識できないような欠
点がなくなり、本発明によれば、走行ロボツトの
位置を矩形の部屋に対して正確に認識できる効果
がある。
認識できる効果がある。なぜなら、一般に家庭、
オフイス、工場、病院、学校などの部屋や廊下な
どの形は矩形である。したがつて、矩形の部屋の
中で本発明のロボツト位置認識装置を備えた走行
ロボツトを走らせた場合、超音波送受信方向を
90゜ずらせた複数個の超音波送受信器で、超音波
が発射されてから部屋の壁から反射されて受信器
で受信されるまでの時間と超音波速度より、部屋
の壁までの距離と方向を測定し、第３図に示すよ
うに、矩形の部屋の少なくとも直交した２方の壁
についての距離と方向のデータが得られた時点で
の走行ロボツトの位置が誤差の累積がなく認識で
きるので、従来技術における車輪の回転数を回転
計で測定し、走行距離と進行方向を累積計算し
て、それらの値からロボツトの位置を計算で求め
る場合の走行している床面状態により車輪のスリ
ツプが生じ、走行距離、走行方向に誤差が生じ
て、求めたロボツトの位置の計算に誤差が累積し
てロボツトの位置を正しく認識できないような欠
点がなくなり、本発明によれば、走行ロボツトの
位置を矩形の部屋に対して正確に認識できる効果
がある。
また本発明によれば、走行ロボツトの位置を周
囲の部屋の形状に対して相対的に認識できるの
で、従来の車輪の回転数を測定する回転計を備え
た走行ロボツトでは部屋の壁にぶつからないよう
にするために周囲の部屋の形状を検知する接触セ
ンサなどの装置が必要であるが、本発明ではその
装置が不要になる効果がある。
囲の部屋の形状に対して相対的に認識できるの
で、従来の車輪の回転数を測定する回転計を備え
た走行ロボツトでは部屋の壁にぶつからないよう
にするために周囲の部屋の形状を検知する接触セ
ンサなどの装置が必要であるが、本発明ではその
装置が不要になる効果がある。
さらに本発明では、特に一般家庭、オフイス、
工場、病院、学校などの部屋や廊下の矩形の壁で
囲まれた場所での走行ロボツトの位置認識に適し
ている特有の効果もある。
工場、病院、学校などの部屋や廊下の矩形の壁で
囲まれた場所での走行ロボツトの位置認識に適し
ている特有の効果もある。
第１図は、本発明の走行ロボツトの位置認識装
置を備えた走行ロボツトの全体構成を示す平面
図、第２図は、走行ロボツトの位置を演算する位
置認識装置のブロツク図、第３図は、本発明の矩
形の部屋に対するロボツト位置の認識方法を示す
座標を示す図、第４図は、ロボツト位置認識アル
ゴリズムのフローチヤート図である。 １…ロボツト本体、２，３，４，５…車輪、６
…回転軸、８…送受信器フレーム、９，１２，１
４，１６…超音波送信器、１０，１３，１５，１
７…超音波受信器、１９…Ｉ／Ｏポート、２０…
超音波送受信器の回転角度測定器、２１…Ｉ／Ｏ
ポート、２２…ロボツト位置演算装置。
置を備えた走行ロボツトの全体構成を示す平面
図、第２図は、走行ロボツトの位置を演算する位
置認識装置のブロツク図、第３図は、本発明の矩
形の部屋に対するロボツト位置の認識方法を示す
座標を示す図、第４図は、ロボツト位置認識アル
ゴリズムのフローチヤート図である。 １…ロボツト本体、２，３，４，５…車輪、６
…回転軸、８…送受信器フレーム、９，１２，１
４，１６…超音波送信器、１０，１３，１５，１
７…超音波受信器、１９…Ｉ／Ｏポート、２０…
超音波送受信器の回転角度測定器、２１…Ｉ／Ｏ
ポート、２２…ロボツト位置演算装置。
Claims (1)
- 【特許請求の範囲】 １ 指向性の鋭い超音波を発射し、物体から反射
して来た超音波を受信することにより物体までの
距離と物体位置のロボツトから見た方向とを測定
する超音波送受信器を、その超音波送受信方向を
90゜ずらせて複数個配置し、かつそれらの超音波
送受信器を同一軸を中心に回転させて周囲全体の
物体についての上記距離と方向のデータを計測す
る構造とした超音波計測装置を設け、 ロボツトの移動前に該超音波計測装置で得られ
た90゜ずれた方向に対する複数個の距離データか
ら、周囲全体の物体を矩形と予測して基準直交座
標を設定した後、 ロボツトの移動後に得られた90゜のずれた方向
に対する複数個の距離データにより、上記基準直
交座標に基づいて移動後のロボツトの位置を計算
することを特徴とする走行ロボツトの位置認識装
置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58224189A JPS60117168A (ja) | 1983-11-30 | 1983-11-30 | 走行ロボットの位置認識装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58224189A JPS60117168A (ja) | 1983-11-30 | 1983-11-30 | 走行ロボットの位置認識装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS60117168A JPS60117168A (ja) | 1985-06-24 |
| JPH0412433B2 true JPH0412433B2 (ja) | 1992-03-04 |
Family
ID=16809913
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP58224189A Granted JPS60117168A (ja) | 1983-11-30 | 1983-11-30 | 走行ロボットの位置認識装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS60117168A (ja) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102004251A (zh) * | 2010-09-27 | 2011-04-06 | 北京航空航天大学 | 一种基于万象盘的水平扫描超声波测距仪 |
| CN104260092B (zh) * | 2014-07-08 | 2015-12-30 | 大连理工大学 | 一种自动跟踪机器人控制装置及自动跟踪机器人 |
| CN107972042A (zh) * | 2017-11-24 | 2018-05-01 | 合肥博焱智能科技有限公司 | 基于人工智能的泳池救援机器人救援方法及装置 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS57108777A (en) * | 1980-12-26 | 1982-07-06 | Toshiba Corp | Position detector |
-
1983
- 1983-11-30 JP JP58224189A patent/JPS60117168A/ja active Granted
Also Published As
| Publication number | Publication date |
|---|---|
| JPS60117168A (ja) | 1985-06-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US8060256B2 (en) | Apparatus, method, and medium for localizing moving robot and transmitter | |
| US6289282B1 (en) | Method of determining the distance between and object and a device of varying location | |
| US6396435B1 (en) | Method for determining the vertical distance between an object and a device with a variable position | |
| JP3480576B2 (ja) | 自律した装置のために障害物を感知する方法及び装置 | |
| US20050043039A1 (en) | Position detecting system, and transmitting and receiving apparatuses for the position detecting system | |
| JPH07306042A (ja) | セルラ構造の周辺地図の作成方法および装置 | |
| US10473759B2 (en) | Tool for automatic multiple radar calibration | |
| JP2000056006A (ja) | 移動体の位置認識装置 | |
| CN112119330B (zh) | 物体检测装置及物体检测方法 | |
| JPH11295412A (ja) | 移動体の位置認識装置 | |
| CN114415662B (zh) | 一种智能机器人避障方法及装置 | |
| JPH0412433B2 (ja) | ||
| EP0492015A1 (en) | Method and apparatus for navigating an automatic guided vehicle | |
| Shoval et al. | Measurement of angular position of a mobile robot using ultrasonic sensors | |
| JPH0248069B2 (ja) | ||
| JPH05257530A (ja) | 移動ロボットの方位及び位置の較正方法並びに装置 | |
| CN114637024A (zh) | 激光定位系统及方法 | |
| JP2944481B2 (ja) | 水中アクティブ音響探知装置 | |
| US12313770B2 (en) | System and method for radar calibration | |
| CA2107198A1 (en) | Method and apparatus for accurate acoustic distance measurement | |
| JPH0587792B2 (ja) | ||
| WO2025229882A1 (ja) | 測位システム | |
| JPH06118170A (ja) | 音響測位装置 | |
| JP3493570B2 (ja) | 移動体の瞬時位置測定法及び装置 | |
| CN118209216A (zh) | 使用超声传感器系统确定空气温度的方法、确定距离的方法及超声传感器系统 |