JP2018100931A - Arithmetic device, arithmetic method, arithmetic system, and program - Google Patents

Arithmetic device, arithmetic method, arithmetic system, and program Download PDF

Info

Publication number
JP2018100931A
JP2018100931A JP2016247917A JP2016247917A JP2018100931A JP 2018100931 A JP2018100931 A JP 2018100931A JP 2016247917 A JP2016247917 A JP 2016247917A JP 2016247917 A JP2016247917 A JP 2016247917A JP 2018100931 A JP2018100931 A JP 2018100931A
Authority
JP
Japan
Prior art keywords
search
uav
unmanned aircraft
surveying device
unit
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.)
Granted
Application number
JP2016247917A
Other languages
Japanese (ja)
Other versions
JP6817806B2 (en
Inventor
信幸 西田
Nobuyuki Nishida
信幸 西田
康夫 寺島
Yasuo Terashima
康夫 寺島
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Topcon Corp
Original Assignee
Topcon Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Topcon Corp filed Critical Topcon Corp
Priority to JP2016247917A priority Critical patent/JP6817806B2/en
Priority to US15/838,754 priority patent/US10732298B2/en
Publication of JP2018100931A publication Critical patent/JP2018100931A/en
Application granted granted Critical
Publication of JP6817806B2 publication Critical patent/JP6817806B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/51Relative positioning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C39/00Aircraft not otherwise provided for
    • B64C39/02Aircraft not otherwise provided for characterised by special use
    • B64C39/024Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • G01C15/002Active optical surveying means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/42Simultaneous measurement of distance and other co-ordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/66Tracking systems using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/03Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
    • G01S19/07Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing data for correcting measured positioning data, e.g. DGPS [differential GPS] or ionosphere corrections
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/14Receivers specially adapted for specific applications
    • G01S19/15Aircraft landing systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/03Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
    • G01S19/10Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing dedicated supplementary positioning signals
    • G01S19/11Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing dedicated supplementary positioning signals wherein the cooperating elements are pseudolites or satellite radio beacon positioning system signal repeaters

Abstract

PROBLEM TO BE SOLVED: To provide a technique for tracking an unmanned aerial vehicle with a surveying instrument capable reliably detecting the unmanned aerial vehicle which is lost from sight.SOLUTION: A UAV searching control part 200 used for searching an unmanned aerial vehicle flying on a predetermined route, includes: an estimation part that estimates a direction of the unmanned aerial vehicle viewed from a surveying device, which measures a position of the unmanned aerial vehicle at specific time using a laser beam based on positional data of the surveying device and data of a predetermined route; and a searching control part that controls the surveying device to search the unmanned aerial vehicle based on the direction estimated by the estimation section.SELECTED DRAWING: Figure 3

Description

本発明は、無人航空機の位置を特定する技術に関する。   The present invention relates to a technique for specifying the position of an unmanned aerial vehicle.

無人航空機(UAV:(Unmanned aerial vehicle))を測量に用いる技術が知られている。この技術では、GNSS(Global Navigation Satellite System)を用いた位置測定装置(所謂GPS受信機)、IMU(慣性航法装置)、高度計、カメラを搭載したUAVを予め定めた経路に沿って飛行させて地上の撮影を行い、航空写真測量等を行う。   A technique using an unmanned aerial vehicle (UAV: (Unmanned aerial vehicle)) for surveying is known. In this technology, a UAV equipped with a position measuring device (so-called GPS receiver), IMU (inertial navigation device), altimeter, and camera using a GNSS (Global Navigation Satellite System) is allowed to fly along a predetermined route to the ground. And take aerial photogrammetry.

写真測量では、カメラの位置データの精度が重要となる。ところで、UAVは、GNSSを利用して自身の位置を特定できるが、その精度は水平方向で1m程度、垂直方向で3m程度であり、写真測量に求められる精度は得られない。GNSSを利用したより高精度の位置測定機器をUAVに搭載する方法もあるが、機器の重量や消費電力の点で汎用のUAVに搭載するは難しい。この問題に対する対応して、TS(トータルステーション)で飛行するUAVを追尾し、TSが備えるレーザー測距機能を用いてUAVの位置を特定する方法がある(例えば、特許文献1を参照)。   In photogrammetry, the accuracy of camera position data is important. By the way, although UAV can identify its position using GNSS, its accuracy is about 1 m in the horizontal direction and about 3 m in the vertical direction, and the accuracy required for photogrammetry cannot be obtained. There is a method of mounting a higher-accuracy position measuring device using GNSS in the UAV, but it is difficult to mount it in a general-purpose UAV in terms of the weight of the device and power consumption. In response to this problem, there is a method of tracking a UAV flying in a TS (total station) and specifying the position of the UAV using a laser ranging function provided in the TS (see, for example, Patent Document 1).

US2014/0210663号公報US2014 / 0210663 Publication

上記のTSでUAVを追尾する方法では、TSが備えるターゲットの自動追尾機能が利用される。この技術では、探索用レーザー光でUAVを捕捉および追尾する。UAVは、探索用レーザー光を入射方向に反射する反射プリズムを備え、この反射プリズムからの反射光をTS側で検出することで、TSによるUAVの追尾が行われる。   In the method of tracking UAV with the above-described TS, an automatic tracking function of a target included in the TS is used. In this technique, a UAV is captured and tracked with a search laser beam. The UAV includes a reflecting prism that reflects search laser light in the incident direction, and the UAV is tracked by the TS by detecting reflected light from the reflecting prism on the TS side.

ところでUAVは、風の影響等で予期しない動きをする場合があり、TSがUAVを見失う場合がある。また、TSによるUAVの追尾中に、TSとUAVの間に木の枝や葉、鳥、電柱や電線といった障害物が入り込み、TSがUAVを見失う場合もある。   By the way, UAV may move unexpectedly due to the influence of wind, etc., and TS may lose sight of UAV. Further, during the tracking of the UAV by the TS, obstacles such as tree branches, leaves, birds, utility poles and electric wires may enter between the TS and the UAV, and the TS may lose sight of the UAV.

TSはターゲットを探索する機能を備えているが、相手が空中を移動するUAVの場合、見失ったUAVを再び捕捉するのが困難な場合が多々ある(もちろん、上手くゆく場合もある)。このような背景において、本発明は、測量装置で無人航空機を追尾する技術において、見失った無人航空機の検出をより確実に行う技術の提供を目的とする。   The TS has a function of searching for a target. However, in the case of a UAV whose opponent moves in the air, it is often difficult to capture a lost UAV again (of course, it may be successful). In such a background, an object of the present invention is to provide a technique for more reliably detecting a lost unmanned aircraft in a technique for tracking an unmanned airplane with a surveying instrument.

請求項1に記載の発明は、予め定めた航路で飛行する無人航空機の探索に利用される演算装置であって、レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部とを備える演算装置である。   The invention according to claim 1 is a calculation device used for searching for an unmanned aerial vehicle flying on a predetermined route, and includes data on a position of a surveying device that measures the position of the unmanned aircraft using a laser beam, and An estimation unit that estimates the direction of the unmanned aircraft viewed from the surveying device at a specific time based on the predetermined route data, and the unmanned aircraft of the surveying device based on the direction estimated by the estimation unit And a search control unit that controls the search.

請求項2に記載の発明は、請求項1に記載の発明において、前記予め定めた航路のデータに基づき、前記測量装置から見た前記無人航空機の見かけの速度を予想する見かけの速度予想部を備え、前記測量装置による前記無人航空機の探索において、前記探索制御部は、前記速度予想部で予想された前記無人航空機の見かけの速度よりも速い見かけの速度で前記測量装置の可動部を動かす制御を行うことを特徴とする。   According to a second aspect of the present invention, in the first aspect of the present invention, an apparent speed prediction unit that predicts an apparent speed of the unmanned aircraft as viewed from the surveying device based on the predetermined route data. In the search of the unmanned aircraft by the surveying device, the search control unit controls the movable unit of the surveying device to move at an apparent speed faster than the apparent speed of the unmanned aircraft predicted by the speed prediction unit. It is characterized by performing.

請求項3に記載の発明は、請求項1または2に記載の発明において、前記探索制御部による前記無人航空機の探索を行うタイミングとして、前記速度予想部で予想された前記見かけの速度が予め定めた値以下となるタイミング、前記推定部が推定した前記無人航空機が旋回飛行をするタイミング、前記推定部が推定した前記無人航空機が前記測量装置から遠ざかる飛行をするタイミング、前記推定部が推定した前記無人航空機が前記測量装置から予め定めた距離よりも遠くを飛行しているタイミングの中の一または複数が選択されることを特徴とする。   According to a third aspect of the present invention, in the first or second aspect of the invention, the apparent speed predicted by the speed prediction unit is determined in advance as a timing when the search control unit searches for the unmanned aircraft. Timing when the unmanned aircraft estimated by the estimation unit makes a turning flight, timing when the unmanned aircraft estimated by the estimation unit makes a flight away from the surveying device, and estimated by the estimation unit One or more of the timings at which the unmanned aircraft is flying farther than a predetermined distance from the surveying device is selected.

請求項4に記載の発明は、請求項1〜3のいずれか一項に記載の発明において、前記無人航空機の探索が、前記測量装置が前記無人航空機を捕捉している状態から見失った場合に行われることを特徴とする。請求項5に記載の発明は、請求項1〜4のいずれか一項に記載の発明において、前記推定部は、前記無人航空機が旋回飛行をする空域、前記無人航空機が前記測量装置から遠ざかる飛行をする空域、前記無人航空機が前記測量装置から予め定めた距離よりも遠くを飛行する空域の少なくとも一つを推定し、前記探索制御部は、前記推定された少なくとも一つの空域に絞って前記無人航空機の探索の制御を行うことを特徴とする。   According to a fourth aspect of the present invention, in the invention according to any one of the first to third aspects, when the search for the unmanned aerial vehicle is lost from a state where the surveying device is capturing the unmanned aerial vehicle. It is performed. According to a fifth aspect of the present invention, in the invention according to any one of the first to fourth aspects of the present invention, the estimation unit includes an airspace where the unmanned aircraft makes a turning flight, and a flight where the unmanned aircraft moves away from the surveying device. Estimating at least one of the airspace where the unmanned aircraft flies farther than a predetermined distance from the surveying device, and the search control unit narrows down the unmanned aircraft to the estimated at least one airspace. It is characterized by controlling aircraft search.

請求項6に記載の発明は、予め定めた航路で飛行する無人航空機の探索に利用される演算方法であって、レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定ステップと、前記推定ステップで推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御ステップとを有する演算方法である。   The invention according to claim 6 is a calculation method used for searching for an unmanned aerial vehicle flying on a predetermined route, the position data of a surveying device for surveying the position of the unmanned aircraft using a laser beam, and An estimation step for estimating the direction of the unmanned aircraft as viewed from the surveying device at a specific time based on the predetermined route data, and the unmanned aircraft by the surveying device based on the direction estimated in the estimation step. And a search control step for controlling the search.

請求項7に記載の発明は、予め定めた航路で飛行する無人航空機の探索に利用される演算システムであって、レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部とを備える演算システムである。   The invention according to claim 7 is a calculation system used for searching for an unmanned aerial vehicle flying on a predetermined route, the position data of a surveying device for surveying the position of the unmanned aircraft using a laser beam, and An estimation unit that estimates the direction of the unmanned aircraft viewed from the surveying device at a specific time based on the predetermined route data, and the unmanned aircraft of the surveying device based on the direction estimated by the estimation unit And a search control unit that controls the search.

請求項8に記載の発明は、予め定めた航路で飛行する無人航空機の探索に利用されるプログラムであって、コンピュータに読み取らせて、コンピュータを(1)レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、(2)前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部として動作させる演算用プログラムである。   The invention according to claim 8 is a program used for searching for an unmanned aerial vehicle flying on a predetermined route, which is read by a computer, and (1) the position of the unmanned aircraft using a laser beam. An estimation unit that estimates the direction of the unmanned aircraft as viewed from the surveying device at a specific time based on the position data of the surveying device that measures and the predetermined route data; and (2) the estimation unit estimates The calculation program is operated as a search control unit for controlling the search for the unmanned aircraft by the surveying device based on the determined direction.

本発明によれば、測量装置で無人航空機を追尾する技術において、見失った無人航空機の検出がより確実に行える。   According to the present invention, in the technique of tracking an unmanned aerial vehicle with a surveying instrument, it is possible to more reliably detect a lost unmanned aerial vehicle.

UAVの位置の測定に係る原理図である。It is a principle figure concerning the measurement of the position of UAV. トータルステーションのブロック図である。It is a block diagram of a total station. UAV探索用制御部のブロック図である。It is a block diagram of the control part for UAV search. TSから見たUAVの見かけの速度を求める原理を示す原理図(A)および(B)である。It is a principle figure (A) and (B) which shows the principle which calculates | requires the apparent speed of UAV seen from TS. 処理の手順の一例を示すフローチャートである。It is a flowchart which shows an example of the procedure of a process.

1.第1の実施形態
(概要)
図1には、飛行するUAV (Unmanned aerial vehicle)と地上に配置されたTS(トータルステーション)が示されている。UAVは、市販のものであり、予め定めた飛行ルートを自律飛行し、航空写真測量のための撮影を行う。もちろん、UAVの無線操縦による飛行制御も可能である。UAVは、カメラ、GNSSを利用した位置測定装置(例えば、GPS受信機)、IMU(慣性航法装置)、高度計、予め定めた飛行経路および飛行ログを記憶する記憶部、飛行のための制御装置を備えている。
1. First embodiment (outline)
FIG. 1 shows a flying UAV (Unmanned aerial vehicle) and a TS (Total Station) arranged on the ground. The UAV is commercially available, and autonomously flies on a predetermined flight route and performs shooting for aerial photogrammetry. Of course, flight control by radio control of UAV is also possible. The UAV includes a camera, a position measurement device (for example, a GPS receiver) using GNSS, an IMU (inertial navigation device), an altimeter, a storage unit for storing a predetermined flight path and a flight log, and a control device for flight. I have.

UAVは、自身が備えた位置特定装置とIMUの機能を利用して、予め定められた航路を予め定められた速度で飛行する。なお、位置特定装置の測定誤差があるので、予め定められた航路と実際に飛ぶ航路との間には、ある程度の誤差がある。飛行の経過は、飛行ログに記憶される。飛行ログには、時刻とUAVの位置(緯度・経度・高度)の情報が関連付けされて記憶される。   The UAV flies at a predetermined speed on a predetermined route using the position specifying device and the function of the IMU. Since there is a measurement error of the position specifying device, there is a certain amount of error between a predetermined route and a route that actually flies. The progress of the flight is stored in the flight log. In the flight log, time and UAV position (latitude, longitude, altitude) information are stored in association with each other.

UAVは、外部から見やすい場所(TSから探索され易い場所、例えばUAVの下部)にTSからの探索用レーザー光と測距用レーザー光を受光し反射する専用の反射プリズムが取り付けられている。この反射プリズムは、TSによる測量用の専用ターゲットであり、入射したレーザー光を入射した方向に反射する。   In the UAV, a dedicated reflecting prism that receives and reflects the search laser light and the ranging laser light from the TS is attached to a place that is easily visible from the outside (a place that can be easily searched from the TS, for example, below the UAV). This reflecting prism is a dedicated target for surveying by TS, and reflects incident laser light in the incident direction.

TSは、GNSSを用いた高精度な位置測定装置、画像を取得するカメラ、ターゲット(上記の反射プリズム)を探索する探索用レーザースキャン機能、測距用レーザー光を用いてターゲットまでの距離を測距するレーザー測距機能、レーザー測距されたターゲットの方向(水平角と垂直角(仰角または俯角))を計測する機能を有する。ターゲットまでの距離と方向を計測することで、TSに対するターゲットの位置を測定できる。ここで、TSの位置が判っていれば、ターゲット(この場合はUAV)の地図座標系における位置(緯度・経度・高度もしくは直交座標系上のXYZ座標)を知ることができる。これらの機能は、市販のTSが持っている機能であり、特別なものではない。これらTSに関する技術としては、例えば、特開2009-229192号公報や特開2012-202821号公報等に記載されている。なお、地図座標系というのは、地図情報を扱う座標系(例えば、緯度,経度,高度(標高))であり、例えばGNSSで得られる位置情報は通常地図座標系で記述される。   TS is a highly accurate position measurement device using GNSS, a camera that acquires images, a laser scanning function for searching for a target (the above-described reflecting prism), and a distance measuring laser beam. It has a laser distance measuring function for measuring the distance and a function for measuring the direction (horizontal angle and vertical angle (elevation angle or depression angle)) of the laser-measured target. By measuring the distance and direction to the target, the position of the target with respect to the TS can be measured. Here, if the position of the TS is known, the position (latitude / longitude / altitude or XYZ coordinates on the Cartesian coordinate system) of the target (in this case, UAV) in the map coordinate system can be known. These functions are functions that the commercial TS has and are not special. The techniques relating to these TSs are described in, for example, Japanese Unexamined Patent Application Publication Nos. 2009-229192 and 2012-202821. Note that the map coordinate system is a coordinate system that handles map information (for example, latitude, longitude, altitude (elevation)). For example, position information obtained by GNSS is usually described in a map coordinate system.

以下、本実施形態で利用するTS(トータルステーション)の一例を説明する。図2には、TS(トータルステーション)100のブロック図が示されている。TS100において、探索制御部200以外の部分は、市販のTSと同じである。TS100は、カメラ101、ターゲット探索部102、測距部103、水平・垂直方向検出部104、水平・垂直方向駆動部105、UAV探索用制御部200、データ記憶部106、位置特定部107、通信部108、ターゲット位置算出部109を備えている。   Hereinafter, an example of a TS (total station) used in the present embodiment will be described. FIG. 2 shows a block diagram of a TS (total station) 100. In TS100, parts other than search control unit 200 are the same as those of commercially available TS. The TS 100 includes a camera 101, a target search unit 102, a distance measurement unit 103, a horizontal / vertical direction detection unit 104, a horizontal / vertical direction drive unit 105, a UAV search control unit 200, a data storage unit 106, a position specifying unit 107, a communication Unit 108 and target position calculation unit 109.

カメラ101は、ターゲット等の測量対象の動画像または静止画像を撮影する。カメラ101が撮影した画像のデータは、測距対象に係る測定時刻、測定方向、測定距離、測定対象の位置等のデータと関連付けされて適当な記憶領域に記憶される。本実施形態の場合、カメラ101により、UAVの画像が取得される。ターゲット探索部102は、扇形ビームを有した探索用レーザー光を用いたタ−ゲットの探索を行う。探索用レーザー光により、測距部103は、測距用レーザー光を用いたターゲットまでの距離の計測を行う。水平・垂直方向検出部104は、測距部103が測距したターゲットの水平方向角と垂直方向角(仰角および俯角)を計測する。ターゲット探索部102および測距部103の光学系を備えた筐体部分は、水平回転および仰角(俯角)制御が可能であり、水平方向角と垂直方向角は、エンコーダにより計測される。このエンコーダの出力が水平・垂直方向角検出部104で検出され、水平方位角と垂直方位角(仰角および俯角)の計測が行われる。   The camera 101 captures a moving image or a still image of a survey target such as a target. Data of an image captured by the camera 101 is stored in an appropriate storage area in association with data such as a measurement time, a measurement direction, a measurement distance, and a position of the measurement object related to the distance measurement object. In the present embodiment, a UAV image is acquired by the camera 101. The target search unit 102 searches for a target using a search laser beam having a fan beam. With the search laser light, the distance measuring unit 103 measures the distance to the target using the distance measuring laser light. The horizontal / vertical direction detection unit 104 measures the horizontal direction angle and the vertical direction angle (elevation angle and depression angle) of the target measured by the distance measurement unit 103. The casing portion having the optical system of the target search unit 102 and the distance measuring unit 103 can be controlled in horizontal rotation and elevation angle (decline angle), and the horizontal direction angle and the vertical direction angle are measured by an encoder. The output of this encoder is detected by the horizontal / vertical direction angle detector 104, and the horizontal azimuth angle and the vertical azimuth angle (elevation angle and depression angle) are measured.

水平・垂直方向駆動部105は、ターゲット探索部102および測距部103の光学系を備えた筐体部分の水平回転および仰角制御(および俯角制御)を行うモータ、該モータの駆動回路、該駆動回路の制御回路を含む。UAV探索用制御部200は、飛行するUAVを探索する。UAV探索用制御部200については後述する。データ記憶部106は、TS100の動作に必要な制御プログラム、各種のデータ、測量結果等を記憶する。   The horizontal / vertical direction drive unit 105 includes a motor that performs horizontal rotation and elevation angle control (and depression angle control) of the housing portion including the optical system of the target search unit 102 and the distance measurement unit 103, a drive circuit for the motor, and the drive Includes circuit control circuitry. The UAV search control unit 200 searches for a flying UAV. The UAV search control unit 200 will be described later. The data storage unit 106 stores a control program necessary for the operation of the TS 100, various data, survey results, and the like.

位置特定部107は、GNSSを用いたTS100の位置の特定を行う。位置特定部107は、誤差補正信号や補助航法衛星のデータを用いた高精度な位置の測定を行う。通信部108は、外部の機器との間で通信を行う。TS100は、外部の端末(専用端末やスマートフォン等)による操作が可能であり、この際の通信を行う。通信の形態としては、無線通信や光通信が挙げられる。ターゲット位置算出部109は、ターゲット(この場合は、UAV)までの距離と方向からTS100に対するターゲットの位置(座標)を算出する。ここで、ターゲットまでの距離は、測距部103で得られ、ターゲットの方向は水平・垂直方向検出部104で得られる。TS100の位置は、位置特定部107で特定されるので、TS100に対するターゲットの位置を求めることで、ターゲットの地図座標系における位置を求めることができる。   The position specifying unit 107 specifies the position of the TS 100 using GNSS. The position specifying unit 107 performs highly accurate position measurement using an error correction signal and auxiliary navigation satellite data. The communication unit 108 communicates with an external device. The TS 100 can be operated by an external terminal (such as a dedicated terminal or a smartphone), and performs communication at this time. Examples of communication forms include wireless communication and optical communication. The target position calculation unit 109 calculates the position (coordinates) of the target with respect to the TS 100 from the distance and direction to the target (in this case, UAV). Here, the distance to the target is obtained by the distance measuring unit 103, and the direction of the target is obtained by the horizontal / vertical direction detecting unit 104. Since the position of the TS 100 is specified by the position specifying unit 107, the position of the target in the map coordinate system can be obtained by obtaining the position of the target with respect to the TS 100.

(UAV探索用制御部の構成)
以下、UAV探索用制御部200について説明する。図3には、UAV探索用制御部200のブロック図が示されている。UAV探索用制御部200は、CPU、記憶部、各種のインターフェースを備えたコンピュータであり、専用のハードウェアによって構成されている。
(Configuration of UAV Search Control Unit)
Hereinafter, the UAV search control unit 200 will be described. FIG. 3 shows a block diagram of the UAV search control unit 200. The UAV search control unit 200 is a computer including a CPU, a storage unit, and various interfaces, and is configured by dedicated hardware.

図3に示す各機能部の一部または全部を専用の演算回路によって構成してもよい。また、ソフトウェア的に構成された機能部と、専用の演算回路によって構成された機能部を組み合わせてもよい。   A part or all of the functional units shown in FIG. 3 may be configured by a dedicated arithmetic circuit. Further, a functional unit configured in software and a functional unit configured by a dedicated arithmetic circuit may be combined.

例えば、図示する各機能部は、CPU(Central Processing Unit)、ASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)に代表されるPLD(Programmable Logic Device)などの電子回路により構成される。また、一部の機能を専用のハードウェアで構成し、他の一部を汎用のマイコンにより構成することも可能である。   For example, each functional unit shown in the figure is configured by an electronic circuit such as a CPU (Central Processing Unit), an ASIC (Application Specific Integrated Circuit), and a PLD (Programmable Logic Device) represented by an FPGA (Field Programmable Gate Array). It is also possible to configure some functions with dedicated hardware and configure other parts with general-purpose microcomputers.

各機能部を専用のハードウェアで構成するのか、CPUにおけるプログラムの実行によりソフトウェア的に構成するのかは、要求される演算速度、コスト、消費電力等を勘案して決定される。なお、機能部を専用のハードウェアで構成することとソフトウェア的に構成することは、特定の機能を実現するという観点からは、等価である。   Whether each functional unit is configured by dedicated hardware or by software by executing a program in the CPU is determined in consideration of required calculation speed, cost, power consumption, and the like. Note that configuring the functional unit with dedicated hardware and configuring it with software are equivalent from the viewpoint of realizing a specific function.

UAV探索用制御部200は、機能部として記憶部201、推定部202、探索制御部203、速度予想部204、探索タイミング選択部205、探索範囲設定部206を備える。記憶部201は、UAVに記憶される予め定めた航路のデータと同じものが記憶される。このデータは飛行計画のデータであり、通過する複数のポイントPnの座標(緯度,経度,高度)と隣接するポイント間の速度が指定されている。この飛行計画に従ってUAVは自律飛行する。ここで、Pnの位置と飛行時間とから指定する時刻における位置を求めることができる。   The UAV search control unit 200 includes a storage unit 201, an estimation unit 202, a search control unit 203, a speed prediction unit 204, a search timing selection unit 205, and a search range setting unit 206 as functional units. The storage unit 201 stores the same data as predetermined route data stored in the UAV. This data is flight plan data, and the coordinates (latitude, longitude, altitude) of a plurality of passing points Pn and the speed between adjacent points are designated. The UAV will fly autonomously according to this flight plan. Here, the position at the specified time can be obtained from the position of Pn and the flight time.

また、記憶部201には、UAV探索用制御部200を備えるTS100(図2参照)の位置のデータが記憶される。TS100の位置は、予め高精度GNSSを用いてTS100の位置特定部107により測定、または、基準点を用いてTS100の座標を測量により求める。なお、飛行計画のデータを他の記憶装置や記憶媒体からUAV探索用制御部200にダウンロードし、それを記憶部201に一時的に記憶する形態も可能である。   The storage unit 201 stores data on the position of the TS 100 (see FIG. 2) including the UAV search control unit 200. The position of the TS100 is previously measured by the position specifying unit 107 of the TS100 using a high-accuracy GNSS, or the coordinates of the TS100 are obtained by surveying using a reference point. It is also possible to download the flight plan data from another storage device or storage medium to the UAV search control unit 200 and temporarily store it in the storage unit 201.

推定部202は、記憶部201に記憶されたTS100の位置データおよび予め定めた航路のデータ(飛行計画のデータ)に基づき、特定の時刻におけるTS100から見たUAVの方向を推定する。以下、図4を用いてTS100から見たUAVの方向を推定する原理を説明する。なお、以下に説明するのは、基本的な原理であり、多様な方法があることはいうまでもない。   The estimation unit 202 estimates the direction of the UAV viewed from the TS 100 at a specific time based on the position data of the TS 100 and the predetermined route data (flight plan data) stored in the storage unit 201. Hereinafter, the principle of estimating the direction of the UAV viewed from the TS 100 will be described with reference to FIG. It should be noted that what is described below is a basic principle, and it goes without saying that there are various methods.

図4(A)には、3次元直交座標表示の場合が示され、図4(B)には、極座標表示の場合が示されている。図4(A)と図4(B)は、利用する座標系が異なるだけであり、原点Oと点Pの関係は両者で同じである。   FIG. 4A shows the case of three-dimensional orthogonal coordinate display, and FIG. 4B shows the case of polar coordinate display. 4A and 4B differ only in the coordinate system used, and the relationship between the origin O and the point P is the same for both.

図4(A)および(B)において、原点OがTSの位置(測定の原点)であり、点Pが特定の時刻におけるUAVの位置である。ここで、UAVの位置は、予め定めた航路のデータから決められる。よって、ここで扱うUAVの位置は、予定(飛行計画)に基づくものであり、その意味で以下に説明する処理は位置の推定に係る処理となる。   4A and 4B, the origin O is the TS position (measurement origin), and the point P is the UAV position at a specific time. Here, the position of the UAV is determined from data of a predetermined route. Therefore, the position of the UAV handled here is based on a schedule (flight plan), and in this sense, the processing described below is processing related to position estimation.

以下、時刻t1におけるTS100から見たUAVの方向を推定する場合を説明する。まず、飛行予定データから、時刻t1における点Pの位置(UAVの位置)のデータを得る。この段階では、図4(A)に示すように、点Pの座標は(緯度,経度,高度)によって特定されている。   Hereinafter, the case where the direction of UAV seen from TS100 in time t1 is estimated is demonstrated. First, the data of the position of the point P (UAV position) at time t1 is obtained from the flight schedule data. At this stage, as shown in FIG. 4A, the coordinates of the point P are specified by (latitude, longitude, altitude).

次いで、図4(A)→図4(B)に示すように、三次元直交座標系を極座標系に変換する。この変換は、初歩的な数学的な操作により行われる。図4(B)に示す極座標系に変換することで、水平角φ(この場合は、x軸から反時計回りに計った角度)と仰角θが求まる。ここで、(φ,θ)が時刻t1におけるTSから見たUAVの推定される方向となる。そして同様な原理により、t1,t2,t3・・・におけるUAVの方向を求めることで、指定した時刻におけるUAVのTS100から見た方向を推定することができる。また、各時刻におけるベクトルr(図4(B)参照)が求まる。ベクトルrは、TS100から見たUAVの方向と距離を示すベクトルである。以上の原理による(r,φ,θ)を求める処理が推定部202において行われる。   Next, as shown in FIG. 4 (A) → FIG. 4 (B), the three-dimensional orthogonal coordinate system is converted into a polar coordinate system. This conversion is performed by elementary mathematical operations. By converting to the polar coordinate system shown in FIG. 4B, the horizontal angle φ (in this case, an angle measured counterclockwise from the x-axis) and the elevation angle θ can be obtained. Here, (φ, θ) is the estimated direction of the UAV viewed from the TS at time t1. Based on the same principle, the UAV direction at t1, t2, t3,... Can be obtained, so that the direction viewed from the UAV TS 100 at the specified time can be estimated. Further, a vector r at each time (see FIG. 4B) is obtained. The vector r is a vector indicating the UAV direction and distance as viewed from the TS 100. The estimation unit 202 performs processing for obtaining (r, φ, θ) based on the above principle.

探索制御部203は、推定部202で推定した方向に基づくUAVの探索を制御する処理を行う。TS100の可動部は、水平方向における回転、仰角および俯角の動作をモータにより行う。このモータの動作を制御する制御信号が探索制御部203から出力される。   The search control unit 203 performs processing for controlling UAV search based on the direction estimated by the estimation unit 202. The movable part of TS100 performs rotation, elevation angle, and depression angle in the horizontal direction with a motor. A control signal for controlling the operation of the motor is output from the search control unit 203.

基本的な前提として、飛行するUAVの追尾は、TS100が備えているターゲットの自動追尾機能を用いる。この機能により、探索用のレーザー光のスキャンおよびターゲット(この場合は、専用の反射プリズム)からの反射光の検出により、飛行するUAVをTS100が自動で追尾する。ただし、飛行開始から追尾を行わない場合、あるいは自動追尾が上手くゆかず、TS100がUAVを見失った場合、飛行しているUAVをTS100が捕捉する必要がある。この際の処理に探索制御部203が利用させる。探索は任意のタイミングで行うことができるが、特に後述するタイミングで行うことが好ましい。   As a basic premise, the tracking of a UAV in flight uses a target automatic tracking function provided in the TS100. With this function, the TS 100 automatically tracks the flying UAV by scanning the laser beam for search and detecting the reflected light from the target (in this case, a dedicated reflecting prism). However, when tracking is not performed from the start of flight, or when automatic tracking is not successful and the TS 100 loses sight of the UAV, the TS 100 needs to capture the flying UAV. The search control unit 203 uses the processing at this time. The search can be performed at an arbitrary timing, but it is particularly preferable to perform the search at a timing described later.

速度予想部204は、TSから見たUAVの見かけの速度を予想する。TSから見たUAVの見かけの速度は、UAVのTSから見た視線方向の変化率として定義される。例えば、図4(B)の場合でいうと、UAVを追うTSからの視線の変化率は、時間に対するφの変化率(dφ/dt)とθの変化率(dθ/dt)で表される。すなわち、角度φ方向における時間に対する角度変化率(dφ/dt)と角度θ方向における時間に対する角度変化率(dθ/dt)を合成したものがTSから見たUAVの見かけの速度となる。(φ,θ)の変化率、すなわち、(dφ/dt)と (dθ/dt)を求める計算が速度予想部204で行われる。   The speed prediction unit 204 predicts the apparent speed of the UAV as viewed from the TS. The apparent speed of the UAV viewed from the TS is defined as the rate of change of the line-of-sight direction viewed from the TS of the UAV. For example, in the case of FIG. 4B, the rate of change of the line of sight from the TS following the UAV is expressed by the rate of change of φ (dφ / dt) and the rate of change of θ (dθ / dt) with respect to time. . That is, an apparent rate of UAV seen from the TS is a combination of the rate of change of angle (dφ / dt) with respect to time in the direction of angle φ and the rate of change of angle (dθ / dt) with respect to time in the direction of angle θ. The speed prediction unit 204 calculates the rate of change of (φ, θ), that is, (dφ / dt) and (dθ / dt).

探索タイミング選択部205は、後述する探索タイミングの中から一つを選択する。選択基準としては、時間的に最初に到来するタイミングを選択する場合や時間と予め定めた優先順位を勘案して選択する場合等が挙げられる。また、2以上のタイミングを選択し、選択した複数のタイミングにおける処理を順次実行する形態も可能である。探索を開始する時刻の指定は、UAVをロストしてから(見失ってから)ΔT秒後、飛行開始からΔT’秒後、TS100やUAV探索用制御部200が搭載する時計で○○時○○分○○秒といった形態で行われる。   The search timing selection unit 205 selects one of search timings to be described later. Examples of selection criteria include the case of selecting the timing that comes first in time, the case of selecting in consideration of time and a predetermined priority order, and the like. In addition, a mode in which two or more timings are selected and processing at a plurality of selected timings is sequentially executed is also possible. The time to start the search is specified by the clock mounted on the TS100 or the UAV search control unit 200 after ΔT seconds after the UAV is lost (lost) and after ΔT ′ seconds from the start of flight. This is done in the form of minutes ** seconds

以下、好ましい探索タイミングについて説明する。以下に説明する好ましい探索タイミングは、飛行計画のデータに基づいて推定される。   Hereinafter, preferable search timing will be described. The preferred search timing described below is estimated based on flight plan data.

(第1の好ましい探索タイミング)
第1の好ましい探索タイミングは、速度予想部204で推定された見かけの速度が予め定めた値以下となるタイミングである。TS100から見た見かけの速度が速いと、UAVが探索用レーザー光の照射範囲(探索範囲)を通過する(横切る)スピードがそれだけ速くなるので、探索用レーザー光がUAVを捕捉する確率が低下する。
(First preferred search timing)
The first preferable search timing is a timing at which the apparent speed estimated by the speed prediction unit 204 is equal to or less than a predetermined value. When the apparent speed seen from TS100 is fast, the speed at which the UAV passes (crosses) the irradiation range (search range) of the search laser beam is increased accordingly, so the probability that the search laser beam captures the UAV decreases. .

他方で、TS100から見た見かけの速度が遅いと、UAVが探索用レーザー光の照射範囲(探索範囲)を通過する(横切る)スピードがそれだけ遅くなるので、探索用レーザー光がUAVを捕捉する確率は高くなる。よって、UAVの見かけの速度が予め定めた閾値以下と推定される場合に、飛行計画から予想される空域に狙いを定めてUAVの探索を行うと、UAVを捕捉できる確率が高くなる。   On the other hand, if the apparent speed seen from TS100 is slow, the speed at which the UAV passes (crosses) the irradiation range (search range) of the search laser beam is slowed accordingly, so the probability that the search laser beam captures the UAV Becomes higher. Therefore, when the apparent speed of the UAV is estimated to be equal to or less than a predetermined threshold, if the UAV is searched for aiming at the airspace expected from the flight plan, the probability that the UAV can be captured increases.

例えば、ある時点でTSがUAVを見失ったとする。この場合、UAVの見かけの速度が予め定めた閾値以下となる空域を飛行計画に基づき計算により推定し、その空域にTS100を向け、その空域に飛んでくるであろうUAVを事前に待ち構える。こうすることで、見失ったUAVを再捕捉できる可能性を高めることができる。この飛行計画から推定した空域で待ち構えてUAVを捕捉する手法は、他の好ましい探索タイミングにおいても有効である。   For example, suppose that TS loses sight of UAV at some point. In this case, an airspace in which the apparent speed of the UAV is equal to or less than a predetermined threshold is estimated by calculation based on the flight plan, the TS100 is directed to that airspace, and a UAV that will fly into that airspace is awaited in advance. In this way, it is possible to increase the possibility that a lost UAV can be recaptured. The method of waiting in the air space estimated from this flight plan and capturing the UAV is also effective at other preferable search timings.

(第2の好ましい探索タイミング)
第2の好ましい探索タイミングは、UAVが旋回飛行を行うと推定されるタイミングである。旋回をする際、UAVの速度は低下する。また、TSから見た単位時間当たりの見かけの移動量は、直線飛行をする場合に比較して少なくなる。よって、UAVが旋回するタイミングでUAVの探索を行うことで、UAVを捕捉できる確率が高くなる。
(Second preferred search timing)
The second preferred search timing is a timing at which the UAV is estimated to make a turning flight. When making a turn, the speed of the UAV decreases. Further, the apparent amount of movement per unit time as viewed from the TS is smaller than that in the case of straight flight. Therefore, by performing a UAV search at the timing when the UAV turns, the probability that the UAV can be captured increases.

(第3の好ましい探索タイミング)
第3の好ましい探索タイミングは、UAVがTSから遠ざかる飛行を行うと推定されるタイミングである。TSから見て、UAVが遠ざかる飛行を行う場合、TSから見た単位時間当たりの見かけの移動量は、徐々に小さくなる。よって、UAVが遠ざかるタイミングでUAVの探索を行うことで、UAVを捕捉できる確率が高くなる。
(Third preferred search timing)
The third preferred search timing is a timing at which it is estimated that the UAV will fly away from the TS. When the UAV performs a flight away from the TS, the apparent amount of movement per unit time as viewed from the TS gradually decreases. Therefore, by searching for a UAV at a timing when the UAV moves away, the probability that the UAV can be captured increases.

(第4の好ましい探索タイミング)
第4の好ましい探索タイミングは、UAVがTSに対して予め定めた距離よりも遠くを飛行すると推定されるタイミングである。同じ視野で考えた場合、UAVが遠くを飛行している場合は、近くを飛行している場合に比較して、視野内を通過するUAVの像の動きは遅くなる。このため、予め定めた距離よりも遠くを飛行することが予定飛行ルートから推定される場合、その推定された飛行ルート付近で待ち構えてUAVの探索を行うことで、UAVを見つけ出す確率が高くなる。
(Fourth preferred search timing)
A fourth preferred search timing is a timing at which the UAV is estimated to fly farther than a predetermined distance with respect to the TS. Considering the same field of view, when the UAV is flying far, the movement of the UAV image passing through the field of view is slower than when the UAV is flying near. For this reason, when it is estimated from the planned flight route that the aircraft will travel farther than a predetermined distance, the probability of finding the UAV increases by waiting for the estimated flight route and searching for the UAV.

探索範囲設定部206は、探索タイミング選択部205で選択された探索タイミングに基づき、UAVの探察範囲を設定する。探索の範囲の設定は、以下のようにして行われる。まず、探索タイミングが選択されることで、そのタイミングにおける飛行予定の航路が飛行計画から得られる。飛行予定の航路が判れば、その航路を飛行するUAVのTSから見た方向(φ,θ)の範囲が求められる。この範囲を基にある程度の幅を持たせた範囲が探索範囲となる。この処理が探索範囲設定部206で行われる。   The search range setting unit 206 sets the UAV search range based on the search timing selected by the search timing selection unit 205. The search range is set as follows. First, when a search timing is selected, a route scheduled for flight at that timing is obtained from the flight plan. If the route scheduled for flight is known, the range of the direction (φ, θ) as seen from the TS of the UAV flying in the route is obtained. A range having a certain width based on this range is a search range. This process is performed by the search range setting unit 206.

(処理の一例)
図3のUAV探索用制御部200で行われる処理の一例を説明する。図5は、UAV探索用制御部200で行われる処理の手順の一例が示されている。図5の処理を実行するためのプログラムは、UAV探索用制御部200の記憶部201や適当な記憶媒体、あるいはネットワーク上のサーバ等に記憶され、そこから提供される。
(Example of processing)
An example of processing performed by the UAV search control unit 200 in FIG. 3 will be described. FIG. 5 shows an example of a procedure of processing performed by the UAV search control unit 200. The program for executing the processing of FIG. 5 is stored in and provided from the storage unit 201 of the UAV search control unit 200, an appropriate storage medium, or a server on the network.

図5の処理は、TS(ト―タルステーション)100がUAVを捕捉していない状態で開始される。このような場合として、TS100がUAVを捕捉していない状態でUAVが飛行を始めた場合、あるいはTS100がUAVを捕捉追尾している状態でUAVを見失った場合が挙げられる。   The process of FIG. 5 is started in a state where the TS (total station) 100 does not capture the UAV. As such a case, there is a case where the UAV starts flying while the TS 100 has not captured the UAV, or a case where the UAV has lost sight of the UAV while the TS 100 is capturing and tracking the UAV.

処理が開始されると、その時点でUAVが飛行しているか否かが判定される(ステップS101)。この判定は、飛行計画(予め定められた飛行ルートと飛行時間の関係を定めたデータ)に基づいて行われる。飛行が終了していないと判定された場合、ステップS102に進み、飛行が終了している判定される場合、処理を終了する。   When the process is started, it is determined whether or not the UAV is flying at that time (step S101). This determination is performed based on a flight plan (data defining a predetermined flight route and flight time relationship). If it is determined that the flight has not ended, the process proceeds to step S102. If it is determined that the flight has ended, the process ends.

ステップS102では、飛行計画に基づき、その時点から最も近い将来に到来する探索タイミングを選択する。ここで候補となる探索タイミングは、上述した第1〜第4の好ましい探索タイミングの4形態である。この際、複数の探索タイミングが同時に抽出される場合も有り得る。この場合は、見かけの速度が最小となる探索タイミングを選択する。   In step S102, based on the flight plan, a search timing that arrives in the near future from that time is selected. Here, the search timings that are candidates are four forms of the above-described first to fourth preferable search timings. At this time, a plurality of search timings may be extracted simultaneously. In this case, the search timing that minimizes the apparent speed is selected.

この処理では、選択された探索タイミングの範囲に含まれる特定の時刻が選択される。選択される特定の時刻としては、UAVをロストしてから(見失ってから)ΔT秒後、飛行開始からΔT’秒後、TS100やUAV探索用制御部200が搭載する時計で○○時○○分○○秒といったものが選択される。   In this process, a specific time included in the selected search timing range is selected. The specific time to be selected is ΔT seconds after the UAV was lost (lost), ΔT ′ seconds after the start of flight, and the clock mounted on the TS100 or the UAV search control unit 200 at the time of XX A minute such as XX seconds is selected.

例えば、飛行計画では、飛行ルートの位置・経路における速度が設定されている。よって、例えばUAVをロストしてからΔT秒後に特定の方向の範囲における探索の実行が指定されることで、飛行空域を予想したUAVの追っかけ探索が実行される。   For example, in the flight plan, the speed in the position / route of the flight route is set. Therefore, for example, by designating the execution of a search in a specific direction range after ΔT seconds after the UAV is lost, a UAV chasing search predicting the flight airspace is executed.

ステップS102の処理は、図3の探索タイミング選択部205で行われる。また、見かけの速度は、ベクトルrを推定部202で推定し、(φ,θ)の変化率を速度予想部204で予想することで得られる。   The processing in step S102 is performed by the search timing selection unit 205 in FIG. The apparent speed can be obtained by estimating the vector r by the estimation unit 202 and predicting the rate of change of (φ, θ) by the speed prediction unit 204.

探索タイミングを選択したら、飛行計画に基づき探索範囲を設定する(ステップS103)。この処理では、ステップS102で選択された探索タイミングを含む一定の期間を選択し、飛行計画からその期間におけるベクトルrを求める。そしてベクトルrによって予想される飛行予定経路を含むある程度の範囲をφとθの角度範囲として設定する。こうして探索範囲を設定する。ステップS103の処理は、探索範囲設定部206で行われる。   When the search timing is selected, a search range is set based on the flight plan (step S103). In this process, a certain period including the search timing selected in step S102 is selected, and a vector r in that period is obtained from the flight plan. Then, a certain range including the planned flight route predicted by the vector r is set as the angle range of φ and θ. Thus, the search range is set. The processing in step S103 is performed by the search range setting unit 206.

探索範囲を設定したら、その範囲にUAVが到達する予定時刻の少し前の段階(例えば2秒〜5秒前の段階)からその範囲でのUAVの探索を行う(ステップS104)。この処理は、探索制御部203からの制御信号に基づき、TS100が備えたターゲットの探索機能を用いて行う。UAVの探索は、TS100が撮影した画像の解析に基づき行ってもよい。   When the search range is set, the UAV is searched in the range from a stage slightly before the scheduled time when the UAV reaches the range (for example, a stage 2 seconds to 5 seconds before) (step S104). This processing is performed using a target search function provided in the TS 100 based on a control signal from the search control unit 203. The UAV search may be performed based on an analysis of an image captured by the TS 100.

上記の探索の際、当該探索範囲におけるUAVの見かけの速度Vを速度予想部204で算出し、UAVの予想移動方向に沿ってv=2Vの見かけの走査速度で探索を行う。すなわち、推定されるUAVの見かけの速度の2倍の見かけの速度でTS100の可動部が動くように(つまり2倍の速度で探索用の視線が動くように)、TS100の動作制御が行われる。   In the above search, the UAV apparent speed V in the search range is calculated by the speed prediction unit 204, and the search is performed at the apparent scanning speed of v = 2V along the UAV expected moving direction. That is, the operation control of the TS100 is performed so that the movable part of the TS100 moves at an apparent speed that is twice the estimated apparent speed of the UAV (that is, the line of sight for search moves at twice the speed). .

上記の制御が行われることで、見かけの速度で考えて、UAVを2倍の速度で追いかける状態となり、走査されて照射される探索用レーザー光がUAVに追い付かず、探索ができなくなる事態が避けられる。ここで、探索の走査方向をUAVの移動方向に沿って複数設定することで、UAVを捕捉する確立を高めることができる。   By performing the control described above, considering the apparent speed, the UAV is chased at twice the speed, and the search laser light that is scanned and irradiated does not catch up with the UAV, thereby avoiding a situation where the search cannot be performed. It is done. Here, by setting a plurality of search scanning directions along the moving direction of the UAV, it is possible to increase the probability of capturing the UAV.

走査速度は、UAVの見かけの速度の2倍程度が適当であるが、2倍に限定されるものではない。また、TSから見たUAVの見かけの速度の変化が大きい場合、各時刻(例えば、3秒毎)における推定される見かけの速度を計算し、それに基づきTSの制御を行う。   The scanning speed is suitably about twice the apparent speed of UAV, but is not limited to twice. Further, when the change in the apparent speed of the UAV seen from the TS is large, the apparent speed estimated at each time (for example, every 3 seconds) is calculated, and the TS is controlled based on the calculated apparent speed.

探索の結果、UAVが捕捉できれば、ステップS105の後、処理を終了し、UAVが捕捉できなければ、ステップS106に進む。ここで、ステップS103で設定した探索範囲におけるUAVの飛行が終了したと推定されるか否か(UAVを捕捉できなければ、この時点では、飛行が推定される状態)が判定され(ステップS106)、探索範囲における飛行が終了していると判定された場合は、ステップS102の前段階に戻り、再度の探索範囲の選択を行う。探索範囲における飛行が終了していないと判定された場合は、ステップS104の探索制御を続行する。   If the UAV can be captured as a result of the search, the process ends after step S105. If the UAV cannot be captured, the process proceeds to step S106. Here, it is determined whether or not it is estimated that the flight of the UAV in the search range set in step S103 has ended (if the UAV cannot be captured, the flight is estimated at this time) (step S106). If it is determined that the flight in the search range has been completed, the process returns to the previous stage of step S102 and the search range is selected again. If it is determined that the flight in the search range has not ended, the search control in step S104 is continued.

以上のようにして、TS側でUAVの飛行計画を予め把握し、この飛行計画に基づき、TSが捕捉していないUAVの探索が行われる。   As described above, a UAV flight plan is grasped in advance on the TS side, and a UAV not captured by the TS is searched based on this flight plan.

2.第2の実施形態
図3のUAV探索用制御部200を独立した制御装置として構成することも可能である。この場合、図3に関連して説明したUAV探索用制御部200が独立した装置となる。この制御装置は、TS(トータルステーション)と無線通信等の適当な通信回線で接続され、TSの動作を制御する制御信号をTSに向かって出力する。この場合、TSは外部からの動作制御が可能な形態のものを用いる。
2. Second Embodiment It is also possible to configure the UAV search control unit 200 of FIG. 3 as an independent control device. In this case, the UAV search control unit 200 described with reference to FIG. 3 is an independent device. This control device is connected to a TS (total station) via an appropriate communication line such as wireless communication, and outputs a control signal for controlling the operation of the TS toward the TS. In this case, a TS that can be externally controlled is used.

UAV探索用制御部200を備えた制御装置は、専用のハードウェアで構成されていてよいし、PC,タブレット,スマートフォン等に動作用ソフトウェアをインストールすることで、図3の機能を実現する形態でもよい。また例えば、タブレットを用いる場合に、タブレットでは困難な演算は、外付け機器で行う形態とし、この外付け機器とタブレットを組み合わせてUAV探索用制御部をシステムとして構成することも可能である。これは、タブレットに限らず、PCやスマートフォンの場合も同じである。また、遠隔地に配置されたサーバをUAV探索用制御部200として動作させ、そこにインターネット回線等を介してタブレットやスマートフォンを用いてアクセスし、当該タブレットやスマートフォンを端末として、操作を行う形態も可能である。   The control device including the UAV search control unit 200 may be configured with dedicated hardware, or may be configured to implement the functions of FIG. 3 by installing operation software on a PC, tablet, smartphone, or the like. Good. Further, for example, when a tablet is used, it is possible to perform an operation that is difficult with the tablet by an external device, and the UAV search control unit can be configured as a system by combining the external device and the tablet. This is the same not only for tablets but also for PCs and smartphones. Further, there is also a mode in which a server located in a remote place is operated as the UAV search control unit 200, accessed there by using a tablet or smartphone via the Internet line, etc., and operated using the tablet or smartphone as a terminal. Is possible.

また、図3の機能部を通信回線で接続された複数の独立したハードウェアで実現するシステムを構成することも可能である。例えば、操作端末としてスマートフォンを用い、記憶部201としてサーバやPCを用い、その他の機能部を実現するハードウェアをTSに接続されるアダプタ形式の筐体に収めた補助装置とする。この補助装置は、上述したスマートフォンやサーバとインターネット回線等を利用して通信が可能であり、利用に際しては、飛行計画のデータを上述したサーバから補助機器にダウンロードし、スマートフォンを操作端末として、第1の実施形態で説明した動作を行う。この場合、分散配置された機能部が通信を介して統合されて機能するシステムが構成される。そしてこのシステムにおいて、図5の処理が実行される。   It is also possible to configure a system that implements the functional units shown in FIG. 3 with a plurality of independent hardware connected via a communication line. For example, a smartphone is used as the operation terminal, a server or a PC is used as the storage unit 201, and hardware that implements other functional units is an auxiliary device housed in an adapter-type housing connected to the TS. This auxiliary device can communicate with the above-described smartphone or server using the Internet line or the like. When using the auxiliary device, the flight plan data is downloaded from the above-described server to the auxiliary device, and the smartphone is used as an operation terminal. The operation described in the first embodiment is performed. In this case, a system is configured in which the functional units arranged in a distributed manner are integrated and functioned via communication. In this system, the process of FIG. 5 is executed.

Claims (8)

予め定めた航路で飛行する無人航空機の探索に利用される演算装置であって、
レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、
前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部と
を備える演算装置。
An arithmetic device used for searching for an unmanned aerial vehicle flying on a predetermined route,
An estimation unit that estimates the direction of the unmanned aircraft as viewed from the surveying device at a specific time based on the position data of the surveying device that measures the position of the unmanned aircraft using laser light and the data of the predetermined route When,
An arithmetic device comprising: a search control unit that controls search of the unmanned aircraft by the surveying device based on the direction estimated by the estimation unit.
前記予め定めた航路のデータに基づき、前記測量装置から見た前記無人航空機の見かけの速度を予想する見かけの速度予想部を備え、
前記測量装置による前記無人航空機の探索において、前記探索制御部は、前記速度予想部で予想された前記無人航空機の見かけの速度よりも速い見かけの速度で前記測量装置の可動部を動かす制御を行う請求項1に記載の演算装置。
An apparent speed prediction unit for predicting the apparent speed of the unmanned aerial vehicle viewed from the surveying device based on the predetermined route data;
In the search for the unmanned aircraft by the surveying device, the search control unit performs control to move the movable unit of the surveying device at an apparent speed faster than the apparent speed of the unmanned aircraft predicted by the speed prediction unit. The arithmetic device according to claim 1.
前記探索制御部による前記無人航空機の探索を行うタイミングとして、
前記速度予想部で予想された前記見かけの速度が予め定めた値以下となるタイミング、
前記推定部が推定した前記無人航空機が旋回飛行をするタイミング、
前記推定部が推定した前記無人航空機が前記測量装置から遠ざかる飛行をするタイミング、
前記推定部が推定した前記無人航空機が前記測量装置から予め定めた距離よりも遠くを飛行しているタイミング
の中の一または複数が選択される請求項1または2に記載の演算装置。
As timing for searching for the unmanned aircraft by the search control unit,
A timing at which the apparent speed predicted by the speed prediction unit is equal to or lower than a predetermined value;
Timing at which the unmanned aircraft estimated by the estimation unit makes a turning flight,
A timing at which the unmanned aircraft estimated by the estimation unit flies away from the surveying device;
The computing device according to claim 1 or 2, wherein one or more of the timings at which the unmanned aircraft estimated by the estimation unit is flying farther than a predetermined distance from the surveying device are selected.
前記無人航空機の探索が、前記測量装置が前記無人航空機を捕捉している状態から見失った場合に行われる請求項1〜3のいずれか一項に記載の演算装置。   The computing device according to any one of claims 1 to 3, wherein the search for the unmanned aerial vehicle is performed when the surveying device loses sight of the unmanned aerial vehicle. 前記推定部は、
前記無人航空機が旋回飛行をする空域、
前記無人航空機が前記測量装置から遠ざかる飛行をする空域、
前記無人航空機が前記測量装置から予め定めた距離よりも遠くを飛行する空域
の少なくとも一つを推定し、
前記探索制御部は、前記推定された少なくとも一つの空域に絞って前記無人航空機の探索の制御を行う請求項1〜4のいずれか一項に記載の演算装置。
The estimation unit includes
An airspace in which the unmanned aerial vehicle makes a turning flight;
An airspace in which the unmanned aircraft flies away from the surveying instrument;
Estimating at least one of the airspace in which the unmanned aircraft flies farther than a predetermined distance from the surveying instrument;
The computing device according to any one of claims 1 to 4, wherein the search control unit controls the search for the unmanned aircraft in the estimated at least one airspace.
予め定めた航路で飛行する無人航空機の探索に利用される演算方法であって、
レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定ステップと、
前記推定ステップで推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御ステップと
を有する演算方法。
A calculation method used for searching for an unmanned aerial vehicle flying on a predetermined route,
An estimation step for estimating the direction of the unmanned aircraft as seen from the surveying device at a specific time based on the position data of the surveying device that measures the position of the unmanned aircraft using laser light and the data of the predetermined route. When,
A search control step of controlling a search for the unmanned aircraft by the surveying device based on the direction estimated in the estimation step.
予め定めた航路で飛行する無人航空機の探索に利用される演算システムであって、
レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、
前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部と
を備える演算システム。
An arithmetic system used for searching for an unmanned aerial vehicle flying on a predetermined route,
An estimation unit that estimates the direction of the unmanned aircraft as viewed from the surveying device at a specific time based on the position data of the surveying device that measures the position of the unmanned aircraft using laser light and the data of the predetermined route When,
A search control unit that controls a search for the unmanned aircraft by the surveying device based on the direction estimated by the estimation unit.
予め定めた航路で飛行する無人航空機の探索に利用されるプログラムであって、
コンピュータに読み取らせて、コンピュータを
レーザー光を用いて前記無人航空機の位置を測量する測量装置の位置のデータおよび前記予め定めた航路のデータに基づき、特定の時刻における前記測量装置から見た前記無人航空機の方向を推定する推定部と、
前記推定部で推定した方向に基づき、前記測量装置による前記無人航空機の探索を制御する探索制御部と
して動作させるプログラム。
A program used to search for unmanned aerial vehicles flying on a predetermined route,
The unmanned vehicle seen from the surveying device at a specific time based on the data of the position of the surveying device that surveys the position of the unmanned aircraft using laser light and the data of the predetermined route An estimation unit for estimating the direction of the aircraft;
A program that operates as a search control unit that controls search of the unmanned aircraft by the surveying device based on the direction estimated by the estimation unit.
JP2016247917A 2016-12-21 2016-12-21 Arithmetic logic units, arithmetic methods, arithmetic systems and programs Active JP6817806B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2016247917A JP6817806B2 (en) 2016-12-21 2016-12-21 Arithmetic logic units, arithmetic methods, arithmetic systems and programs
US15/838,754 US10732298B2 (en) 2016-12-21 2017-12-12 Operating device, operating method, operating system, and operating program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016247917A JP6817806B2 (en) 2016-12-21 2016-12-21 Arithmetic logic units, arithmetic methods, arithmetic systems and programs

Publications (2)

Publication Number Publication Date
JP2018100931A true JP2018100931A (en) 2018-06-28
JP6817806B2 JP6817806B2 (en) 2021-01-20

Family

ID=62562388

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016247917A Active JP6817806B2 (en) 2016-12-21 2016-12-21 Arithmetic logic units, arithmetic methods, arithmetic systems and programs

Country Status (2)

Country Link
US (1) US10732298B2 (en)
JP (1) JP6817806B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20200009638A (en) * 2018-07-19 2020-01-30 정성철 Near field drone detection and identifying device
US10565730B2 (en) 2017-09-06 2020-02-18 Topcon Corporation Survey data processing device, survey data processing method, and survey data processing program
JP2021001775A (en) * 2019-06-20 2021-01-07 三菱電機株式会社 Shape measurement system
US11221216B2 (en) 2018-02-14 2022-01-11 Topcon Corporation Placement table for unmanned aerial vehicle, surveying method, surveying device, surveying system and program

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020036683A1 (en) * 2018-08-13 2020-02-20 Bae Systems Information And Electronic Systems Integration Inc. Tiered unassisted discovery in directional rf networks
CN110118999A (en) * 2019-06-11 2019-08-13 威海程航航空科技有限公司 A kind of unmanned plane search system and method
WO2021081961A1 (en) * 2019-10-31 2021-05-06 深圳市大疆创新科技有限公司 Light control method, moving platform, and light control system
CN112001309A (en) * 2020-08-21 2020-11-27 上海特金无线技术有限公司 Target searching method, device and equipment based on unmanned aerial vehicle cluster and storage medium
CN114003060A (en) * 2021-11-04 2022-02-01 西安石油大学 Multi-unmanned aerial vehicle task allocation method based on improved global optimal brainstorming algorithm

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0628030A (en) * 1992-07-09 1994-02-04 Fujita Corp Method for detecting position of mobile body
JP2004020185A (en) * 2002-06-12 2004-01-22 Oerlikon Contraves Ag Target tracking method and target tracking system
JP2004132914A (en) * 2002-10-11 2004-04-30 Topcon Corp Position measuring apparatus
JP2009081696A (en) * 2007-09-26 2009-04-16 Toshiba Corp Aircraft communication system and antenna direction control method thereof
US20140032021A1 (en) * 2011-04-14 2014-01-30 Hexagon Technology Center Gmbh System and method for controlling an unmanned air vehicle
JP2015145784A (en) * 2014-01-31 2015-08-13 株式会社トプコン Measurement system

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2511658A1 (en) 2011-04-14 2012-10-17 Hexagon Technology Center GmbH Measuring system and method for new point determination
EP3062066A1 (en) * 2015-02-26 2016-08-31 Hexagon Technology Center GmbH Determination of object data by template-based UAV control
JP6843773B2 (en) * 2015-03-03 2021-03-17 プレナヴ インコーポレイテッド Environmental scanning and unmanned aerial vehicle tracking
US20160349746A1 (en) * 2015-05-29 2016-12-01 Faro Technologies, Inc. Unmanned aerial vehicle having a projector and being tracked by a laser tracker
US10242581B2 (en) * 2016-10-11 2019-03-26 Insitu, Inc. Method and apparatus for target relative guidance

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0628030A (en) * 1992-07-09 1994-02-04 Fujita Corp Method for detecting position of mobile body
JP2004020185A (en) * 2002-06-12 2004-01-22 Oerlikon Contraves Ag Target tracking method and target tracking system
JP2004132914A (en) * 2002-10-11 2004-04-30 Topcon Corp Position measuring apparatus
JP2009081696A (en) * 2007-09-26 2009-04-16 Toshiba Corp Aircraft communication system and antenna direction control method thereof
US20140032021A1 (en) * 2011-04-14 2014-01-30 Hexagon Technology Center Gmbh System and method for controlling an unmanned air vehicle
JP2015145784A (en) * 2014-01-31 2015-08-13 株式会社トプコン Measurement system

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10565730B2 (en) 2017-09-06 2020-02-18 Topcon Corporation Survey data processing device, survey data processing method, and survey data processing program
US11221216B2 (en) 2018-02-14 2022-01-11 Topcon Corporation Placement table for unmanned aerial vehicle, surveying method, surveying device, surveying system and program
KR20200009638A (en) * 2018-07-19 2020-01-30 정성철 Near field drone detection and identifying device
KR102112340B1 (en) * 2018-07-19 2020-05-18 정성철 Near field drone detection and identifying device
JP2021001775A (en) * 2019-06-20 2021-01-07 三菱電機株式会社 Shape measurement system

Also Published As

Publication number Publication date
JP6817806B2 (en) 2021-01-20
US20180172843A1 (en) 2018-06-21
US10732298B2 (en) 2020-08-04

Similar Documents

Publication Publication Date Title
JP6817806B2 (en) Arithmetic logic units, arithmetic methods, arithmetic systems and programs
KR102463176B1 (en) Device and method to estimate position
JP6826888B2 (en) Surveying equipment, unmanned aerial vehicle search methods, surveying systems and programs
US10636171B2 (en) Device, method, and system for tracking unmanned aerial vehicle, and program therefor
US20190103032A1 (en) Unmanned aerial vehicle, data processing device, path selection device, processing method and processing program
KR100995362B1 (en) Flight altitude control system of pilotless aircraft
US7463340B2 (en) Ladar-based motion estimation for navigation
US10146230B2 (en) Control device, optical device, and control method for tracking unmanned aerial vehicle, and system and program therefor
US10969493B2 (en) Data processing device, data processing method, and data processing program
US7792330B1 (en) System and method for determining range in response to image data
JP7007137B2 (en) Information processing equipment, information processing methods and programs for information processing
US20120232717A1 (en) Remote coordinate identifier system and method for aircraft
JP2016188806A (en) Mobile entity and system
JP2017182692A (en) Autonomous Mobile Robot
JP2018119852A (en) Position specification device, position specification method, position specification system, program for position specification, unmanned aircraft, and target for identifying unmanned aircraft
US11598878B2 (en) Vision-cued random-access lidar system and method for localization and navigation
JP6934367B2 (en) Positioning device, position measuring method and position measuring program
CN113848541A (en) Calibration method and device, unmanned aerial vehicle and computer readable storage medium
US20230083021A1 (en) Surveying data processor, surveying data processing method, and surveying data processing program
KR101911353B1 (en) Autonomic flight method when gnss signal loss and unmanned aerial vehicle for the same
JP6783681B2 (en) Arithmetic logic unit, arithmetic method and program
KR102036080B1 (en) Portable positioning device and method for operating portable positioning device
JP6664258B2 (en) Self-location estimation device
Putra et al. Autonomous drone indoor navigation based on virtual 3D map reference
WO2024009855A1 (en) Control method, control device, and computer program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191202

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200929

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201002

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201127

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20201218

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201225

R150 Certificate of patent or registration of utility model

Ref document number: 6817806

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250