JP2020076663A - 無人移動体及び無人移動体の制御方法 - Google Patents

Abstract

【課題】装備コストの上昇を抑え、高度が低い太陽の方向に向かって走行する場合も支障なく自律走行でき、オーバーハングの障害物があるときには、この障害物を確実に検出し得る無人移動体及び無人移動体の制御方法を提供する。【解決手段】レーザレーザレンジファインダ３１と、自己位置日時計測部と、進行方向情報，自己位置情報を処理する車両制御用コンピュータ１０を備え、車両制御用コンピュータ１０は、太陽Ｓｕからの直接光を障害物として誤検出するのを防ぐための太陽位置算出手段１０ａと、センサ視野範囲算出手段１０ｂと、太陽光判定手段１０ｃを具備していると共に、レーザレンジファインダ３１の視野範囲にオーバーハングの障害物Ｔが入った場合のデータ及びレーザレンジファインダ３１の視野範囲に太陽Ｓｕからの直接光が入った場合のデータを分離する強度値判定手段１０ｄ及び測距値判定手段１０ｅを具備している。【選択図】図２

Description

本発明は、自律又は半自律移動可能な無人移動体に関わり、特に、進行方向の情報を取得するレーザセンサとして、半導体レーザ光を照射するレーザセンサを搭載した無人移動体及び無人移動体の制御方法に関するものである。

従来、上記したような進行方向の情報を取得するレーザセンサを搭載した自律又は半自律移動可能な無人移動体としては、例えば、特許文献１に記載された自律走行車がある。

この自律走行車は、自律して走行させるための走行機構と、レーザ光を走査して進行方向の情報を取得するレーザレンジファインダ（レーザセンサ）と、自己位置情報である自己位置，自己姿勢角及び自己方位を取得するＧＰＳ，ＩＭＵ（慣性計測装置）等の自己位置計測部と、レーザレンジファインダで得た進行方向の情報及び自己位置計測部で得た自己位置情報が入力される制御部を備えている。

レーザレンジファインダには、コスト面の事情により半導体レーザ光を照射するレーザレンジファインダが用いられ、制御部は、このレーザレンジファインダで取得した進行方向の情報及び自己位置計測部で得た自己位置情報の解析を行って走行経路を生成すると共に、この走行経路に基づいて走行速度を設定し、これらの走行経路及び走行速度に従って走行機構であるモータドライバを介して操舵用アクチュエータ及びブレーキ／アクセル用アクチュエータを作動させるようになっている。

ここで、この自律走行車が、朝方や夕方に高度が低い太陽の方向に向かって走行したり、斜面を太陽の方向に向かって登ったりする際には、太陽からの直接光がレーザレンジファインダの視野範囲に入ることが頻繁に起こり得る。

レーザレンジファインダで用いる半導体レーザ光の波長は太陽光の周波数帯に含まれているので、上記のように太陽からの直接光がレーザレンジファインダの視野範囲に入った場合には、図４のレーザ光走査結果に示すように、太陽からの直接光がノイズＮとなって誤計測が生じ、太陽からの直接光を障害物として誤検出してしまい、自律走行車１００の自律走行に支障を来す可能性がある。

従来において、太陽からの直接光を障害物として誤検出しないための対策が施された進行方向の情報取得手段としては、例えば、特許文献２に記載された車両用前方障害物検出装置がある。
この車両用前方障害物検出装置もレーザセンサを備えたものであり、自己の位置及び日時に基づいて太陽の位置を算出し、レーザセンサと太陽を結ぶ直線がレーザセンサの視野範囲にあるか否かを自己姿勢に基づいて算出する。

そして、この車両用前方障害物検出装置では、レーザセンサと太陽を結ぶ直線がレーザセンサの視野範囲にある場合には、太陽からの直接光を障害物として誤検出する可能性ありと判定して計測データを無効化し、一方、レーザセンサと太陽を結ぶ直線がレーザセンサの視野範囲にない場合には、太陽の直接光による障害を受けないと判定して計測データを有効化するようにしている。

特開2012-159954号 特開2005-180994号

ところが、上記した車両用前方障害物検出装置を搭載した自律走行車では、太陽からの直接光を障害物として誤検出することを防ぐことはできるものの、レーザセンサと太陽を結ぶ直線がレーザセンサの視野範囲にある場合において、制御部で生成した走行経路上に覆いかぶさるようにせり出す樹木の枝や大きな岩等のオーバーハングの障害物がレーザセンサの視野範囲に存在するときには、レーザセンサで計測して取得したこの障害物のデータも無効化されてしまうので、このオーバーハングの障害物を検出することができない虞があるという問題を有している。

この際、このデメリットを補うべく、太陽光の周波数帯に含まれない波長の、例えば、ファイバーレーザを使用する場合には、装備コストが嵩んでしまい好ましくないという問題があり、これらの問題を解決することが従来の課題となっていた。

本発明は、上記した従来の課題に着目してなされたもので、高度が低い太陽の方向に向かって走行したり、斜面を太陽の方向に向かって登ったりする場合であったとしても、高価なレーザセンサを用いることなく、支障なく自律走行することができるのは勿論のこと、走行経路上に覆いかぶさるようにせり出す樹木の枝や大きな岩等のオーバーハングの障害物がレーザセンサの視野範囲にあるときには、このオーバーハングの障害物を確実に検出して危険を回避することが可能である無人移動体及び無人移動体の制御方法を提供することを目的としている。

本発明の第１の態様は、自律又は半自律して走行する無人移動体であって、自律又は半自律して走行させるための走行機構と、半導体レーザ光を走査して進行方向の情報を取得するレーザセンサと、自己位置情報である自己位置，自己姿勢角及び自己方位並びに日時を取得する自己位置日時計測部と、前記進行方向の情報及び前記自己位置情報に基づいて前記走行機構を動作させる制御部を備えた無人移動体において、前記制御部には、前記自己位置日時計測部で計測した自己位置，自己姿勢角及び自己方位並びに日時に基づいて太陽の位置である太陽高度及び太陽方位を算出する太陽位置算出手段と、前記太陽位置算出手段で算出した太陽高度及び太陽方位の太陽からの直接光を受光し得る前記レーザセンサの視野範囲を前記自己位置日時計測部で計測した自己位置，自己姿勢角及び自己方位並びに日時に基づいて算出するセンサ視野範囲算出手段と、前記レーザセンサで取得した計測点が前記センサ視野範囲算出手段で算出した前記レーザセンサの視野範囲にあるか否かを判定して、前記レーザセンサで取得した計測点が前記レーザセンサの視野範囲になくて前記太陽位置算出手段で算出した太陽の位置と一致しないと判定した場合には前記計測点のデータを有効化する太陽光判定手段と、が具備されていると共に、前記レーザセンサによって取得した計測点が前記レーザセンサの視野範囲にあって前記太陽位置算出手段で算出した太陽の位置と一致すると前記太陽光判定手段で判定した場合に前記計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かを判定して、前記計測点のデータの受光強度値が前記強度閾値未満でないと判定した場合には前記計測点のデータを有効化する強度値判定手段、及び、前記計測点のデータの測距値が予め定めた測距閾値未満であるか否かを判定して、前記測距値が前記測距閾値未満でないと判定した場合には前記計測点のデータを有効化し、前記測距値が前記測距閾値未満であると判定した場合には前記計測点のデータを無効化する測距値判定手段のうちの少なくともいずれか一方の判定手段が具備されている構成としている。

一方、本発明の第２の態様は、自律又は半自律走行する無人移動体の制御方法であって、前記無人移動体に搭載したレーザセンサからの半導体レーザ光を走査して前記無人移動体の進行方向の情報を取得すると共に、該無人移動体の自己位置情報である自己位置，自己姿勢角及び自己方位並びに日時を取得して自律又は半自律走行する無人移動体の制御方法において、前記無人移動体の自己位置，自己姿勢角及び自己方位並びに日時に基づいて太陽の位置である太陽高度及び太陽方位を算出し、算出した太陽高度及び太陽方位の太陽からの直接光を受光し得る前記レーザセンサの視野範囲を自己位置，自己姿勢角及び自己方位並びに日時に基づいて算出し、前記レーザセンサで取得した計測点が算出した前記レーザセンサの視野範囲にあるか否かを判定して、前記レーザセンサで取得した計測点が前記レーザセンサの視野範囲になくて前記算出した太陽の位置と一致しないと判定した場合には前記計測点のデータを有効化し、前記レーザセンサによって取得した計測点が前記レーザセンサの視野範囲にあって前記算出した太陽の位置と一致すると判定した場合に、前記計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かの判定、及び、前記計測点のデータの測距値が予め定めた測距閾値未満であるか否かの判定の少なくともいずれか一方の判定を行って、前記計測点のデータの受光強度値が前記強度閾値未満でないと判定した場合及び前記計測点のデータの測距値が前記測距閾値未満でないと判定した場合にはいずれも前記計測点のデータを有効化し、前記計測点のデータの受光強度値が前記強度閾値未満であると判定した場合及び前記計測点のデータの測距値が前記測距閾値未満であると判定した場合にはいずれも前記計測点のデータを無効化する構成としている。

本発明に係る無人移動体及び無人移動体の制御方法において、レーザセンサからの半導体レーザ光を走査しつつ自律又は半自律走行する際に、レーザセンサの視野範囲に太陽からの直接光が入った場合に計測されるデータはノイズであり、このデータには測距値が小さく且つ強度値が小さい（レーザセンサには、通常、太陽光成分を除去するハイパスフィルタが内蔵されているので、太陽の直接光の影響を受けると、受光強度値が小さくなる。）といった特徴がある。

一方、走行経路上に覆いかぶさるようにせり出す樹木の枝や大きな岩等のオーバーハングの障害物が存在する場合には、レーザセンサの視野範囲にこの障害物が入ったときに計測されるデータには測距値が大きく且つ強度値が大きいといった特徴がある。

本発明に係る無人移動体及び無人移動体の制御方法では、レーザセンサの視野範囲に太陽からの直接光が入った場合と、レーザセンサの視野範囲にオーバーハングの障害物が入った場合との各データの特徴の違いを用いることで、太陽の直接光とオーバーハングの障害物との各データを分離するようにしている。

本発明の第１の態様に係る無人移動体及び第２の態様に係る無人移動体の制御方法において、高度が低い太陽の方向に向かって走行したり、斜面を太陽の方向に向かって登ったりする場合であったとしても、高価なレーザセンサを用いることなく、支障なく自律又は半自律走行することができ、加えて、走行経路上に覆いかぶさるようにせり出す樹木の枝や大きな岩等のオーバーハングの障害物があるときには、このオーバーハングの障害物を太陽の直接光によるノイズと誤判定することなく確実に検出して危険を回避することが可能であるという非常に優れた効果がもたらされる。

本発明の一実施例による無人移動体としての自律走行車の概略構成説明図（ａ）及び平面説明図(ｂ)である。 図１における自律走行車の制御機器の接続ブロック図である。 図１に示した自律走行車の制御方法における環境認識モジュールの動作フローチャートである。 レーザセンサの視野範囲に太陽からの直接光が入った場合に計測されるノイズを含むレーザ光走査結果説明図である。

以下、本発明の実施例を図面に基づいて説明する。
図１〜図３は、本発明の一実施例による無人移動体及び無人移動体の制御方法を示している。

この実施例において、無人移動体は、自律して走行可能な自律走行車Ａであり、図１及び図２に示すように、車両制御用コンピュータ（制御部）１０及びこの車両制御用コンピュータ１０とＬＡＮ１１を介して接続される自律走行用コンピュータ（制御部）３０によって制御されるようになっている。

車両制御用コンピュータ１０の入力側には、アンテナ１２と接続する無線ＬＡＮ１３が入出力回路１５を介して接続されていると共に、自己位置情報（自己位置の他に姿勢角及び方位並びに日時を含む）を求める自己位置日時計測部としてのＧＰＳ１６や姿勢制御用バーチカルジャイロ１７や移動速度測定用車速パルス１８や図示しないＩＭＵ（慣性計測装置）がシリアル回線を介して接続されている。

また、車両制御用コンピュータ１０の出力側には、モータドライバ２１を介して操舵用アクチュエータ２２及びブレーキ／アクセル用アクチュエータ２３が接続されており、モータドライバ２１とアクチュエータ２２，２３と車輪２４とで走行機構２０を構成している。

車両制御用コンピュータ１０は、ＧＰＳ１６やバーチカルジャイロ１７で取得した各種情報をＬＡＮ１１，無線ＬＡＮ１３及びアンテナ１２を介して図示しない指令所に送信する機能を有していると共に、この指令所から緊急時等に送信される指令に基づいて、モータドライバ２１を介して操舵用アクチュエータ２２及びブレーキ／アクセル用アクチュエータ２３を作動、停止させる機能を有している。

一方、自律走行用コンピュータ３０の入力側には、進行方向における地形の凹凸の近距離情報取得に適したレーザレンジファインダ（レーザセンサ）３１と、遠距離で且つ広角情報取得に適した自律走行用のステレオカメラ３２と、車高以上の起立した障害物を検出する障害物用レーザレンジファインダ（レーザセンサ）３３が接続されており、レーザレンジファインダ３１，３３には、半導体レーザ光を照射するレーザレンジファインダが用いられている。この自律走行用コンピュータ３０は、ＬＡＮ１１を介して、レーザレンジファインダ３１やステレオカメラ３２や障害物用のレーザレンジファインダ３３で取得した測距データを車両制御用コンピュータ１０に送信する機能を有している。

そして、上記車両制御用コンピュータ１０は、レーザレンジファインダ３１で取得した進行方向の測距情報及び自己位置日時計測部のＧＰＳ１６やバーチカルジャイロ１７で得た自己位置情報の解析を行って走行経路を生成すると共に、この走行経路に基づいて走行速度を設定する環境認識モジュール１０Ａを有しており、この環境認識モジュール１０Ａで作成設定した走行経路及び走行速度に従って、走行機構２０であるモータドライバ２１を介して操舵用アクチュエータ２２及びブレーキ／アクセル用アクチュエータ２３を作動させるようになっている。

この場合、太陽Ｓｕからの直接光を障害物として誤検出してしまうのを防ぐために、上記車両制御用コンピュータ１０の環境認識モジュール１０Ａには、太陽位置算出手段１０ａと、センサ視野範囲算出手段１０ｂと、太陽光判定手段１０ｃが具備されている。

太陽位置算出手段１０ａは、自己を基準にした太陽Ｓｕの位置である太陽高度及び太陽方位を算出する手段であり、自己位置日時計測部のＧＰＳ１６やバーチカルジャイロ１７で計測した自己位置（緯度・経度），自己姿勢角（ピッチ角・ロール角），自己方位（ヨー角）及び日時に基づいて、太陽高度及び太陽方位を算出する。

センサ視野範囲算出手段１０ｂは、太陽位置算出手段１０ａで算出した太陽高度及び太陽方位の太陽Ｓｕからの直接光を受光し得る近距離情報取得に適したレーザレンジファインダ３１の視野範囲（視野角θ，φ）を自己位置日時計測部のＧＰＳ１６やバーチカルジャイロ１７で計測した自己位置，自己姿勢角，自己方位及び日時に基づいて算出する。ここで、レーザレンジファインダ３１の視野範囲とは、レーザレンジファインダ３１のレーザ光走査範囲内において、太陽Ｓｕからの直接光を受光する範囲のことである。
なお、車高以上の起立した障害物を検出する障害物用のレーザレンジファインダ３３は、レーザ光をほぼ水平方向に照射させるので、太陽Ｓｕからの直接光を受光し得る視野範囲の算出はとくに行わない。

太陽光判定手段１０ｃは、レーザレンジファインダ３１で取得した計測点がセンサ視野範囲算出手段１０ｂで算出したレーザレンジファインダ３１の視野範囲にあるか否かを判定する、すなわち、計測点が太陽位置算出手段１０ａで算出した太陽Ｓｕの位置と一致したか否かを判定する。

上記車両制御用コンピュータ１０の環境認識モジュール１０Ａにおける太陽光判定手段１０ｃでは、レーザレンジファインダ３１で取得した計測点がレーザレンジファインダ３１の視野範囲にない、すなわち、計測点が太陽位置算出手段１０ａで算出した太陽Ｓｕの位置と一致しないと判定した場合には計測点のデータを有効化する。

一方、レーザレンジファインダ３１で取得した計測点がレーザレンジファインダ３１の視野範囲にある、すなわち、計測点が太陽位置算出手段１０ａで算出した太陽Ｓｕの位置と一致すると判定した場合には、この時点で計測点のデータを無効化する、すなわち、計測点のデータが障害物として表されたとしても太陽Ｓｕからの直接光によるものとする。

ここで、レーザレンジファインダ３１で取得した計測点が太陽Ｓｕの位置と一致すると判定した際に、レーザレンジファインダ３１の視野範囲にオーバーハングの障害物（例えば、走行経路上に覆いかぶさるようにせり出す樹木の枝）Ｔが実際に存在する場合において、この障害物Ｔのデータが無効化されるのを回避するために、上記車両制御用コンピュータ１０の環境認識モジュール１０Ａには、強度値判定手段１０ｄと、測距値判定手段１０ｅが具備されている。

レーザレンジファインダ３１の視野範囲に太陽Ｓｕからの直接光が入った場合に計測されるノイズのデータには、測距値が小さく且つ受光強度値が小さい（レーザレンジファインダ３１には、通常、太陽光成分を除去するハイパスフィルタが内蔵されているので、太陽Ｓｕの直接光の影響を受けると、受光強度値が小さくなる。）といった特徴があり、一方、レーザレンジファインダ３１の視野範囲に障害物Ｔが入ったときに計測されるデータには、測距値が大きく且つ受光強度値が大きいといった特徴がある。

強度値判定手段１０ｄ及び測距値判定手段１０ｅでは、上記の双方の特徴に基づいて、レーザレンジファインダ３１の視野範囲にオーバーハングの障害物Ｔが入った場合のデータをレーザレンジファインダ３１の視野範囲に太陽Ｓｕからの直接光が入った場合のデータから分離するようにしている。

具体的には、強度値判定手段１０ｄにおいて、レーザレンジファインダ３１により取得した計測点が太陽光判定手段１０ｃでレーザレンジファインダ３１の視野範囲にある、すなわち、計測点が太陽Ｓｕの位置と一致すると判定した場合には、計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かを判定して、計測点のデータの受光強度値が強度閾値未満でない（受光強度値が大きい）と判定した場合には計測点のデータを有効化し、受光強度値が強度閾値未満であると判定した場合には計測点のデータを無効化する。

一方、測距値判定手段１０ｅは、強度値判定手段１０ｄで計測点のデータの受光強度値が強度閾値未満であると判定した場合において、測距値が予め定めた測距閾値未満であるか否かを判定して、測距値が測距閾値未満でない（測距値が大きい）と判定した場合には計測点のデータを有効化し、測距値が測距閾値未満であると判定した場合には計測点のデータを無効化する。

なお、強度値判定手段１０ｄ及び測距値判定手段１０ｅは、少なくともいずれか一方の判定手段が備わっていれば、実際に存在する障害物Ｔのデータが無効化されるのを回避することが可能であるが、オーバーハングの障害物Ｔを太陽Ｓｕの直接光によるノイズと誤判定することなく確実に検出するために、強度値判定手段１０ｄ及び測距値判定手段１０ｅをいずれも具備することが望ましい。

そこで、上記車両制御用コンピュータ１０による制御要領を具体的に説明する。まず、図３に示すように、ステップＳ１において、自律走行車Ａに搭載したレーザレンジファインダ３１からの半導体レーザ光を走査して、自律走行車Ａの進行方向における路面の凹凸や障害物の有無等の情報を取得するのに続いて、自己位置日時計測部のＧＰＳ１６やバーチカルジャイロ１７によって自律走行車Ａの自己位置の緯度及び経度を取得すると共に、自律走行車Ａの自己方位及び自己姿勢角並びに現在の日時を取得する。

次いで、ステップＳ２において、ステップＳ１で取得した自律走行車Ａの自己位置，自己方位及び自己姿勢角並びに日時に基づいて太陽Ｓｕの位置である太陽高度及び太陽方位を算出する。
なお、自律走行車Ａの自己位置（緯度・経度），自己方位及び自己姿勢角、並びに、日時に基づく太陽高度及び太陽方位は、既知の計算手順で算出することができる。

次に、ステップＳ３において、ステップＳ２で算出した太陽高度及び太陽方位の太陽Ｓｕからの直接光を受光し得るレーザレンジファインダ３１の視野範囲をステップＳ１で取得した自律走行車Ａの自己位置，自己姿勢角，自己方位及び日時に基づいて算出し、ステップＳ４において、太陽Ｓｕからの直接光を受光し得るレーザレンジファインダ３１により取得した計測点がレーザレンジファインダ３１の視野範囲にある、すなわち、計測点が算出した太陽Ｓｕの位置と一致するか否かを判定する。

そして、ステップＳ４において、レーザレンジファインダ３１で取得した計測点が算出した太陽Ｓｕの位置と一致しない（Ｎｏ）と判定した場合には、ステップＳ５において計測点のデータを有効化し、レーザレンジファインダ３１で取得した計測点が算出した太陽Ｓｕの位置と一致する（Ｙｅｓ）と判定した場合には、ステップＳ６において、計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かを判定する。

続いて、ステップＳ６において、計測点のデータの受光強度値が強度閾値未満でない（Ｎｏ）と判定した場合には、ステップＳ５において計測点のデータを有効化し、計測点のデータの受光強度値が強度閾値未満である（Ｙｅｓ）と判定した場合には、ステップＳ７において、計測点のデータの測距値が予め定めた測距閾値未満であるか否かを判定する。

次いで、ステップＳ７において、測距値が測距閾値未満でない（Ｎｏ）と判定した場合には、ステップＳ５において計測点のデータを有効化し、測距値が測距閾値未満である（Ｙｅｓ）と判定した場合には、ステップＳ８において計測点のデータを無効化する。

上記したように、この実施例による自律走行車Ａでは、太陽位置算出手段１０ａ，センサ視野範囲算出手段１０ｂ及び太陽光判定手段１０ｃが具備された車両制御用コンピュータ１０の環境認識モジュール１０Ａに、強度値判定手段１０ｄ及び測距値判定手段１０ｅを具備させることで、レーザレンジファインダ３１の視野範囲にオーバーハングの障害物Ｔが入った場合のデータと、レーザレンジファインダ３１の視野範囲に太陽Ｓｕからの直接光が入った場合のデータとを分離するようにしている。

したがって、この実施例による自律走行車Ａでは、高度が低い太陽Ｓｕの方向に向かって走行したり、斜面を太陽Ｓｕの方向に向かって登ったりする場合であったとしても、高価なレーザレンジファインダを用いることなく、支障なく自律走行し得ることとなる。

そのうえ、走行経路上に覆いかぶさるようにせり出す樹木の枝や大きな岩等のオーバーハングの障害物Ｔが存在するときであったとしても、このオーバーハングの障害物Ｔを太陽Ｓｕの直接光によるノイズと誤判定することなく確実に検出して、危険を回避しながら自律走行し得ることとなる。

上記した実施例では、無人移動体が自律走行車Ａである場合を示したが、これに限定されるものではなく、無人移動体が半自律で走行する半自律走行車であったり、無人移動体が自律歩行するロボットであったりしてもよい。

本発明に係る無人移動体及び無人移動体の制御方法の構成は、上記した実施例に限定されるものではない。

１０ 車両制御用コンピュータ（制御部）
１０ａ 太陽位置算出手段（車両制御用コンピュータ）
１０ｂ センサ視野範囲算出手段（車両制御用コンピュータ）
１０ｃ 太陽光判定手段（車両制御用コンピュータ）
１０ｄ 強度値判定手段（車両制御用コンピュータ）
１０ｅ 測距値判定手段（車両制御用コンピュータ）
１６ ＧＰＳ（自己位置日時計測部）
１７ バーチカルジャイロ（自己位置日時計測部）
１８ 車速パルス（自己位置日時計測部）
２１ モータドライバ（走行機構）
２２ 操舵用アクチュエータ（走行機構）
２３ ブレーキ／アクセル用アクチュエータ（走行機構）
２４ 車輪（走行機構）
３１ レーザレンジファインダ（レーザセンサ）
Ａ 自律走行車（無人移動体）
Ｓｕ 太陽
Ｔ オーバーハングの障害物

Claims (2)

1. 自律又は半自律して走行する無人移動体であって、
   自律又は半自律して走行させるための走行機構と、
   半導体レーザ光を走査して進行方向の情報を取得するレーザセンサと、
   自己位置情報である自己位置，自己姿勢角及び自己方位並びに日時を取得する自己位置日時計測部と、
   前記進行方向の情報及び前記自己位置情報に基づいて前記走行機構を動作させる制御部を備えた無人移動体において、
   前記制御部には、前記自己位置日時計測部で計測した自己位置，自己姿勢角及び自己方位並びに日時に基づいて太陽の位置である太陽高度及び太陽方位を算出する太陽位置算出手段と、
   前記太陽位置算出手段で算出した太陽高度及び太陽方位の太陽からの直接光を受光し得る前記レーザセンサの視野範囲を前記自己位置日時計測部で計測した自己位置，自己姿勢角及び自己方位並びに日時に基づいて算出するセンサ視野範囲算出手段と、
   前記レーザセンサで取得した計測点が前記センサ視野範囲算出手段で算出した前記レーザセンサの視野範囲にあるか否かを判定して、前記レーザセンサで取得した計測点が前記レーザセンサの視野範囲になくて前記太陽位置算出手段で算出した太陽の位置と一致しないと判定した場合には前記計測点のデータを有効化する太陽光判定手段と、が具備されていると共に、
   前記レーザセンサによって取得した計測点が前記レーザセンサの視野範囲にあって前記太陽位置算出手段で算出した太陽の位置と一致すると前記太陽光判定手段で判定した場合に前記計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かを判定して、前記計測点のデータの受光強度値が前記強度閾値未満でないと判定した場合には前記計測点のデータを有効化する強度値判定手段、及び、
   前記計測点のデータの測距値が予め定めた測距閾値未満であるか否かを判定して、前記測距値が前記測距閾値未満でないと判定した場合には前記計測点のデータを有効化し、前記測距値が前記測距閾値未満であると判定した場合には前記計測点のデータを無効化する測距値判定手段のうちの少なくともいずれか一方の判定手段が具備されている無人移動体。
2. 自律又は半自律走行する無人移動体の制御方法であって、
   前記無人移動体に搭載したレーザセンサからの半導体レーザ光を走査して前記無人移動体の進行方向の情報を取得すると共に、該無人移動体の自己位置情報である自己位置，自己姿勢角及び自己方位並びに日時を取得して自律又は半自律走行する無人移動体の制御方法において、
   前記無人移動体の自己位置，自己姿勢角及び自己方位並びに日時に基づいて太陽の位置である太陽高度及び太陽方位を算出し、
   算出した太陽高度及び太陽方位の太陽からの直接光を受光し得る前記レーザセンサの視野範囲を自己位置，自己姿勢角及び自己方位並びに日時に基づいて算出し、
   前記レーザセンサで取得した計測点が算出した前記レーザセンサの視野範囲にあるか否かを判定して、前記レーザセンサで取得した計測点が前記レーザセンサの視野範囲になくて前記算出した太陽の位置と一致しないと判定した場合には前記計測点のデータを有効化し、
   前記レーザセンサによって取得した計測点が前記レーザセンサの視野範囲にあって前記算出した太陽の位置と一致すると判定した場合に、前記計測点のデータの受光強度値が予め定めた強度閾値未満であるか否かの判定、及び、前記計測点のデータの測距値が予め定めた測距閾値未満であるか否かの判定の少なくともいずれか一方の判定を行って、
   前記計測点のデータの受光強度値が前記強度閾値未満でないと判定した場合及び前記計測点のデータの測距値が前記測距閾値未満でないと判定した場合にはいずれも前記計測点のデータを有効化し、
   前記計測点のデータの受光強度値が前記強度閾値未満であると判定した場合及び前記計測点のデータの測距値が前記測距閾値未満であると判定した場合にはいずれも前記計測点のデータを無効化する無人移動体の制御方法。

Images