JP2022161745A - 無人移動体、無人移動方法及び無人移動プログラム - Google Patents
無人移動体、無人移動方法及び無人移動プログラム Download PDFInfo
- Publication number
- JP2022161745A JP2022161745A JP2021066806A JP2021066806A JP2022161745A JP 2022161745 A JP2022161745 A JP 2022161745A JP 2021066806 A JP2021066806 A JP 2021066806A JP 2021066806 A JP2021066806 A JP 2021066806A JP 2022161745 A JP2022161745 A JP 2022161745A
- Authority
- JP
- Japan
- Prior art keywords
- positioning
- quality
- coordinates
- types
- unmanned mobile
- 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 15
- 238000012937 correction Methods 0.000 claims description 43
- 230000008859 change Effects 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 9
- 238000004891 communication Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 5
- 230000008520 organization Effects 0.000 description 4
- 230000036541 health Effects 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000001681 protective effect Effects 0.000 description 2
- 239000013598 vector Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 239000004918 carbon fiber reinforced polymer Substances 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000010790 dilution Methods 0.000 description 1
- 239000012895 dilution Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
【課題】複数種類の測位を使用しつつ、乖離問題を回避すること。【解決手段】無人移動体1は、無人移動体1の現在位置を測位し、現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段と、複数種類の測位によって出力される座標の基準日を統一するための座標統一手段と、複数種類の測位の品質を判断する品質判断手段と、品質判断による品質に基づいて、複数種類の前記測位から所定の測位を選択する選択手段と、を有し、選択手段によって選択した前記測位によって前記無人移動体の現在位置を測位しつつ飛行するように構成されている。【選択図】図9
Description
本発明は、無人移動体、無人移動方法及び無人移動プログラムに関する。
従来、小型無人移動体(「ドローン」とも呼ばれる)の利用が提案されている。このようなドローンは、現在位置を測位しつつ飛行する(例えば、特許文献1)。
ドローンが現在位置を測位するとき、例えば、測位用衛星の配置が測位に適さない場合や、測位用電波を受信可能な測位用衛星の数が少ない場合には、測位精度が劣化する。本明細書において、測位精度は、測位の品質と同義とする。この問題に対応するために、異なる測位方法を使用する複数の測位を使用することが考えられる。例えば、図1に示すように、ドローン500が2つの測位システム(SA、SB)を備え、一つの測位システムによる測位SAは今期座標を出力し、他の測位システムによる測位SBは元期座標を出力するとする。そうすると、例えば、測位SAによる測位によって今期座標に基づく経路Rbを飛行しているときに、位置P3の近傍で測位SBに切り替えると、出力される座標が今期座標から元期座標に変わるから、ドローン500は飛行経路を急激に変更し、経路Rbから乖離するという問題がある。以下、実際の飛行経路が今までの飛行経路の延長線上から急激に乖離する問題を「乖離問題」と呼ぶ。なお、「元期」と「今期」の用語は、国土地理院の定義に従う。国土地理院では、測地成果2011の基準日を測量成果の「元期(げんき)」と呼び、元期に対して、それ以降、観測を行った時点を「今期(こんき)」と呼んでいる(今期は「年度単位」)。そして、国土地理院から、元期から今期までに生じた地殻変動を表す補正パラメータが提供されている(国土交通省国土地理院のウェブサイト参照)。複数の補正パラメータによって、任意の位置について、元期座標と今期座標の相互の変換をすることは周知である。
本発明は上記の問題の解決を試みたものであり、複数種類の測位を使用しつつ、乖離問題を回避することができる無人移動体、無人移動方法及び無人移動プログラムを提供することを目的とする。
第一の発明は、自律飛行可能な無人移動体であって、前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段と、複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一手段と、複数種類の前記測位の品質を判断する品質判断手段と、前記品質判断による前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択手段と、を有し、前記選択手段によって選択した前記測位によって前記無人移動体の現在位置を測位しつつ移動するように構成されている、無人移動体である。
第一の発明の構成によれば、無人移動体は座標統一手段を有するから、複数種類の測位によって出力される座標の基準日を統一することができる。また、無人移動体は選択手段を有するから、測位の品質が優る測位を選択することができる。これにより、測位の品質が優る測位を使用しつつ、乖離問題を回避することができる。
第二の発明は、第一の発明の構成において、前記品質判断手段は、継続的に前記品質の判断を実施するように構成されており、前記選択手段は、現在使用中の種類の前記測位が、他の種類の前記測位よりも前記品質が劣る場合であっても、前記品質が劣る程度が所定の許容範囲内である場合には、現在使用中の前記測位の使用を継続するように構成されている、無人移動体である。
第二の発明の構成によれば、現在使用中の種類の測位が他の種類の測位よりも品質が劣る場合であっても、品質が劣る程度が所定の許容範囲内であれば現在使用中の測位を継続するように構成されているから、測位の種類を頻繁に変更することなく、安定した制御が可能となる。
第三の発明は、第二の発明の構成において、前記選択手段は、現在使用中の前記測位の品質が劣化する傾向であると判断した場合には、他の種類の前記測位の使用に変更するように構成されており、さらに、前記他の種類の前記測位の使用に変更される条件として、現在使用中の前記測位よりも品質が優り、かつ、品質が安定または向上する傾向であることが規定されている無人移動体である。
第三の発明の構成によれば、現在使用中の測位システムの品質が、劣る傾向にあれば、品質が優り、かつ、安定または向上する傾向である他の種類の測位に変更することができる。
第四の発明は、第一の発明乃至第三のいずれかの発明の構成において、複数種類の前記測位のうち、一部の前記測位は元期座標を出力し、一部の前記測位は今期座標を出力するように構成されており、前記座標統一手段は、地殻変動量を示す補正パラメータによって、前記元期座標を前記今期座標に補正する、または、前記今期座標を前記元期座標に補正することによって、複数種類の前記測位によって出力される前記座標を統一するように構成されている、無人移動体である。
第四の発明の構成によれば、無人移動体が今期座標に基づいて飛行している場合には、測位によって出力される座標を今期座標に統一し、無人移動体が元期座標に基づいて飛行している場合には測位によって出力される座標を元期座標に統一することができる。
第五の発明は、自律移動可能な無人移動体であって、前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する測位ステップと、複数種類の前記測位の品質を判断する品質判断ステップと、前記品質判断ステップにおける前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択ステップと、複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一ステップと、を実施し、前記選択ステップにおいて選択した前記測位によって前記無人移動体の現在位置を測位しつつ移動する、無人移動方法である。
第六の発明は、自律移動可能な無人移動体を制御するコンピュータを、前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段、複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一手段、複数種類の前記測位の品質を判断する品質判断手段、及び、前記品質判断による前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択手段、として機能させるための無人移動プログラムである。
本発明によれば、複数種類の測位を使用しつつ、乖離問題を回避することができる。
以下、本発明を実施するための形態(以下、実施形態)について詳細に説明する。以下の説明においては、同様の構成には同じ符号を付し、その説明を省略又は簡略する。なお、当業者が適宜実施できる構成については説明を省略し、本発明の基本的な構成についてのみ説明する。
<第一の実施形態>
本明細書において、「今期」、「元期」、「補正パラメータ」等の用語は、国土交通省国土地理院のウェブサイトに記載の意味として使用する。国土交通省国土地理院は外部機関の一例である。なお、外部機関は補正パラメータを提供する機関であり、国土地理院のような公的機関でもよいし、私的な機関でもよい。主な用語の意義は、以下の通りである。「地図に示される位置情報(緯度、経度、標高など)」は、ある時点(基準日)の数値で表したものである。具体的には、2011年の東北地方太平洋沖地震の影響を大きく受けた東北と関東を中心とする地域は、地震後に位置を決め直した2011年5月24日が基準日であり、それ以外の地域は、1997年1月1日が基準日である。測地成果2011の基準日を測量成果の「元期(げんき)」と呼ぶ。元期に対して、それ以降、観測を行った時点を「今期(こんき)」と呼ぶ(今期は「年度単位」)。「補正パラメータ」は、国土地理院が提供しているデータであって、元期から今期までに生じた地殻変動を表すものである。補正パラメータは、電子基準点でのGPS連続観測や高度地域基準点測量で検出された地殻変動量を基に作成されている。また、補正パラメータは、電子基準点等で検出された地殻変動量を基本として、クリギング法という補間法を用いて、電子基準点等で検出された地殻変動量をもとに約5km間隔の格子点上での地殻変動量が求められている。補正パラメータは、約5km間隔の3次メッシュコードごとに、元期から今期までの緯度の変動量(秒)、経度の変動量(秒)、高さの変動量(m)で表現され、原則として4月1日から翌年3月31日までの年度単位を適用期間とし、毎年更新されている。本明細書において「基準点」は、上述の電子基準点等、及び、電子基準点等で検出された地殻変動量をもとに約5km間隔で規定される格子点を意味するものとする。
本明細書において、「今期」、「元期」、「補正パラメータ」等の用語は、国土交通省国土地理院のウェブサイトに記載の意味として使用する。国土交通省国土地理院は外部機関の一例である。なお、外部機関は補正パラメータを提供する機関であり、国土地理院のような公的機関でもよいし、私的な機関でもよい。主な用語の意義は、以下の通りである。「地図に示される位置情報(緯度、経度、標高など)」は、ある時点(基準日)の数値で表したものである。具体的には、2011年の東北地方太平洋沖地震の影響を大きく受けた東北と関東を中心とする地域は、地震後に位置を決め直した2011年5月24日が基準日であり、それ以外の地域は、1997年1月1日が基準日である。測地成果2011の基準日を測量成果の「元期(げんき)」と呼ぶ。元期に対して、それ以降、観測を行った時点を「今期(こんき)」と呼ぶ(今期は「年度単位」)。「補正パラメータ」は、国土地理院が提供しているデータであって、元期から今期までに生じた地殻変動を表すものである。補正パラメータは、電子基準点でのGPS連続観測や高度地域基準点測量で検出された地殻変動量を基に作成されている。また、補正パラメータは、電子基準点等で検出された地殻変動量を基本として、クリギング法という補間法を用いて、電子基準点等で検出された地殻変動量をもとに約5km間隔の格子点上での地殻変動量が求められている。補正パラメータは、約5km間隔の3次メッシュコードごとに、元期から今期までの緯度の変動量(秒)、経度の変動量(秒)、高さの変動量(m)で表現され、原則として4月1日から翌年3月31日までの年度単位を適用期間とし、毎年更新されている。本明細書において「基準点」は、上述の電子基準点等、及び、電子基準点等で検出された地殻変動量をもとに約5km間隔で規定される格子点を意味するものとする。
まず、本発明の前提として、元期座標と今期座標について説明する。元期における地図に示される位置を「元期座標」と呼ぶ。任意の元期座標と補正パラメータを使用して、今期座標を算出することができる。元期座標(成果値)と今期座標との関係は、「今期座標=元期座標+補正パラメータに示される補正量」となる。なお、「補正パラメータに示される補正量」を単に補正パラメータと呼ぶ。
任意の元期座標と補正パラメータを使用して今期座標を算出する方法は周知であり、任意の今期座標と補正パラメータを使用して元期座標を算出する方法も周知である。例えば図3に示すように、元期座標における任意の位置P0xについて、位置P0xを囲むように配置される少なくとも3つの基準点を特定する。例えば、位置P0xを最も小さな面積の三角形で囲むように基準点P01、P02及びP03を特定する。基準点P01、P02及びP03を「周辺基準点」と呼ぶ。そして、基準点P01、P02及びP03の補正パラメータに示されるそれぞれの地殻変動量をベクトルV11、V12及びV13とする。そうすると、基準点P01、P02及びP03は、今期において、基準点P01、P02及びP03からベクトルV11、V12及びV13だけ移動した基準点P11、P12及びP13に示される座標に移動する。
元期における任意の位置P0xの補正パラメータV1Xは未知数である。仮に、位置P0xがいずれかの基準点の座標と一致すれば、位置P0xの補正パラメータV1Xは基準点の補正パラメータである。しかし、位置P0xが、基準点の座標と一致しない場合には、位置P0xと基準点との距離が遠いほど、基準点の補正パラメータは位置P0xの補正パメータV1Xと乖離するはずである。このため、例えば、元期における位置P0xと周辺基準点との距離に基づいて、補正パラメータV1Xを算出する。
位置P0xと、各基準点P01、P02及びP03との間の距離をそれぞれ、d1、d2及びd3とする。図4の式1に示すように、距離d1、d2及びd3の和をdbとする。式2に示すように、位置P0xとの距離が相対的に近い基準点の補正パラメータの重みを大きくするように重みづけすることによって、周辺基準点の補正パラメータに基づいて、位置P0xの補正パラメータV1Xを算出することができる。
今期においては、位置P0xは補正パラメータV1Xに示される地殻変動量により、P1xに移動している。今期における位置P1xは、式3に示すように、「位置P1x=位置P0x+補正パラメータV1X」として算出することができる。
なお、上述の方法の逆の計算をすれば、今期座標を元期座標に変換することができる。
本実施形態においては、無人移動体1は、今期座標に基づいて飛行し、使用する測位によって元期座標が出力される場合には、補正パラメータを使用して今期座標に補正する。以下、図2を参照して、無人移動体1(以下、「無人機1」という。)の作用を説明する。
無人機1と制御装置50が無人移動システムを構成する。無人機1は無人飛行体であり、プロペラの回転によって推力を得て、所定の経路を自律飛行可能である。無人機1は無人移動体の一例である。制御装置50は無人機1を制御する制御装置の一例である。無人機1は、制御装置50から飛行経路を示す情報を受信し、プロペラの回転によって推力を得て、所定の経路を自律飛行する。また、無人機1は、制御装置50において充電等を行うようになっている。制御装置50は、無線通信可能なコンピュータで構成される。なお、無人移動体は、無人飛行体に限定されず、例えば、地上を走行する無人車両でよいし、水上を移動する無人船舶であってもよい。
無人機1は、所定領域300において、制御装置50から与えられた所定の経路を自律飛行する。本実施形態において、所定の経路は今期座標で与えられる。無人機1は、飛行の際には、GPS、GLONASS、Galileo、準天頂衛星(QZSS)等の衛星測位システムを構成する航法衛星からの測位用電波を受信して、無人機1の現在位置を継続的に測位し、経路を外れないように飛行位置を制御しつつ、飛行する。
無人機1は、異なる種類の測位をそれぞれ実施する複数種類の測位手段を実装している。具体的には、無人機1は、測位SAと測位SBを実施することができる。測位SAによって、今期座標が出力される。測位SBによって、元期座標が出力される。
例えば、無人機1が、測位SAを使用して経路Rbを飛行し、位置P1、P2を通過し、位置P3において測位SBに切り替えたとする。この場合、無人機1は、測位SBによって出力される元期座標を今期座標に補正する。これにより、無人機1は、測位SAから測位SBに切り替えた場合であっても、経路Rbから乖離することはない。
以下、図5を参照して、無人機1の構成の一例を説明する。図5に示すように、無人機1は、筐体2を有する。筐体2には、無人機1の各部を制御するコンピュータ、自律飛行装置、無線通信装置、GPSなどの航法衛星システムからの測位用電波を利用する測位装置、慣性センサー、気圧センサー、バッテリー等が配置されている。無人機1は複数種類の測位装置を有する。また、筐体2には、固定装置12を介して、カメラ14が配置されている。
無人機1は、カメラ14によって、下方の画像を取得する。カメラ14は、可視光カメラであるが、これとは異なり、マルチスペクトルカメラであってもよい。固定装置12は、カメラ14による撮影画像のぶれを最小化し、かつ、カメラ14の光軸を任意の方向に制御することができる3軸の固定装置(いわゆる、ジンバル)である。
筐体2には、丸棒状のアーム4が接続されている。各アーム4にはモーター6が接続されており、各モーター6にはプロペラ8が接続されている。各モーター6は、直流モーター(ブラシレスDCモーター)である。各モーター6は、筐体2内の自律飛行装置によってそれぞれ独立して制御され、無人機1を上下水平方向の移動や空中での停止(ホバリング)及び姿勢制御を自在に行うことができるようになっている。
アーム4には保護枠10が接続され、プロペラ8が外部の物体に直接接触することを防止している。アーム4及び保護枠10は、例えば、炭素繊維強化プラスチックで形成されており、強度を保ちつつ、軽量に構成されている。
図6は、無人機1の機能構成を示す図である。図6に示すように、無人機1は、CPU(Central Processing Unit)100、記憶部102、無線通信部104、衛星測位部106、衛星測位部108、慣性センサー部110、駆動制御部112、画像処理部114、及び、電源部116を有する。
無人機1は、無線通信部104によって、制御装置50と通信可能になっている。無人機1は、無線通信部104によって、制御装置50から、飛行経路の情報や発進等の指示を受信する。制御装置50は、コンピュータで構成されている。また、制御装置50を介して、各種情報の入力を受け付ける。
無人機1は、衛星測位部106及び衛星測位部108によって、無人機1自体の位置を測定することができる。衛星測位部106及び衛星測位部108は、それぞれ、基本的に4つ以上の航法衛星からの測位用電波を受信して無人機1の位置を計測する。無人機1は、飛行中において、衛星測位部106または衛星測位部108のいずれか一方からの出力座標を使用して飛行する。無人機1自体の位置情報は、無人機1の移動経路の決定及び自律飛行のために使用するほか、画像処理部114によって撮影した画像データと座標(位置)とを紐づけするために使用する。衛星測位部106または衛星測位部108は、無人機1の現在位置を測位し、現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段の一例である。
衛星測位部106によって行われる測位が測位SAであり、衛星測位部108によって行われる測位が測位SBである。図7に示すように、測位SAは、衛星測位による測位位置をそのまま出力する。本実施形態において、衛星測位による測位位置は、今期における測位位置と同視する。なお、厳密には、今期と現時点とでは、元期からの地殻変動量は異なる。しかし、元期から現時点までの地殻変動量に比べると、今期と現時点までの地殻変動量の相違は小さいから、本実施形態においては、今期と現時点を区別しないものとする。なお、本実施形態とは異なり、今期と現時点を区別してもよい。例えば、補正パラメータは毎年1回更新されるから、前回の補正パラメータと直近の補正パラメータとの相違に示される地殻変動が継続すると仮定して、今期から現時点までの経過日数に応じて、その相違を適用すれば、現時点における補正パラメータを算出することができる。例えば、相違をDIFとし、1年間が365日で、現時点が今期から100日経過しているとすれば、現時点の補正パラメータは、「今期の補正パラメータ+DIF×100/365」で算出することができる。
図7に示すように、測位SBは、衛星測位による測位位置を補正パラメータによって補正して出力する。具体的には、測位SBは、衛星測位による現時点の測位位置から補正パラメータに示される補正量を差し引いて、元期における座標を算出し、元期座標を出力する。
測位SAと測位SBは、出力する座標の基準日だけではなく、測位方法が異なる。例えば、測位SAは、準天頂衛星を使用したPPP(Precise Point Positioning/高精度単独測位)である。そして、測位SBは、GPS衛星を使用したRTK(Real Time Kinematic)測位である。異なる複数種類の測位システムを選択的に使用することによって、常に信頼度の相対的に高い測位システムを使用することができる。なお、測位方法は、上記に限定されない。
慣性センサー部110は、例えば、加速度センサー及びジャイロセンサーによって、無人機1の姿勢の変化を計測する。
駆動制御部112によって、無人機1は各モーター6(図5参照)に接続されたプロペラ8(図5参照)の回転を制御し、上下水平移動や空中停止、傾きなどの姿勢を制御するようになっている。
画像処理部114によって、無人機1はカメラ14(図5参照)を作動させて外部の画像を取得することができる。
電源部116は、例えば、交換可能な可充電電池であり、無人機1の各部に電力を供給するようになっている。
記憶部102には、出発点から目的位置まで自律飛行するための移動計画を示すデータ等の自律飛行に必要な各種データ及びプログラムのほか、自律飛行プログラム、座標統一プログラム、品質判断プログラム、及び、選択プログラムが格納されている。CPU100と自律飛行プログラムは、自律飛行手段の一例である。CPU100と座標統一プログラムは、座標統一手段の一例である。CPU100と品質判断プログラムは、品質判断手段の一例である。CPU100と選択プログラムは、選択手段の一例である。無人機1は、品質判断プログラムによる品質の優劣に基づいて、複数種類の測位システムから所定の測位システムを選択する。
無人機1は、自律飛行プログラムによって、制御装置50から、飛行経路を示す情報を受信して、自律飛行するように構成されている。無人機1は、測位によって取得した現在位置を自律飛行プログラムに入力することによって、所定の飛行経路を飛行するように構成されている。自律飛行プログラムは、例えば、所定の基準日の座標による飛行経路を参照するから、自律飛行プログラムに入力する現在位置は、その所定の基準日の座標にする必要がある。本実施形態において、所定の基準日は今期である。したがって、現在位置は今期における座標である必要がある。また、無人機1は、自律飛行プログラムによって、慣性センサー部110からの出力を参照して、無人機1の姿勢を制御する。
無人機1は、座標統一プログラムによって、複数種類の測位SA及びSBによって出力される座標を一致させる。ここで、座標を統一するとは、座標の基準となる日を一致させることを意味する。座標の基準となる日は、例えば、元期、今期、現在である。本実施形態においては、座標の基準となる日時は今期である。無人機1は、座標統一プログラムによって、測位SBによって元期で出力される座標を今期に補正する。無人機1は、領域300内の各基準点の補正パラメータを記憶部102に記憶している。あるいは、無人機1は、領域300内の各基準点の近傍を通過するときに、その近傍の周辺の各基準点の補正パラメータを外部から直接、あるいは、制御装置50を介して外部から受信する。無人機1は、補正パラメータを使用して、任意の位置の元期座標を今期座標に補正するように構成されている。
無人機1は、品質判断プログラムによって、複数種類の測位SA及びSBによる測位の品質の優劣を判断する。品質は、例えば、衛星数を示す情報や、測位用衛星の配置を示すDOP(Dilution Of Precision)、ヘルスフラグ、アラートフラグ等の要素を参照して、判断する。無人機1は、複数種類の測位システムのそれぞれについて、測位用電波を受信しつつ、衛星数をカウントし、DOPを計算し、測位用電波からヘルスフラグ及びアラートフラグを取得する。無人機1は、各要素を数値化して、品質を判断する。例えば、品質が良い方から悪い方へ10点から0点で評価とすると、衛星数については、測位用電波の受信が可能である衛星数が4個未満であれば0点、10個以上であれば10点とする。DOPについては、最小面積を1点として、最大面積を10点とする。ヘルスフラグまたはアラートフラグは、否定的な内容の衛星については、衛星数を1つ減少させる。無人機1は、各要素の点数を合計した総合点で品質を判断する。
無人機1は、選択プログラムによって、品質判断プログラムによる品質に基づいて、複数種類の測位から所定の測位を選択する。無人機1は、例えば、測位SAと測位SBのうち、品質を示す点数が高い方の測位を選択する。品質を示す点数が同一の場合には、今期の位置を出力する測位SAを選択する。
無人機1は、選択プログラムによって選択した測位SAまたは測位SBを使用して無人機1の現在位置を測位しつつ自律飛行するように構成されている。無人機1は、測位SBを使用して自律飛行する場合には、上述の座標統一プログラムによって測位SBから出力される元期座標を今期座標に補正する。
無人機1は、自律飛行のためには1種類の測位のみを使用するが、複数種類の測位を継続的に実施している。例えば、無人機1は、自律飛行に測位SAを使用する場合であっても、並行して測位SBを実施している。そして、上述の品質判断プログラム及び選択プログラムによる処理を継続的に実施している。
図8は、制御装置50の機能構成を示す図である。図8に示すように、制御装置50は、CPU200、記憶部202、無線通信部204、表示部206、電源部208を有する。
以下、無人機1の動作を、図9のフローチャートを参照して説明する。無人機1は飛行を開始すると、測位SAと測位SBをそれぞれ実施し、測位SAと測位SBの品質を判断する(図9のステップST1)。続いて、無人機1は、品質の高い方(測位SAまたは測位SB)を選択し(ステップST2)、測位SBを飛行に使用する場合には出力結果を今期座標に補正する(ステップST3)。続いて、無人機1は、任務終了か否かを判断し(ステップST4)、任務終了であれば、帰還し(ステップST5)、任務終了でなければ、ステップST1乃至ステップST4を繰り返す。ステップST1は、測位ステップ及び品質判断ステップの一例である。ステップST2は選択ステップの一例である。ステップST3は座標統一ステップの一例である。
<第二の実施形態>
以下、図10等を参照して、第二の実施形態について説明する。第一の実施形態と共通する事項については説明を省略し、異なる部分を中心に説明する。
以下、図10等を参照して、第二の実施形態について説明する。第一の実施形態と共通する事項については説明を省略し、異なる部分を中心に説明する。
第二の実施形態において、無人機1は、選択プログラムによって、現在使用中の種類の測位が、他の種類の測位よりも測位の品質が劣る場合であっても、品質が劣る程度が所定の許容範囲内であれば、現在使用中の測位の使用を継続するように構成されている。
例えば、無人機1が、測位SAを使用して飛行している場合において、測位SAの品質が測位SBの品質よりも劣る場合であっても、その劣る程度が許容範囲内であれば、引き続き、測位SAを使用して飛行する。許容範囲は、例えば、品質において、5%以内の差である。例えば、測位SAの品質の総合点が29点であり、測位SBの品質の総合点が30点の場合には、測位SAの品質が測位SBの品質よりも低くても、その差は約3%(1/30)であり、許容範囲内であるから測位SAの使用を継続する。これに対して、測位SAの品質の総合点が25点であり、測位SBの品質の総合点が30点の場合には、測位SAの品質が測位SBの品質よりも低く、その差は約17%(5/30)であり、許容範囲内外であるから測位SAの使用を停止し、飛行する測位を測位SBに変更する。
以下、図10を参照して、無人機1の動作を説明する。無人機1は、品質の優劣が逆転したと判断すると(ステップST21)、さらに、品質の優劣の差が許容範囲内か否かを判断し(ステップST22)、許容範囲内であれば、現在使用中の測位を維持し、許容範内でなければ、品質の高い方の測位に変更し、使用する(ステップST23)。
<第三の実施形態>
以下、図11等を参照して、第三の実施形態について説明する。第一の実施形態または第二の実施形態と共通する事項については説明を省略し、異なる部分を中心に説明する。
以下、図11等を参照して、第三の実施形態について説明する。第一の実施形態または第二の実施形態と共通する事項については説明を省略し、異なる部分を中心に説明する。
第三の実施形態において、無人機1は、選択プログラムによって、現在使用中の測位の品質が劣化する傾向であると判断した場合には、他の種類の測位の使用に変更するように構成されている。さらに、他の種類の測位に変更される条件として、現在使用中の測位よりも品質が優り、かつ、品質が安定または向上する傾向であることが規定されている。
例えば、無人機1が、測位SAを使用して飛行中において、測位SAの品質が劣化する傾向であれば、測位SBとの品質の差が許容範囲内であっても、飛行に使用する測位を測位SBに切り替える。
以下、図11を参照して、無人機1の動作を説明する。無人機1は、品質の優劣が逆転したと判断すると(ステップST21)、さらに、品質の優劣の差が許容範囲内か否かを判断し(ステップST22)、許容範囲内であれば、さらに、飛行に使用中の測位の品質が劣化傾向にあるか否かを判断する(ステップST31)。飛行に使用中の測位の品質が劣化傾向でなければ現在使用中の測位を維持し、劣化傾向であれば、品質の高い方の測位に変更し、使用する(ステップST23)。
なお、本発明は上述の各実施形態に限定されるものではなく、本発明の目的を達成できる範囲での変形、改良等は本発明に含まれるものである。
1 無人機
2 筐体
6 モーター
14 カメラ
50 制御装置
102,202 記憶部
106,108 衛星測位部
2 筐体
6 モーター
14 カメラ
50 制御装置
102,202 記憶部
106,108 衛星測位部
Claims (6)
- 自律移動可能な無人移動体であって、
前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段と、
複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一手段と、
複数種類の前記測位の品質を判断する品質判断手段と、
前記品質判断による前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択手段と、
を有し、
前記選択手段によって選択した前記測位によって前記無人移動体の現在位置を測位しつつ移動するように構成されている、
無人移動体。 - 前記品質判断手段は、継続的に前記品質の判断を実施するように構成されており、
前記選択手段は、現在使用中の種類の前記測位が、他の種類の前記測位よりも前記品質が劣る場合であっても、前記品質が劣る程度が所定の許容範囲内である場合には、現在使用中の前記測位の使用を継続するように構成されている、
請求項1に記載の無人移動体。 - 前記選択手段は、現在使用中の前記測位の品質が劣化する傾向であると判断した場合には、他の種類の前記測位の使用に変更するように構成されており、
さらに、前記他の種類の前記測位の使用に変更される条件として、現在使用中の前記測位よりも品質が優り、かつ、品質が安定または向上する傾向であることが規定されている、
請求項2に記載の無人移動体。 - 複数種類の前記測位のうち、一部の前記測位は元期座標を出力し、一部の前記測位は今期座標を出力するように構成されており、
前記座標統一手段は、地殻変動量を示す補正パラメータによって、前記元期座標を前記今期座標に補正する、または、前記今期座標を前記元期座標に補正することによって、複数種類の前記測位によって出力される前記座標を統一するように構成されている、
請求項1乃至請求項3のいずれかに記載の無人移動体。 - 自律移動可能な無人移動体であって、
前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する測位ステップと、
複数種類の前記測位の品質を判断する品質判断ステップと、
前記品質判断ステップにおける前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択ステップと、
複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一ステップと、
を実施し、
前記選択ステップにおいて選択した前記測位によって前記無人移動体の現在位置を測位しつつ移動する、
無人移動方法。 - 自律飛移動可能な無人移動体を制御するコンピュータを、
前記無人移動体の現在位置を測位し、前記現在位置の座標を出力するための複数種類の測位をそれぞれ実施する複数の測位手段、
複数種類の前記測位によって出力される前記座標の基準日を統一するための座標統一手段、
複数種類の前記測位の品質を判断する品質判断手段、及び、
前記品質判断による前記品質に基づいて、複数種類の前記測位から所定の前記測位を選択する選択手段、
として機能させるための無人移動プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021066806A JP2022161745A (ja) | 2021-04-09 | 2021-04-09 | 無人移動体、無人移動方法及び無人移動プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021066806A JP2022161745A (ja) | 2021-04-09 | 2021-04-09 | 無人移動体、無人移動方法及び無人移動プログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022161745A true JP2022161745A (ja) | 2022-10-21 |
Family
ID=83658560
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021066806A Pending JP2022161745A (ja) | 2021-04-09 | 2021-04-09 | 無人移動体、無人移動方法及び無人移動プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2022161745A (ja) |
-
2021
- 2021-04-09 JP JP2021066806A patent/JP2022161745A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10289116B1 (en) | Fiducial-based navigation of unmanned vehicles | |
Zhang et al. | A new path planning algorithm using a GNSS localization error map for UAVs in an urban area | |
US10197400B2 (en) | Calibration methods and systems for an autonomous navigation vehicle | |
US11092694B2 (en) | Methods and system for controlling a movable object | |
CN104764443B (zh) | 一种光学遥感卫星严密成像几何模型构建方法 | |
JP2008304260A (ja) | 画像処理装置 | |
US11029707B2 (en) | Moving object, moving object control method, moving object control system, and moving object control program | |
US10802159B2 (en) | Long term repeatability of determined position in GNSS navigation system | |
US12024276B2 (en) | Control device and control method for controlling flight of aerial vehicle | |
CN113295174B (zh) | 一种车道级定位的方法、相关装置、设备以及存储介质 | |
CN109839650A (zh) | 一种无人机兼容rtk定位方法、***、设备和存储介质 | |
JP2021056154A (ja) | 測位システム、サーバ、情報配信方法及びプログラム | |
JP2021047054A (ja) | 測位システム、サーバ、測位方法、プログラム、測位対象の装置及び移動体 | |
JP2019191888A (ja) | 無人飛行体、無人飛行方法及び無人飛行プログラム | |
WO2020062356A1 (zh) | 控制方法、控制装置、无人飞行器的控制终端 | |
JP2019182108A (ja) | 無人飛行体、無人飛行方法及び無人飛行プログラム | |
JP2022161745A (ja) | 無人移動体、無人移動方法及び無人移動プログラム | |
KR101911353B1 (ko) | Gnss 신호 손실시 자율 비행 방법 및 이를 위한 무인 비행체 | |
US20230266483A1 (en) | Information processing device, information processing method, and program | |
CN111895976A (zh) | 无人机航测方法、植保方法、装置、***及可读存储介质 | |
US20220333929A1 (en) | Determination device, path determination method, non-transitory computer readable storage medium, path determination system, and air vehicle device | |
JP2018197917A (ja) | 移動計画にしたがい航行する移動体、並びに、その移動体の位置制御のための装置および方法 | |
JP2019188965A (ja) | 無人飛行体、学習結果情報、無人飛行方法及び無人飛行プログラム | |
JP7137509B2 (ja) | 船舶の積載物の数量検収システム | |
CN110892353A (zh) | 控制方法、控制装置、无人飞行器的控制终端 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240327 |