WO2020225894A1 - 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体 - Google Patents

位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体 Download PDF

Info

Publication number
WO2020225894A1
WO2020225894A1 PCT/JP2019/018474 JP2019018474W WO2020225894A1 WO 2020225894 A1 WO2020225894 A1 WO 2020225894A1 JP 2019018474 W JP2019018474 W JP 2019018474W WO 2020225894 A1 WO2020225894 A1 WO 2020225894A1
Authority
WO
WIPO (PCT)
Prior art keywords
point
point cloud
cloud data
sensor
pair
Prior art date
Application number
PCT/JP2019/018474
Other languages
English (en)
French (fr)
Inventor
聡 辻
Original Assignee
日本電気株式会社
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 日本電気株式会社 filed Critical 日本電気株式会社
Priority to PCT/JP2019/018474 priority Critical patent/WO2020225894A1/ja
Priority to US17/606,803 priority patent/US20220187455A1/en
Priority to JP2021518268A priority patent/JP7160187B2/ja
Publication of WO2020225894A1 publication Critical patent/WO2020225894A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/08—Systems determining position data of a target for measuring distance only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/933—Lidar systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C3/00—Measuring distances in line of sight; Optical rangefinders
    • G01C3/02—Details
    • G01C3/06—Use of electric means to obtain final indication
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/006—Theoretical aspects
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T1/00—General purpose image data processing

Definitions

  • the present disclosure relates to a non-temporary computer-readable medium in which a position management device, a position management system, a position management method, and a program are stored.
  • Non-Patent Document 1 discloses a system for guiding a helicopter to a landing point.
  • the marker provided on the helicopter is detected by an infrared camera, and a laser for measuring the distance to a specific part of the helicopter's body (specifically, a reflector provided near the marker) is emitted. Eject. As a result, the distance to a specific point (reflector) of the helicopter body is measured. According to this technique, the position of the helicopter can be grasped.
  • Non-Patent Document 1 it is necessary to attach marks such as markers and reflectors to moving objects. Further, when the moving object is moving in a direction in which the mark cannot be seen, the position of the flying object cannot be grasped.
  • the present disclosure has been made to solve such a problem, and is a position management device, a position management system, and a position management method capable of grasping the position of a moving object without providing a mark on the moving object. And the purpose of providing the program.
  • the position management device is A sensor that measures the distances of a plurality of points of a moving object for each unit time and acquires point cloud data representing the coordinates of the plurality of points in space for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • a pair selection means for selecting a pair of the coordinates with the second point cloud data, and The position of the moving object is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating the coordinates of the pair selected by the pair selection means with each other.
  • the pair selection means has a direction seen from the sensor of the first point belonging to the first point cloud data and a direction seen from the sensor of the second point belonging to the second point cloud data.
  • the pair of coordinates is selected by pairing the first point and the second point.
  • the position management system is Equipped with an aircraft and a position management device,
  • the position management device is A sensor that measures the distances of a plurality of points of the aircraft for each unit time and acquires point cloud data representing the coordinates of the plurality of points in space for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • a pair selection means for selecting a pair of the coordinates with the second point cloud data, and
  • the position of the aircraft is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating both coordinates of the pair selected by the pair selection means with each other.
  • the pair selection means has a direction seen from the sensor of the first point belonging to the first point cloud data and a direction seen from the sensor of the second point belonging to the second point cloud data.
  • the pair of coordinates is selected by pairing the first point and the second point.
  • the distance between multiple points of a moving object is measured by a sensor every unit time, Point cloud data representing the coordinates in the space of the plurality of locations is acquired for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • Select the pair of coordinates with and from the second point cloud data The position of the moving object is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating both coordinates of the selected pair with each other.
  • the pair of coordinates is selected by pairing the first point and the second point.
  • the program according to the fourth aspect of the present disclosure is The point group data acquired at a first time point by a sensor that measures the distances of a plurality of points of a moving object for each unit time and acquires point group data representing the coordinates of the plurality of points in space for each unit time.
  • first point group data which is the point group data
  • second point group data which is the point group data acquired at the second time point, which is one unit time before the first time point.
  • a position estimation step for estimating the position of the moving object by performing an alignment process between the first point cloud data and the second point cloud data by associating both coordinates of the selected pair with each other.
  • the pair selection step the direction of the first point belonging to the first point cloud data as seen from the sensor and the direction of the second point belonging to the second point cloud data as seen from the sensor.
  • the pair of coordinates is selected by pairing the first point and the second point.
  • a position management device capable of grasping the position of a moving object without providing a mark on the moving object.
  • FIG. 1 It is a block diagram which shows an example of the structure of the position management apparatus which concerns on the outline of embodiment. It is a schematic diagram which shows an example of the structure of the position management system which concerns on Embodiment 1.
  • FIG. It is a figure which shows the coordinates obtained by a sensor. It is a schematic diagram explaining the emission of the beam of a sensor. It is a schematic diagram which shows an example of the scanning trajectory of a beam. It is a schematic diagram explaining the emission of the beam of a sensor. It is a schematic diagram which shows an example of the hardware composition of a control part. It is a flowchart which shows an example of the operation of the position management apparatus which concerns on Embodiment 1.
  • FIG. 1 It is a block diagram which shows an example of the structure of the position management apparatus which concerns on the outline of embodiment. It is a schematic diagram which shows an example of the structure of the position management system which concerns on Embodiment 1.
  • FIG. It is a figure which shows the coordinates obtained by a sensor. It is
  • FIG. It is a flowchart which shows an example of the operation of a pair selection part. It is a graph which shows the accuracy of the alignment process at the time of simulating the behavior of the position management system which concerns on Embodiment 1.
  • FIG. It is a schematic diagram which shows an example of the structure of the position management apparatus which concerns on Embodiment 2.
  • FIG. It is a flowchart which shows an example of the operation of the position management apparatus which concerns on Embodiment 2.
  • FIG. 1 is a block diagram showing an example of the configuration of the position management device 1 according to the outline of the embodiment.
  • the position management device 1 has a sensor 2, a pair selection unit 3, and a position estimation unit 4, and manages the position of a moving object.
  • the moving object is, for example, an aircraft (flying object), but is not limited to this.
  • the moving object may be an object that moves on land.
  • the sensor 2 measures the distances of a plurality of points of a moving object every unit time, and acquires point cloud data representing the coordinates of the plurality of points in space every unit time.
  • the sensor 2 is a LiDAR (Light Detection and Ringing) device that emits a beam and measures the distance to the object based on the time until the beam reflected by the object reaches the sensor 2.
  • LiDAR Light Detection and Ringing
  • the pair selection unit 3 selects a coordinate pair between the first point cloud data and the second point cloud data.
  • the first point cloud data is the point cloud data acquired by the sensor 2 at the first time point cloud
  • the second point cloud data is the first point cloud data obtained by the unit time before the first time point cloud. It is the point cloud data acquired by the sensor 2 at the time point 2.
  • the pair selection unit 3 selects a pair as follows. That is, in the pair selection unit 3, the difference between the direction of the first point belonging to the first point cloud data and the direction of the second point belonging to the second point cloud data is equal to or less than a predetermined first threshold value.
  • a pair of coordinates is selected by pairing the first and second points.
  • the direction of the first point is, more specifically, the direction seen from the sensor 2 of the first point
  • the direction of the second point is the direction seen from the sensor 2 of the second point.
  • the position estimation unit 4 makes the coordinates of the pair selected by the pair selection unit 3 correspond to each other, and performs the alignment process of the first point cloud data and the second point cloud data to perform the alignment process of the moving object. Estimate the position.
  • the position of the moving object is estimated using the point cloud data obtained by measuring the distance of an arbitrary position of the moving object. Therefore, the position of the moving object can be grasped without providing a mark on the moving object. Further, according to the position management device 1, the alignment process is performed by associating points having similar directions with each other. Therefore, the alignment process of the point cloud data can be appropriately performed as compared with the case where the alignment process is performed by associating arbitrary points (for example, randomly selected points) with each other. That is, the position of the moving object can be estimated more appropriately.
  • FIG. 2 is a schematic view showing an example of the configuration of the position management system 10 according to the first embodiment.
  • the position management system 10 includes an aircraft 200, which is a specific example of a moving object, and a position management device 100. Although only one aircraft 200 is shown in FIG. 1, there may be a plurality of aircraft 200.
  • the aircraft 200 may be, for example, an unmanned aerial vehicle such as a drone, but may be a manned aircraft such as a helicopter.
  • the aircraft 200 has a flight control unit 201.
  • the flight control unit 201 controls the flight of the aircraft.
  • the flight control unit 201 controls the flight according to the notification from the notification unit 124 described later of the position management device 100.
  • the position management device 100 corresponds to the position management device 1 in FIG.
  • the position management device 100 has a sensor 110 and a control unit 120 as shown in FIG.
  • the sensor 110 corresponds to the sensor 2 in FIG.
  • the sensor 110 is a LiDAR device that emits a beam for measuring a distance.
  • the sensor 110 measures the distance to the aircraft 200 by measuring the time it takes for the emitted beam to be reflected by the aircraft 200 flying in space and return to the sensor 110.
  • the beam is periodically ejected in various directions.
  • the sensor 110 measures the distances of the plurality of points of the aircraft 200 every unit time, and acquires the point cloud data representing the coordinates of the plurality of points in space every unit time.
  • FIG. 3 is a diagram showing the coordinates obtained by the sensor 110.
  • the sensor 110 emits a beam in the emission direction 50 with respect to the three-dimensional space.
  • the origin indicates the position of the sensor 110
  • the point p indicates the position where the beam emitted in the injection direction 50 is reflected.
  • the injection direction 50 is represented by an angle (azimuth) ⁇ of a horizontal component and an angle (elevation / depression angle) ⁇ of a vertical component.
  • the sensor 110 measures the distance d to the point p when the beam is ejected in the ejection direction 50. As a result, the sensor 110 acquires the coordinates of the point p uniquely determined by the injection direction 50 and the distance d.
  • FIG. 4 is a schematic view illustrating the emission of the beam of the sensor 110 according to the present embodiment.
  • the sensor 110 emits the beam 52 within the predetermined emission range 51.
  • FIG. 5 is a schematic view showing an example of the scanning trajectory of the beam 52.
  • the horizontal axis represents the azimuth angle at which the beam 52 is ejected
  • the vertical axis represents the elevation / depression angle at which the beam 52 is ejected.
  • the injection range 51 is specified by the azimuth angle and the elevation / depression angle.
  • the sensor 110 emits the beam 52 so as to periodically draw a predetermined scanning trajectory at the period t.
  • FIG. 5 is a schematic view showing an example of the scanning trajectory of the beam 52.
  • the horizontal axis represents the azimuth angle at which the beam 52 is ejected
  • the vertical axis represents the elevation / depression angle at which the beam 52 is ejected.
  • the injection range 51 is specified by the azimuth angle and the elevation / depression angle.
  • the scanning trajectory 53 shown by a solid line in the ejection range 51 indicates the scanning trajectory of the beam 52 in the k-period
  • the scanning trajectory 54 indicated by the broken line in the ejection range 51 is the (k-1) period. It shows the scanning trajectory of the eye beam 52.
  • k is an integer of 2 or more.
  • the scanning trajectories 53 and 54 are geometric patterns over the entire predetermined ejection range 51 (for example, a circular range), respectively. In this way, the sensor 110 periodically scans according to the scanning trajectory of the geometric pattern over the entire predetermined ejection range 51.
  • the injection range 51 is circular, but it is not limited to the circular shape and may have any other shape.
  • the position of the scanning trajectory (the position of the geometric pattern) is deviated so as to rotate by a predetermined angle on the azimuth-elevation / depression angle plane for each cycle.
  • the position may be constant.
  • the geometric patterns of the scanning trajectories 53 and 54 shown in FIG. 5 are examples, and any other geometric pattern may be used.
  • the sensor 110 described with reference to FIGS. 4 and 5 may be referred to as a space-limited LiDAR device.
  • the sensor 110 does not necessarily have to be a space-limited LiDAR device.
  • the sensor 110 may be, for example, a LiDAR device as shown in FIG.
  • the sensor 110 shown in FIG. 6 emits n beams (where n is an integer of 1 or more) of beams 55_1, 55_2, ..., 55_n into a three-dimensional space.
  • the n beams have different elevation / depression angles.
  • the sensor 110 periodically emits beams 55_1, 55_2, ..., 55_n with a period t in all directions.
  • the sensor 110 described with reference to FIG. 6 will be referred to as an omnidirectional LiDAR device.
  • the control unit 120 of the position management device 100 includes a pair selection unit 121, a position estimation unit 122, a route determination unit 123, and a notification unit 124.
  • the pair selection unit 121 corresponds to the pair selection unit 3 in FIG.
  • Point cloud data is acquired by the sensor 110 every cycle t, that is, every unit time.
  • the pair selection unit 121 includes point cloud data (first point cloud data) acquired by the sensor 110 in the kth cycle and point cloud data (second point cloud data) acquired in the (k-1) cycle. Select a pair of coordinates between and. That is, a pair consisting of the coordinates (point p) included in the point cloud data acquired in the k-cycle and the coordinates (point p) included in the point cloud data acquired in the k-1 cycle is determined.
  • the pair selection unit 121 selects one or more pairs that satisfy a predetermined condition. The details of the processing of the pair selection unit 121 will be described later with reference to the flowchart.
  • the position estimation unit 122 corresponds to the position estimation unit 4 in FIG. Since the aircraft 200 is an object having a predetermined shape and size, the distance obtained as a measurement result varies depending on which part of the surface of the aircraft 200 is used as the measurement point for measuring the distance. Therefore, the position estimation unit 122 estimates the position of the aircraft 200 as follows.
  • the position estimation unit 122 makes the two coordinates of the pair selected by the pair selection unit 121 correspond to each other, and the point cloud data acquired in the k-period and the point cloud data acquired in the (k-1) period.
  • the position of the aircraft 200 is estimated by performing the alignment process with.
  • the alignment process is also called a registration process.
  • the position estimation unit 122 uses a known algorithm in the alignment process of the point cloud data. Specifically, for example, ICP (Iterative Closest Point) or NDT (Normal Distributions Transform) may be used as such an algorithm.
  • ICP Intelligent Closest Point
  • NDT Normal Distributions Transform
  • the coordinates of one point cloud data and the coordinates of the other point cloud data are made to correspond to each other so that the points come closer to each other, that is, the distance between the points becomes smaller. Identify the correspondence.
  • a parameter indicating how to move one point cloud data and how to rotate it to match the other point cloud data can be obtained by the alignment process. More specifically, parameters of a rotation matrix and a translation matrix for transforming one point cloud data to match the other point cloud data are obtained.
  • the displacement of the aircraft 200 from the position at the time of the (k-1) cycle to the position at the time of the k cycle can be obtained by performing the alignment process. Can be identified. Therefore, the current position of the aircraft 200 (the position at the time of the kth cycle) can be specified.
  • the position estimation unit 122 estimates the initial position of the aircraft 200 (the position at the time of the first cycle) by, for example, calculating the center of gravity of the point cloud data. Then, the position estimation unit 122 sets the position of the aircraft 200 at the time of the kth cycle (k> 2) from the position of the aircraft 200 at the time of the k-1th cycle and the displacement of the position obtained by the alignment result. presume.
  • the route determination unit 123 predicts the future route of the aircraft 200 from the transition of the position of the aircraft 200 estimated by the position estimation unit 122. That is, the route determination unit 123 predicts the future route when the current movement direction and speed calculated from the transition of the position of the aircraft 200 estimated by the position estimation unit 122 continue. Then, the route determination unit 123 determines whether or not the predicted route of the aircraft 200 is appropriate.
  • the route determination unit 123 may determine whether or not the route is appropriate according to an arbitrary predetermined determination criterion. For example, the route determination unit 123 may determine that the route of the aircraft 200 is not appropriate when the route of the aircraft 200 is different from the route specified in advance. Further, for example, the route determination unit 123 may determine that the route of the aircraft 200 is not appropriate when the route of the aircraft 200 interferes with the route of another aircraft. In this case, in order to grasp the route of the other aircraft, the position and the moving direction of the other aircraft may be similarly estimated by the method described above, and the route data indicating the route of the other aircraft may be obtained from the position management device 100. May remember.
  • the notification unit 124 When the route determination unit 123 determines that the route of the aircraft 200 is not appropriate, the notification unit 124 notifies the aircraft 200 of the change in the moving direction.
  • the notification unit 124 may notify the aircraft 200 of the change in speed instead of changing the moving direction or at the same time as changing the moving direction.
  • the notification unit 124 may notify an appropriate moving direction or speed.
  • the emission direction of the beam emitted by the sensor 110 for measuring the distance is limited to a predetermined azimuth angle and elevation / depression angle. Therefore, in order to acquire the point cloud data, it is preferable that the aircraft 200 flies so that the beam is irradiated. Therefore, the notification unit 124 may notify the aircraft 200 of the moving direction so that the beam emitted by the sensor 110 to measure the distance hits the aircraft 200. By doing so, it is possible to appropriately obtain point cloud data for the aircraft 200.
  • FIG. 7 is a schematic view showing an example of the hardware configuration of the control unit 120.
  • the control unit 120 includes a network interface 150, a memory 151, and a processor 152.
  • the network interface 150 is used to communicate with other devices such as the aircraft 200.
  • the notification unit 124 communicates with the aircraft 200 by wire or wirelessly using the network interface 150.
  • the memory 151 is composed of, for example, a combination of a volatile memory and a non-volatile memory.
  • the memory 151 is used to store software (computer program) including one or more instructions executed by the processor 152.
  • the processor 152 processes the control unit 120 by reading software (computer program) from the memory 151 and executing the software (computer program).
  • the processor 152 may be, for example, a microprocessor, an MPU (Micro Processor Unit), a CPU (Central Processing Unit), or the like.
  • the processor 152 may include a plurality of processors.
  • control unit 120 has a function as a computer.
  • aircraft 200 may have a hardware configuration. That is, the processing of the flight control unit 201 described above may be realized by executing a program by the processor.
  • Non-transitory computer-readable media include various types of tangible storage media (tangible storage media).
  • Examples of non-temporary computer-readable media include magnetic recording media (eg, flexible disks, magnetic tapes, hard disk drives), magneto-optical recording media (eg, magneto-optical disks), CD-ROMs (Read Only Memory) CD-Rs, CDs. -R / W, semiconductor memory (for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM (Random Access Memory)) is included.
  • the program may also be supplied to the computer by various types of temporary computer-readable media (transitory computer readable media).
  • temporary computer-readable media include electrical, optical, and electromagnetic waves.
  • the temporary computer-readable medium can supply the program to the computer via a wired communication path such as an electric wire and an optical fiber, or a wireless communication path.
  • FIG. 8 is a flowchart showing an example of the operation of the position management device 100.
  • FIG. 9 is a flowchart showing an example of the operation of the pair selection unit 121.
  • the operation of the position management device 100 will be described with reference to FIGS. 8 and 9.
  • the position management device 100 periodically repeats the processes from step S10 to step S15. In other words, the position management device 100 repeats the following processing every cycle t, that is, every unit time.
  • step S10 the sensor 110 acquires the point cloud data.
  • step S11 the pair selection unit 121 selects a coordinate pair between the latest point cloud data and the point cloud data acquired one cycle before.
  • step S12 the position estimation unit 122 performs the alignment process so that both coordinates of the pair selected in step S11 correspond to each other, and estimates the position of the aircraft 200.
  • step S13 the route determination unit 123 predicts the future route of the aircraft 200 and determines whether or not the predicted route is appropriate. If the route is inappropriate (No in step S14), the process proceeds to step S15. On the other hand, if the route is appropriate (Yes in step S14), step S15 is skipped.
  • step S15 the notification unit 124 notifies the aircraft 200 of the change in the moving direction.
  • the flight control unit 201 of the aircraft 200 changes the moving direction based on the notification.
  • the pair selection unit 121 includes the first point cloud data which is the point cloud data acquired in the kth cycle and the second point cloud data which is the point cloud data acquired in the k-1th cycle. Select a point (coordinate) pair between and.
  • the details of the processing of the pair selection unit 121 will be described with reference to FIG.
  • one of the pair selection units 121 is a first point, the other is a second point, and the difference in the directions of both points as seen from the sensor 110 is a predetermined threshold Th 1 (first point).
  • Two points that are less than or equal to the threshold value of) are candidates for a pair.
  • the first point is a point (coordinate) belonging to the first point cloud data
  • the second point is a point (coordinate) belonging to the second point cloud data.
  • the pair selection unit 121 sets all two points satisfying this condition as pair candidates. Therefore, a plurality of pair candidates may be generated for the same first point or the same second point.
  • (p 1, p '1 ), (p 1, p' 2), (p 2, p '2) may occur like.
  • p 1 and p 2 is a point belonging to the point group data of the k-th cycle
  • p '1 and p' 2 is a point belonging to the (k-1) th cycle of the point group data.
  • the pair selection unit 121 extracts two points in close directions on condition that the difference in direction is the threshold value Th 1 or less.
  • step S111 the pair selection unit 121 calculates the difference in distance between the two points for all the pair candidates extracted in step S110. That is, the pair selection unit 121 calculates the difference between the distance from the sensor 110 at one point forming the pair and the distance from the sensor 110 at the other point in each pair candidate.
  • step S112 when a plurality of pair candidates are generated for the same point, the pair selection unit 121 selects the pair candidates other than those having the smallest difference in distance calculated in step S111. exclude. That is, when a plurality of pair candidates are generated for the same point, the pair selection unit 121 leaves only the pair candidates having the smallest distance difference.
  • the difference in distance, or Only candidates for the pair will remain.
  • the pair selection unit 121 when the pair selection unit 121 has a plurality of second points in which the difference in the direction seen from the sensor 110 is equal to or less than the first threshold value with respect to the same first point, the sensor 110 of the first point The second point where the difference between the distance from the sensor 110 and the distance from the second point from the sensor 110 is the smallest is set as a pair candidate.
  • the sensor 110 of the first point when the pair selection unit 121 has a plurality of first points in which the difference in the direction seen from the sensor 110 is equal to or less than the first threshold value with respect to the same second point, the sensor 110 of the first point The first point, which has the smallest difference between the distance from the sensor 110 and the distance from the sensor 110 of the second point, is used as a pair candidate. By doing so, it is possible to make at most one pair for the same point, so that the correspondence between the first point cloud data and the second point cloud data can be appropriately determined.
  • the measured distance may differ greatly even if the beam ejection direction is slightly different. For example, such an event occurs at the edge of the shape of a three-dimensional object.
  • the value of the parameter is determined so that the point of one point cloud data and the point of the other point cloud data are brought close to each other. For this reason, if two points having significantly different distances are used in the alignment process, the two points have a great influence on the alignment result, so that an appropriate alignment result may not be obtained. Therefore, in the present embodiment, the following processing is performed so that an appropriate alignment result can be obtained.
  • step S113 the pair selection unit 121 determines whether or not the difference in distance calculated in step S111 is equal to or less than a predetermined threshold value Th 2 (second threshold value) with respect to the remaining pair candidates.
  • the pair selection unit 121 excludes candidates for pairs exceeding a predetermined threshold value Th 2 (step S115), and sets candidates for pairs having a threshold value Th 2 or less as regular pairs (step S114). In this way, the pair selection unit 121 selects a coordinate pair from the first point cloud data and the second point cloud data.
  • the pair selection unit 121 outputs one or more regular pairs obtained in step S113 to the position estimation unit 122.
  • the position estimation unit 122 performs the alignment process as follows.
  • the position estimation unit 122 constitutes a regular pair selected by the pair selection unit 121 among the point cloud data acquired in the k-period and the point cloud data acquired in the (k-1) period.
  • the alignment process is performed so that these points come close to each other using the coordinates of.
  • the difference between the direction of the first point and the direction of the second point is equal to or less than the first threshold value, and the distance between the first point and the distance between the second points
  • a pair of coordinates is selected by pairing these points.
  • the pair selection unit 121 allows the generation of a plurality of pair candidates for the same point, but the pair selection unit 121 generates a plurality of pair candidates. You do not have to allow it to be done. That is, a maximum of one pair of candidates may be generated for the same point.
  • the pair selection unit 121 is, for example, in step S110, only the combination of the first point and the second point where the difference in direction is equal to or less than the predetermined threshold value Th 1 and the difference in direction is the smallest. Is a candidate for a pair. In this case, since a plurality of pair candidates are not generated for the same point, the above-mentioned process of step S112 is omitted.
  • step S113 pair candidates are excluded based on the difference in distance, but such exclusion does not necessarily have to be performed. That is, step S113 may be omitted. However, in order to perform the alignment process with higher accuracy, it is preferable that the process of step S113 is performed.
  • the farther the aircraft 200 is from the sensor 110 the lower the density of the beam that hits the aircraft 200. That is, the farther the aircraft 200 is from the sensor 110, the lower the density of measurement points. Therefore, the farther the aircraft 200 is, the larger the interval between measurement points. That is, the measurement conditions (measurement intervals on the surface of the aircraft 200) differ depending on how far the aircraft 200 is measured from the sensor 110. Therefore, it is not preferable to use a fixed value as the threshold value Th 2 for the difference in distance, which is a threshold value for determining the validity of the pair.
  • the pair selection unit 121 in order to set the threshold value according to the measurement condition, is the difference between the distance from the sensor 110 at the first point and the distance from the sensor 110 at the second point.
  • the value of the threshold Th 2 is set based on the statistical value of. Specifically, for each cycle, in step S113, the pair selection unit 121 calculates the standard deviation s from the distribution of all the distance differences calculated in step S111. Then, the pair selection unit 121 sets the product of the calculated standard deviation s and the predetermined coefficient ⁇ to the value of the threshold value Th 2 .
  • the value of the coefficient ⁇ is a constant value, for example, a predetermined integer value.
  • the pair selection unit 121 calculates the value of the threshold value Th 2 for each cycle, but a fixed value, that is, a constant value may be used as the threshold value Th 2 .
  • FIG. 10 is a graph showing the accuracy of the alignment process when simulating the behavior of the position management system 10.
  • a three-dimensional model imitating an aircraft 200 is flown in a virtual space, and the measurement operation of the sensor 110 is simulated. Then, the above-mentioned pair selection process and alignment process are performed on the point cloud data obtained by this simulation.
  • the horizontal axis indicates the distance from the sensor 110 to the aircraft 200.
  • the vertical axis shows the error of the alignment processing result. More specifically, the vertical axis represents the point cloud data obtained by converting one point cloud data of the alignment target using the parameters obtained as the alignment result, and the other point cloud data of the alignment target. Shows the average of the coordinate errors of. In the example shown in FIG.
  • the aircraft 200 approaches the sensor 110 at 5 meters per second, and the sensor 110 acquires point cloud data at a cycle of every 50 milliseconds.
  • the alignment is performed with a high accuracy of a distance of about 80 meters and an average error of less than 10 centimeters.
  • the distance measurement cycle (cycle t) needs to be a short time (for example, about 50 milliseconds).
  • the number of measurement points for the aircraft 200 in each cycle is limited. That is, the number of point cloud data (points) corresponding to the aircraft 200 at a certain point in time that can be obtained is limited. Therefore, if the existing alignment processing algorithm is simply used, there is a possibility that the alignment result with sufficient accuracy cannot be obtained.
  • the pair selection unit 121 specifies a pair of points to be brought close to each other, and then the alignment process is performed. Therefore, even if the number of data is small, the alignment process is performed with high accuracy. Is done. Therefore, the position of the aircraft 200 can be appropriately managed. In particular, according to the present embodiment, the position of the aircraft 200 can be grasped without providing a mark on the aircraft 200.
  • the position management device appropriately manages the positions of the plurality of aircraft 200.
  • the position management system according to the present embodiment is different from the position management system 10 according to the first embodiment in that the position management device 100 is replaced with the position management device 101.
  • FIG. 11 is a schematic view showing an example of the configuration of the position management device 101 according to the second embodiment.
  • the position management device 101 is different from the position management device 100 of the first embodiment in that the control unit 120 further includes the clustering unit 125.
  • the description overlapping with the first embodiment will be omitted as appropriate.
  • the clustering unit 125 performs a clustering process on the point cloud data obtained from the sensor 110 every cycle to generate a cluster.
  • the clustering unit 125 generates a cluster by using an arbitrary known clustering algorithm (for example, Euclidean clustering). As a result, a cluster of point cloud data for each aircraft 200 can be obtained.
  • an arbitrary known clustering algorithm for example, Euclidean clustering
  • the pair selection unit 121 performs pair selection processing for each cluster. Further, in the present embodiment, the position estimation unit 122 performs the alignment process and the position estimation for each cluster. That is, the position estimation unit 122 estimates the position of each aircraft 200 by performing the alignment process of the first point cloud data and the second point cloud data for each cluster. As a result, the position of each aircraft 200 can be managed.
  • the pair selection unit 121 is a statistical value (standard deviation s) regarding the difference between the distance from the sensor 110 at the first point and the distance from the sensor 110 at the second point for each cluster.
  • the value of the threshold Th 2 is set based on. That is, the standard deviation s is calculated for each cluster, and the value of the threshold Th 2 is set for each cluster. In this way, the pair selection unit 121 does not calculate the statistical value from the distribution of all the point cloud data existing in the three-dimensional space, but calculates the statistical value from the distribution of the point cloud data for each cluster. Therefore, the value of the threshold value Th 2 can be set appropriately.
  • FIG. 12 is a flowchart showing an example of the operation of the position management device 101.
  • the flowchart shown in FIG. 12 is different from the flowchart shown in FIG. 8 in that step S20 is added between steps S10 and S11.
  • the position management device 101 periodically repeats the process of the step shown in FIG. In other words, the position management device 100 repeats the process of the step shown in FIG. 12 every cycle t, that is, every unit time.
  • step S10 the process proceeds to step S20.
  • step S20 the clustering unit 125 performs a clustering process to generate a cluster of point cloud data.
  • step S20 the process proceeds to step S11.
  • the same processing as in the first embodiment is performed.
  • the pair selection unit 121 sets the pair selection and the value of the threshold value Th 2 for each cluster, and the position estimation unit 122 executes the alignment process for each cluster.
  • (Appendix 1) A sensor that measures the distances of a plurality of points of a moving object for each unit time and acquires point cloud data representing the coordinates of the plurality of points in space for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • a pair selection means for selecting a pair of the coordinates with the second point cloud data, and The position of the moving object is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating the coordinates of the pair selected by the pair selection means with each other.
  • the pair selection means has a direction seen from the sensor of the first point belonging to the first point cloud data and a direction seen from the sensor of the second point belonging to the second point cloud data.
  • a position management device that selects a pair of coordinates by pairing the first point and the second point when the difference is equal to or less than a predetermined first threshold value.
  • Appendix 2 In the pair selection means, the difference between the direction of the first point seen from the sensor and the direction of the second point seen from the sensor is equal to or less than a predetermined first threshold value, and the first point is said.
  • the difference between the distance of one point from the sensor and the distance of the second point from the sensor is equal to or less than a predetermined second threshold value, the first point and the second point are paired.
  • the position management device according to Appendix 1, wherein the pair of coordinates is selected by the operation.
  • the pair selection means sets the value of the second threshold value based on the statistical value of the difference between the distance of the first point from the sensor and the distance of the second point from the sensor.
  • the position management device according to 2.
  • (Appendix 4) Further, it has a clustering means for generating a cluster by performing a clustering process on the point cloud data.
  • the position management device according to any one of Supplementary note 1 to 3, wherein the position estimation means performs an alignment process between the first point cloud data and the second point cloud data for each cluster.
  • (Appendix 5) Further, it has a clustering means for generating a cluster by performing a clustering process on the point cloud data.
  • the pair selection means sets the value of the second threshold value for each cluster based on the statistical value, and sets the value of the second threshold value.
  • the position management device according to Appendix 3, wherein the position estimation means performs an alignment process between the first point cloud data and the second point cloud data for each cluster. (Appendix 6)
  • the pair selection means has a plurality of the second points in which the difference in the direction seen from the sensor is equal to or less than the first threshold value with respect to the same first point, the said first point.
  • the second point which has the smallest difference between the distance from the sensor and the distance of the second point from the sensor, is set as a pair candidate, and the same second point is in the direction seen from the sensor.
  • the difference between the distance of the first point from the sensor and the distance of the second point from the sensor is the smallest.
  • the position management device according to any one of Appendix 1 to 5, wherein the first point is a candidate for a pair.
  • Appendix 7 In any one of Appendix 1 to 6, further comprising a route determining means for determining whether or not the route of the moving object predicted from the transition of the position of the moving object estimated by the position estimating means is appropriate.
  • the described position management device is any one of Appendix 1 to 5, wherein the first point is a candidate for a pair.
  • the position management device is A sensor that measures the distances of a plurality of points of the aircraft for each unit time and acquires point cloud data representing the coordinates of the plurality of points in space for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • a pair selection means for selecting a pair of the coordinates with the second point cloud data, and The position of the aircraft is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating both coordinates of the pair selected by the pair selection means with each other. It has a position estimation means and The pair selection means has a direction seen from the sensor of the first point belonging to the first point cloud data and a direction seen from the sensor of the second point belonging to the second point cloud data.
  • the position management device is A route determining means for determining whether or not the route of the aircraft predicted from the transition of the position of the aircraft estimated by the position estimating means is appropriate, and Further, it has a notification means for notifying the aircraft of a change in the moving direction or speed when the route determination means determines that the route of the aircraft is not appropriate.
  • the position management system according to Appendix 10, wherein the aircraft has flight control means for controlling flight in accordance with notification from the notification means.
  • Point cloud data representing the coordinates in the space of the plurality of locations is acquired for each unit time.
  • the first point cloud data which is the point cloud data acquired at the first time point cloud data
  • the point cloud data acquired at the second time point cloud which is one unit time before the first time point cloud.
  • Select the pair of coordinates with and from the second point cloud data The position of the moving object is estimated by performing the alignment process of the first point cloud data and the second point cloud data by associating both coordinates of the selected pair with each other.
  • a pair selection step to select a coordinate pair and A position estimation step for estimating the position of the moving object by performing an alignment process between the first point cloud data and the second point cloud data by associating both coordinates of the selected pair with each other.
  • Let the computer run In the pair selection step the direction of the first point belonging to the first point cloud data as seen from the sensor and the direction of the second point belonging to the second point cloud data as seen from the sensor.
  • a non-temporary computer-readable medium containing a program for selecting the coordinate pair by pairing the first point and the second point is .
  • Position management device 2 Sensor 3 Pair selection unit 4 Position estimation unit 10 Position management system 50 Ejection direction 51 Emission range 52 Beam 53 Scanning trajectory 54 Scanning trajectory 55 Beam 100 Position management device 101 Position management device 110 Sensor 120 Control unit 121 Pair selection Unit 122 Position estimation unit 123 Route determination unit 124 Notification unit 125 Clustering unit 150 Network interface 151 Memory 152 Processor 200 Aircraft 201 Flight control unit

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

移動物体に目印を設けることなく、移動物体の位置を把握する。位置管理装置（１）は、点群データを単位時間毎に取得するセンサ（２）と、第１の点群データと、第２の点群データとの間で、前記座標のペアを選択するペア選択部（３）と、前記ペア選択部（３）により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定部（４）とを有する。前記ペア選択部（３）は、前記第１の点群データに属する第１の点の方向と、前記第２の点群データに属する第２の点の方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する。

Description

位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体
　本開示は、位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体に関する。
　ドローンを物流に利用するなど、ドローンを活用した様々なサービスの提案が近年行なわれている。物流拠点や人口密集地などのように、ドローンなどの航空機が密集する可能性がある場所では、航空機の位置を適切に管理する必要がある。
　これに関して、非特許文献１は、ヘリコプタを着陸地点まで誘導するシステムについて開示している。このシステムでは、ヘリコプタに設けられたマーカを赤外線カメラにより検出することにより、ヘリコプタの機体の特定の箇所（具体的にはマーカ付近に設けられたリフレクタ）に対し、距離を測定するためのレーザーを射出する。これにより、ヘリコプタの機体の特定の箇所（リフレクタ）までの距離が測定される。この技術によれば、ヘリコプタの位置を把握することができる。
山下尚之、他４名、「特集論文　ＳＨ－６０Ｋ哨戒ヘリコプタの開発」、三菱重工技報、三菱重工業株式会社、２００５年１２月、Ｖｏｌ．４２、Ｎｏ．５、ｐ．２０８－２１１
　非特許文献１に開示された技術では、移動物体に対し、マーカ及びリフレクタといった目印を取り付ける必要がある。また、この目印が見えないような向きで移動物体が移動している場合、飛行物体の位置を把握することができない。
　本開示は、このような問題点を解決するためになされたものであり、移動物体に目印を設けることなく、移動物体の位置を把握することができる位置管理装置、位置管理システム、位置管理方法及びプログラムを提供することを目的とする。
　本開示の第１の態様にかかる位置管理装置は、
　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定手段と
　を有し、
　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する。
　本開示の第２の態様にかかる位置管理システムは、
　航空機と、位置管理装置とを備え、
　前記位置管理装置は、
　　前記航空機の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
　　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
　　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記航空機の位置を推定する位置推定手段と
　を有し、
　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する。
　本開示の第３の態様にかかる位置管理方法では、
　移動物体の複数箇所の距離を単位時間毎にセンサにより測定し、
　前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得し、
　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択し、
　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定し、
　前記座標のペアの選択において、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する。
　本開示の第４の態様にかかるプログラムは、
　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサによって第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択ステップと、
　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定ステップと
　をコンピュータに実行させ、
　前記ペア選択ステップでは、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する。
　本開示によれば、移動物体に目印を設けることなく、移動物体の位置を把握することができる位置管理装置、位置管理システム、位置管理方法及びプログラムを提供することができる。
実施形態の概要にかかる位置管理装置の構成の一例を示すブロック図である。 実施形態１にかかる位置管理システムの構成の一例を示す模式図である。 センサにより得られる座標について示す図である。 センサのビームの射出について説明する模式図である。 ビームの走査軌道の一例を示す模式図である。 センサのビームの射出について説明する模式図である。 制御部のハードウェア構成の一例を示す模式図である。 実施形態１にかかる位置管理装置の動作の一例を示すフローチャートである。 ペア選択部の動作の一例を示すフローチャートである。 実施形態１にかかる位置管理システムの挙動をシミュレーションした際の位置合わせ処理の精度を示すグラフである。 実施形態２にかかる位置管理装置の構成の一例を示す模式図である。 実施形態２にかかる位置管理装置の動作の一例を示すフローチャートである。
　説明の明確化のため、以下の記載及び図面は、適宜、省略、及び簡略化がなされている。なお、各図面において、同一の要素には同一の符号が付されており、必要に応じて重複説明は省略されている。
＜実施形態の概要＞
　実施形態の詳細を説明する前に、まず、実施形態の概要について説明する。図１は、実施形態の概要にかかる位置管理装置１の構成の一例を示すブロック図である。図１に示すように、位置管理装置１は、センサ２と、ペア選択部３と、位置推定部４とを有し、移動物体の位置を管理する。なお、移動物体は、例えば、航空機（飛行物体）であるが、これに限られない。例えば、移動物体は、陸上を移動する物体であってもよい。
　センサ２は、移動物体の複数箇所の距離を単位時間毎に測定し、当該複数箇所の空間上の座標を表わす点群データを単位時間毎に取得する。例えば、センサ２は、ビームを射出し、物体により反射したビームがセンサ２に届くまでの時間により物体までの距離を測定するＬｉＤＡＲ（Light Detection and Ranging）装置である。
　ペア選択部３は、第１の点群データと第２の点群データとの間で、座標のペアを選択する。なお、第１の点群データは、センサ２により第１の時点で取得された点群データであり、第２の点群データは、この第１の時点よりも上記単位時間だけ前である第２の時点で、センサ２により取得された点群データである。ここで、ペア選択部３は、次のようにペアを選択する。すなわち、ペア選択部３は、第１の点群データに属する第１の点の方向と、第２の点群データに属する第２の点の方向との差が所定の第１の閾値以下である場合、第１の点と第２の点をペアとすることにより、座標のペアを選択する。なお、第１の点の方向とは、より詳細には、第１の点のセンサ２から見た方向を言い、第２の点の方向とは、第２の点のセンサ２から見た方向を言う。
　位置推定部４は、ペア選択部３により選択されたペアの両座標を互いに対応させて、第１の点群データと第２の点群データとの位置合わせ処理を行なうことにより、移動物体の位置を推定する。
　位置管理装置１では、移動物体の任意の箇所の距離を測定して得られる点群データを用いて、移動物体の位置が推定される。このため、移動物体に目印を設けることなく、移動物体の位置を把握することができる。また、位置管理装置１によれば、方向が近い点同士を対応させて位置合わせ処理が行なわれる。このため、任意の点同士（例えばランダムに選択された点同士）を対応させて位置合わせ処理を行なう場合よりも、点群データの位置合わせ処理を適切に行なうことができる。すなわち、移動物体の位置をより適切に推定することができる。
　次に、実施形態の詳細について説明する。
＜実施形態１＞
　図２は、実施形態１にかかる位置管理システム１０の構成の一例を示す模式図である。位置管理システム１０は、図１に示すように、移動物体の具体例である航空機２００と、位置管理装置１００とを備える。なお、図１では、航空機２００が１台のみ図示されているが、航空機２００が複数あってもよい。
　航空機２００は、例えば、ドローンなどの無人航空機が挙げられるが、ヘリコプタなどの有人航空機であってもよい。航空機２００は、飛行制御部２０１を有している。飛行制御部２０１は、航空機の飛行を制御する。特に、本実施の形態では、飛行制御部２０１は、位置管理装置１００の後述する通知部１２４からの通知に従って飛行を制御する。
　位置管理装置１００は、図１の位置管理装置１に相当する。本実施の形態では、位置管理装置１００は、図２に示すように、センサ１１０と、制御部１２０とを有する。
　センサ１１０は、図１のセンサ２に相当する。本実施形態では、センサ１１０は、ＬｉＤＡＲ装置であり、距離を測定するためのビームを射出する。センサ１１０は、射出したビームが空間を飛行している航空機２００の機体により反射しセンサ１１０に戻るまでの時間を測定することにより航空機２００までの距離を測定する。ビームは、様々な方向に、周期的に射出される。これにより、センサ１１０は、航空機２００の複数箇所の距離を単位時間毎に測定し、当該複数箇所の空間上の座標を表わす点群データを単位時間毎に取得する。
　図３は、センサ１１０により得られる座標について示す図である。センサ１１０は、図３に示すように３次元空間に対し、射出方向５０でビームを射出する。図３において、原点はセンサ１１０の位置を示し、点ｐは、射出方向５０で射出されたビームが反射した位置を示している。なお、射出方向５０は、水平成分の角度（方位角）φと、垂直成分の角度（仰俯角）θとにより表わされる。センサ１１０は、射出方向５０でビームを射出した際の点ｐまでの距離ｄを測定する。これにより、センサ１１０は、射出方向５０と距離ｄとにより一意に定まる点ｐの座標を取得する。
　図４は、本実施の形態におけるセンサ１１０のビームの射出について説明する模式図である。センサ１１０は、所定の射出範囲５１内において、ビーム５２を射出する。
　図５は、ビーム５２の走査軌道の一例を示す模式図である。図５において、横軸はビーム５２が射出される方位角を示し、縦軸はビーム５２が射出される仰俯角を示す。射出範囲５１は、方位角及び仰俯角により範囲が特定される。センサ１１０は、周期ｔで、周期的に所定の走査軌道を描くようビーム５２を射出する。図５において、射出範囲５１内に実線で示される走査軌道５３は、ｋ周期目のビーム５２の走査軌道を示し、射出範囲５１内に破線で示される走査軌道５４は、（ｋ－１）周期目のビーム５２の走査軌道を示している。ただし、ｋは２以上の整数である。図５に示すように、走査軌道５３及び５４は、それぞれ、所定の射出範囲５１（例えば円形範囲）の全体にわたった幾何学パターンである。このように、センサ１１０は、所定の射出範囲５１の全体にわたった幾何学パターンの走査軌道に従って周期的に走査する。なお、図４及び図５において、射出範囲５１は、円形であるが、円形に限らず、任意の他の形状であってもよい。また、図５に示した例では、周期毎に、走査軌道の位置（幾何学パターンの位置）が方位角－仰俯角平面上において所定の角度だけ回転するようにずれているが、走査軌道の位置は一定であってもよい。また、図５に示した走査軌道５３及び５４の幾何学パターンは、一例であり、任意の他の幾何学パターンが用いられてもよい。
　以下の説明では、図４及び図５を用いて説明したセンサ１１０について、空間限定型ＬｉＤＡＲ装置と称すことがある。なお、センサ１１０は、必ずしも空間限定型ＬｉＤＡＲ装置でなくてもよい。センサ１１０は、例えば、図６に示すようなＬｉＤＡＲ装置であってもよい。図６に示したセンサ１１０は、３次元空間に対し、ｎ本（ただし、ｎは１以上の整数）のビーム５５＿１、５５＿２、・・・、５５＿ｎを射出する。なお、ｎ本のビームは、仰俯角が異なっている。そして、センサ１１０は、センサ１１０が回転することにより、全方位に対して、周期ｔで、周期的にビーム５５＿１、５５＿２、・・・、５５＿ｎを射出する。以下の説明では、図６を用いて説明したセンサ１１０について、全方位型ＬｉＤＡＲ装置と称すこととする。
　次に、位置管理装置１００の制御部１２０について説明する。制御部１２０は、図２に示したように、ペア選択部１２１と、位置推定部１２２と、経路判定部１２３と、通知部１２４とを有する。
　ペア選択部１２１は、図１のペア選択部３に相当する。センサ１１０によって、周期ｔ毎に、すなわち、単位時間毎に、点群データが取得される。ペア選択部１２１は、センサ１１０によりｋ周期目に取得された点群データ（第１の点群データ）と（ｋ－１）周期目に取得された点群データ（第２の点群データ）との間で、座標のペアを選択する。つまり、ｋ周期目に取得された点群データに含まれる座標（点ｐ）と、ｋ－１周期目に取得された点群データに含まれる座標（点ｐ）とからなるペアを決定する。ペア選択部１２１は、所定の条件を満たす１以上のペアを選択する。ペア選択部１２１の処理の詳細については、フローチャートを参照しつつ後述する。
　位置推定部１２２は、図１の位置推定部４に相当する。航空機２００は、所定の形状及び大きさを有する物体であるため、当該航空機２００の表面のいずれの箇所を測定点として距離を測定するかにより、測定結果として得られる距離にばらつきが生じる。このため、位置推定部１２２は、次のようにして航空機２００の位置を推定する。位置推定部１２２は、ペア選択部１２１により選択されたペアの両座標を互いに対応させて、ｋ周期目に取得された点群データと、（ｋ－１）周期目に取得された点群データとの位置合わせ処理を行なって、航空機２００の位置を推定する。位置合わせ処理は、レジストレーション（registration）処理とも呼ばれる。
　位置推定部１２２は、点群データの位置合わせ処理において、公知のアルゴリズムを用いる。具体的には、例えば、そのようなアルゴリズムとして、ＩＣＰ(Iterative Closest Point)又はＮＤＴ(Normal Distributions Transform)などが用いられてもよい。位置合わせ処理では、一方の点群データの座標と他方の点群データの座標とを互いに対応させて、点同士が近づくように、すなわち点同士の距離が小さくなるように、両点群データの対応関係を特定する。これにより、位置合わせ処理により、一方の点群データをどのように移動させ、かつ、どのように回転させれば他方の点群データと一致するかを表わすパラメータが得られる。より具体的には、一方の点群データを他方の点群データと一致するよう変換するための回転行列及び平行移動行列のパラメータが得られる。
　位置合わせ処理ではこのようなパラメータが得られるため、位置合わせ処理を行なうことで、航空機２００の（ｋ－１）周期目の時点での位置から、ｋ周期目の時点での位置への変位が特定できる。このため、航空機２００の現在の位置（ｋ周期目の時点での位置）を特定できる。なお、位置推定部１２２は、航空機２００の初期位置（１周期目の時点での位置）を、例えば、点群データの重心を算出することにより推定する。そして、位置推定部１２２は、ｋ周期目（ｋ＞２）の時点の航空機２００の位置を、ｋ－１周期目の時点の航空機２００の位置と、位置合わせ結果で得られる位置の変位とから推定する。
　経路判定部１２３は、位置推定部１２２により推定された航空機２００の位置の推移から、航空機２００の今後の経路を予測する。すなわち、経路判定部１２３は、位置推定部１２２により推定された航空機２００の位置の推移から算出される現在の移動方向及び速度が継続した場合の今後の経路を予測する。そして、経路判定部１２３は、航空機２００の予測される経路が適切であるか否かを判定する。
　なお、経路判定部１２３は、任意の予め定められた判定基準に従って、経路が適切であるか否かを判定すればよい。例えば、経路判定部１２３は、航空機２００の経路が予め指定した経路とは異なる場合、航空機２００の経路が適切ではないと判定してもよい。また、例えば、経路判定部１２３は、航空機２００の経路が他の航空機の経路を妨害する場合、航空機２００の経路が適切ではないと判定してもよい。この場合、他の航空機の経路を把握するために、他の航空機の位置及び移動方向が上述した方法で同様に推定されてもよいし、他の航空機の経路を示す経路データを位置管理装置１００が記憶していてもよい。
　通知部１２４は、経路判定部１２３により航空機２００の経路が適切でないと判定された場合、移動方向の変更を航空機２００に通知する。なお、通知部１２４は、移動方向の変更に代えて、又は、移動方向の変更とともに、速度の変更を航空機２００に通知してもよい。通知部１２４は、適切な移動方向又は速度を通知してもよい。
　ところで、センサ１１０が、距離を測定するために射出するビームの射出方向は、所定の方位角及び仰俯角に限られる。したがって、点群データを取得するためには、航空機２００は、ビームが照射されるよう飛行することが好ましい。このため、通知部１２４は、センサ１１０が距離を測定するために射出するビームが当たるように移動方向を航空機２００に通知してもよい。このようにすることで、適切に航空機２００についての点群データを得ることができる。
　次に、制御部１２０のハードウェア構成の一例について説明する。図７は、制御部１２０のハードウェア構成の一例を示す模式図である。
　図７に示すように、制御部１２０は、ネットワークインタフェース１５０、メモリ１５１、及びプロセッサ１５２を含む。
　ネットワークインタフェース１５０は、航空機２００などの他の装置と通信するために使用される。通知部１２４は、ネットワークインタフェース１５０を用いて、有線又は無線により航空機２００と通信する。
　メモリ１５１は、例えば、揮発性メモリ及び不揮発性メモリの組み合わせによって構成される。メモリ１５１は、プロセッサ１５２により実行される、１以上の命令を含むソフトウェア（コンピュータプログラム）などを格納するために使用される。
　プロセッサ１５２は、メモリ１５１からソフトウェア（コンピュータプログラム）を読み出して実行することで、制御部１２０の処理を行う。プロセッサ１５２は、例えば、マイクロプロセッサ、ＭＰＵ(Micro Processor Unit)、又はＣＰＵ(Central Processing Unit)などであってもよい。プロセッサ１５２は、複数のプロセッサを含んでもよい。
　このように、制御部１２０は、コンピュータとしての機能を備えている。なお、航空機２００も同様に、ハードウェア構成を有していてもよい。すなわち、上述した飛行制御部２０１の処理が、プロセッサによるプログラムの実行により実現されてもよい。
　また、上述したプログラムは、様々なタイプの非一時的なコンピュータ可読媒体（ｎｏｎ－ｔｒａｎｓｉｔｏｒｙ　ｃｏｍｐｕｔｅｒ　ｒｅａｄａｂｌｅ　ｍｅｄｉｕｍ）を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体（ｔａｎｇｉｂｌｅ　ｓｔｏｒａｇｅ　ｍｅｄｉｕｍ）を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体（例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ）、光磁気記録媒体（例えば光磁気ディスク）、ＣＤ－ＲＯＭ（Ｒｅａｄ　Ｏｎｌｙ　Ｍｅｍｏｒｙ）ＣＤ－Ｒ、ＣＤ－Ｒ／Ｗ、半導体メモリ（例えば、マスクＲＯＭ、ＰＲＯＭ（Ｐｒｏｇｒａｍｍａｂｌｅ　ＲＯＭ）、ＥＰＲＯＭ（Ｅｒａｓａｂｌｅ　ＰＲＯＭ）、フラッシュＲＯＭ、ＲＡＭ（Ｒａｎｄｏｍ　Ａｃｃｅｓｓ　Ｍｅｍｏｒｙ））を含む。また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体（ｔｒａｎｓｉｔｏｒｙ　ｃｏｍｐｕｔｅｒ　ｒｅａｄａｂｌｅ　ｍｅｄｉｕｍ）によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。
　次に、位置管理装置１００の動作の流れについて説明する。図８は、位置管理装置１００の動作の一例を示すフローチャートである。また、図９は、ペア選択部１２１の動作の一例を示すフローチャートである。以下、図８及び図９に沿って、位置管理装置１００の動作について説明する。
　位置管理装置１００は、周期的に、ステップＳ１０からステップＳ１５までの処理を繰り返す。換言すると、位置管理装置１００は、周期ｔ毎に、すなわち、単位時間毎に、以下の処理を繰り返す。
　ステップＳ１０において、センサ１１０が、点群データを取得する。
　次に、ステップＳ１１において、ペア選択部１２１が、最新の点群データと、１周期前に取得された点群データとの間で、座標のペアを選択する。
　次に、ステップＳ１２において、位置推定部１２２が、ステップＳ１１で選択されたペアの両座標を互いに対応させて位置合わせ処理を行い、航空機２００の位置を推定する。
　次に、ステップＳ１３において、経路判定部１２３は、航空機２００の今後の経路を予測し、予測された経路が適切であるか否かを判定する。経路が不適切である場合（ステップＳ１４でＮｏ）、処理はステップＳ１５へ移行する。これに対し、経路が適切である場合（ステップＳ１４でＹｅｓ）、ステップＳ１５はスキップされる。
　ステップＳ１５では、通知部１２４が、移動方向の変更を航空機２００に通知する。これに対し、航空機２００の飛行制御部２０１は、通知に基づいて移動方向を変更する。
　次に、ペア選択部１２１によるペアの選択（ステップＳ１１）について、具体的に説明する。ペア選択部１２１は、上述した通り、ｋ周期目に取得された点群データである第１の点群データと、ｋ－１周期目に取得された点群データである第２の点群データとの間で、点（座標）のペアを選択する。以下、ペア選択部１２１の処理の詳細について図９に沿って説明する。
　ステップＳ１１０において、ペア選択部１２１は、一方が第１の点であり、他方が第２の点であり、かつ、センサ１１０から見た両点の方向の差が所定の閾値Ｔｈ１（第１の閾値）以下である２つの点同士をペアの候補とする。ここで、第１の点とは、第１の点群データに属する点（座標）であり、第２の点とは、第２の点群データに属する点（座標）である。ペア選択部１２１は、この条件を満たす全ての２点をペアの候補とする。このため、同一の第１の点又は同一の第２の点に対し、複数のペアの候補が発生してもよい。例えば、ペアの候補として、（ｐ１，ｐ’１）、（ｐ１，ｐ’２）、（ｐ２，ｐ’２）などが発生してもよい。ここで、ｐ１及びｐ２はｋ周期目の点群データに属する点であり、ｐ’１及びｐ’２は（ｋ－１）周期目の点群データに属する点である。
　なお、センサ１１０が、各周期において、ビームの射出方向が同じである場合、センサ１１０から見た両点の方向の差がゼロである２点が存在しうる。しかし、センサ１１０が、図５に示したように、周期毎に、ビームの射出方向がずれる場合には、センサ１１０から見た両点の方向の差がゼロである２点は得られない。ペア選択部１２１は、方向の差が閾値Ｔｈ１以下であることを条件とすることで、近接した方向にある２点を抽出している。
　次に、ステップＳ１１１において、ペア選択部１２１は、ステップＳ１１０で抽出された全てのペアの候補について、２点の距離の差を算出する。すなわち、ペア選択部１２１は、各ペアの候補において、ペアを構成する一方の点のセンサ１１０からの距離と他方の点のセンサ１１０からの距離の差を算出する。
　次に、ステップＳ１１２において、ペア選択部１２１は、同一の点に対し、複数のペアの候補が発生している場合、ステップＳ１１１で算出した距離の差が最小であるもの以外をペアの候補から除外する。すなわち、ペア選択部１２１は、同一の点に対し、複数のペアの候補が発生している場合、距離の差が最小であるペアの候補のみを残す。上述した例では、点ｐ１に対し、（ｐ１，ｐ’１）、（ｐ１，ｐ’２）という２つのペアの候補が発生しているため、距離の差に基づいて、いずれかのペアの候補のみが残ることとなる。
　このようにペア選択部１２１は、同一の第１の点に対し、センサ１１０から見た方向の差が第１の閾値以下である第２の点が複数ある場合、第１の点のセンサ１１０からの距離と第２の点の前記センサ１１０からの距離の差が最小である第２の点をペアの候補とする。同様に、ペア選択部１２１は、同一の第２の点に対し、センサ１１０から見た方向の差が第１の閾値以下である第１の点が複数ある場合、第１の点のセンサ１１０からの距離と第２の点のセンサ１１０からの距離の差が最小である第１の点をペアの候補とする。このようにすることにより、同一の点に対するペアを高々１つにすることができるため、第１の点群データと第２の点群データの対応を適切に決定することができる。
　ところで、測定対象の物体の形状によっては、ビームの射出方向が少し異なるだけで測定される距離が大きく異なることがある。例えば、立体的な物体の形状の端の部分で、そのような事象が発生する。位置合わせ処理では、一方の点群データの点と他方の点群データの点とを近づけるようにパラメータの値が決定される。このため、距離が大きく異なる２点を位置合わせ処理に用いると、当該２点が位置合わせ結果に対し大きく影響を与えてしまうため、適切な位置合わせ結果が得られない恐れがある。そこで、本実施の形態では、適切な位置合わせ結果が得られるよう以下の処理を行なう。
　ステップＳ１１３において、ペア選択部１２１は、残っているペアの候補に対し、ステップＳ１１１において算出された距離の差が所定の閾値Ｔｈ２（第２の閾値）以下であるか否かを判定する。
　ペア選択部１２１は、所定の閾値Ｔｈ２を超えるペアの候補を除外し（ステップＳ１１５）、閾値Ｔｈ２以下であるペアの候補を正規のペアとする（ステップＳ１１４）。このようにして、ペア選択部１２１は、第１の点群データ及び第２の点群データから座標のペアを選択する。
　ペア選択部１２１は、ステップＳ１１３で得られた１以上の正規のペアを、位置推定部１２２に出力する。これに対し、図８のステップＳ１２において、位置推定部１２２は次のように位置合わせ処理を行なう。位置推定部１２２は、ｋ周期目に取得された点群データと、（ｋ－１）周期目に取得された点群データのうち、ペア選択部１２１により選択された正規のペアを構成する点の座標を用いて、これらの点が互いに近づくように位置合わせ処理を行なう。
　このように、ペア選択部１２１は、第１の点の方向と第２の点の方向との差が第１の閾値以下であり、かつ、第１の点の距離と第２の点の距離との差が第２の閾値以下である場合、これらの点をペアとすることにより、座標のペアを選択する。
　なお、上述したフローチャートでは、ステップ１１０において、ペア選択部１２１は、同一の点に対し、複数のペアの候補が発生することを許容したが、ペア選択部１２１は、複数のペアの候補が発生することを許容しなくてもよい。すなわち、同一の点に対し、最大で１個のペアの候補が発生するようにしてもよい。この場合、ペア選択部１２１は、例えば、ステップＳ１１０において、方向の差が所定の閾値Ｔｈ１以下である第１の点及び第２の点の組み合わせのうち、方向の差が最小である組み合わせのみをペアの候補とする。なお、この場合、同一の点に対し、複数のペアの候補は発生しないため、上述したステップＳ１１２の処理は省略される。
　また、上述したフローチャートでは、ステップＳ１１３において、距離の差に基づいて、ペアの候補を除外しているが、必ずしも、そのような除外が行なわれなくてもよい。すなわち、ステップＳ１１３が省略されてもよい。しかしながら、より精度良く位置合わせ処理を行なうためには、ステップＳ１１３の処理が行なわれることが好ましい。
　また、センサ１１０からビームは放射状に射出されるため、航空機２００がセンサ１１０から遠いほど、航空機２００に当たるビームの密度は低下する。すなわち、航空機２００がセンサ１１０に遠いほど、測定点の密度は下がる。このため、航空機２００が遠いほど、測定点の間隔も大きくなる。つまり、センサ１１０からどれだけ離れている航空機２００を測定するかによって、測定条件（航空機２００の表面上の測定間隔）が異なる。このため、ペアの妥当性を判定するための閾値である、距離の差についての閾値Ｔｈ２として、固定的な値を用いることは好ましくない。
　そこで、本実施の形態では、測定条件に応じた閾値を設定するために、ペア選択部１２１は、第１の点のセンサ１１０からの距離と第２の点のセンサ１１０からの距離との差についての統計値に基づいて閾値Ｔｈ２の値を設定する。具体的には、周期毎に、ステップＳ１１３において、ペア選択部１２１は、ステップＳ１１１で算出された距離の差の全てについての分布から標準偏差ｓを算出する。そして、ペア選択部１２１は、算出された標準偏差ｓと予め定められた係数αの積を閾値Ｔｈ２の値に設定する。係数αの値は、一定の値であり、例えば、所定の整数値である。本実施の形態では、このように、ペア選択部１２１は、周期毎に、閾値Ｔｈ２の値を算出するが、閾値Ｔｈ２として固定的な値、すなわち、一定値が用いられてもよい。
　図１０は、位置管理システム１０の挙動をシミュレーションした際の位置合わせ処理の精度を示すグラフである。このシミュレーションでは、航空機２００を模した３次元モデルを仮想空間内で飛行させるとともに、センサ１１０の測定動作をシミュレーションしている。そして、このシミュレーションにより得られる点群データに対し、上述したペアの選択処理、及び、位置合わせ処理を行なっている。横軸は、センサ１１０から航空機２００までの距離を示す。縦軸は、位置合わせ処理結果の誤差を示す。より詳細には、縦軸は、位置合わせ結果として得られたパラメータを用いて位置合わせ対象の一方の点群データを変換して得られる点群データと、位置合わせ対象の他方の点群データとの座標の誤差の平均を示している。なお、図１０に示した例では、航空機２００が毎秒５メートルでセンサ１１０に近づき、センサ１１０が５０ミリ秒毎の周期で点群データを取得している。図１０に示されるように、本シミュレーションによれば、距離が８０メートル付近で、平均誤差が１０センチメートル未満という高い精度で位置合わせが行なわれている。
　以上、実施の形態１について説明した。航空機２００の位置を適切に管理するためには、距離の測定周期（周期ｔ）は、短時間（例えば、５０ミリ秒程度）である必要がある。この場合、各周期における航空機２００に対する測定点の数が限られてしまう。すなわち、得られる、ある時点における航空機２００に対応する点群データのデータ数（点数）が限られてしまう。このため、単純に、既存の位置合わせ処理のアルゴリズムを用いた場合、十分な精度の位置合わせ結果が得られない恐れがある。これに対し、本実施の形態では、ペア選択部１２１により、近づけるべき点のペアを指定した上で、位置合わせ処理が行なわれるため、少ないデータ数であっても、精度よく位置合わせ処理が行なわれる。このため、航空機２００の位置を適切に管理することができる。特に、本実施形態によれば、航空機２００に目印を設けることなく、航空機２００の位置を把握することができる。
＜実施形態２＞
　次に、実施形態２について説明する。本実施形態では、位置管理装置は、複数の航空機２００の位置を適切に管理する。本実施の形態における位置管理システムは、位置管理装置１００が位置管理装置１０１に置き換わった点で、実施形態１にかかる位置管理システム１０と異なる。
　図１１は、実施形態２にかかる位置管理装置１０１の構成の一例を示す模式図である。位置管理装置１０１は、制御部１２０がクラスタリング部１２５をさらに有する点で、実施形態１の位置管理装置１００と異なっている。以下の説明では、実施形態１と重複する説明は適宜省略する。
　クラスタリング部１２５は、周期毎に、センサ１１０から得られた点群データに対しクラスタリング処理をしてクラスタを生成する。なお、クラスタリング部１２５は、公知の任意のクラスタリングアルゴリズム（例えば、ユークリッドクラスタリング）を用いてクラスタを生成する。これにより、航空機２００毎の点群データのクラスタが得られる。
　本実施の形態では、ペア選択部１２１は、クラスタ毎に、ペアの選択処理を行なう。また、本実施形態では、位置推定部１２２は、クラスタ毎に、位置合わせ処理及び位置の推定を行なう。すなわち、位置推定部１２２は、クラスタ毎に第１の点群データと第２の点群データとの位置合わせ処理を行なうことにより、各航空機２００の位置を推定する。これにより、航空機２００毎の位置を管理することができる。
　また、本実施形態では、ペア選択部１２１は、クラスタ毎に、第１の点のセンサ１１０からの距離と第２の点のセンサ１１０からの距離との差についての統計値（標準偏差ｓ）に基づいて閾値Ｔｈ２の値を設定する。つまり、標準偏差ｓが、クラスタ毎に算出され、クラスタ毎に、閾値Ｔｈ２の値が設定される。このように、ペア選択部１２１は、３次元空間に存在する全ての点群データの分布から統計値を算出するのではなく、クラスタ毎の点群データの分布から統計値を算出する。このため、閾値Ｔｈ２の値を適切に設定することができる。
　図１２は、位置管理装置１０１の動作の一例を示すフローチャートである。図１２に示したフローチャートは、ステップＳ１０とステップＳ１１の間にステップＳ２０が追加されている点で、図８に示したフローチャートと異なる。位置管理装置１０１は、周期的に、図１２で示したステップの処理を繰り返す。換言すると、位置管理装置１００は、周期ｔ毎に、すなわち、単位時間毎に、図１２で示したステップの処理を繰り返す。
　図１２に示すように、本実施形態では、ステップＳ１０の後、処理は、ステップＳ２０へ移行する。ステップＳ２０では、クラスタリング部１２５が、クラスタリング処理行い、点群データのクラスタを生成する。ステップＳ２０の後、処理はステップＳ１１へ移行する。以降、実施形態１と同様の処理が行なわれる。ただし、上述した通り、ペア選択部１２１は、クラスタ毎に、ペアの選択及び閾値Ｔｈ２の値を設定し、位置推定部１２２は、クラスタ毎に位置合わせ処理を実行する。
　以上、実施の形態を参照して本願発明を説明したが、本願発明は上記によって限定されるものではない。本願発明の構成や詳細には、発明のスコープ内で当業者が理解し得る様々な変更をすることができる。
　上記の実施形態の一部又は全部は、以下の付記のようにも記載され得るが、以下には限られない。
（付記１）
　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定手段と
　を有し、
　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
　位置管理装置。
（付記２）
　前記ペア選択手段は、前記第１の点の前記センサから見た方向と、前記第２の点の前記センサから見た方向との差が所定の第１の閾値以下であり、かつ、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離との差が所定の第２の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
　付記１に記載の位置管理装置。
（付記３）
　前記ペア選択手段は、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離との差についての統計値に基づいて前記第２の閾値の値を設定する
　付記２に記載の位置管理装置。
（付記４）
　前記点群データに対しクラスタリング処理をしてクラスタを生成するクラスタリング手段をさらに有し、
　前記位置推定手段は、前記クラスタ毎に前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なう
　付記１乃至３のいずれか１項に記載の位置管理装置。
（付記５）
　　前記点群データに対しクラスタリング処理をしてクラスタを生成するクラスタリング手段をさらに有し、
　前記ペア選択手段は、前記クラスタ毎に前記統計値に基づいて前記第２の閾値の値を設定し、
　前記位置推定手段は、前記クラスタ毎に前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なう
　付記３に記載の位置管理装置。
（付記６）
　前記ペア選択手段は、同一の前記第１の点に対し、前記センサから見た方向の差が前記第１の閾値以下である前記第２の点が複数ある場合、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離の差が最小である前記第２の点をペアの候補とし、同一の前記第２の点に対し、前記センサから見た方向の差が前記第１の閾値以下である前記第１の点が複数ある場合、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離の差が最小である前記第１の点をペアの候補とする
　付記１乃至５のいずれか１項に記載の位置管理装置。
（付記７）
　前記位置推定手段により推定された前記移動物体の位置の推移から予測される前記移動物体の経路が適切であるか否かを判定する経路判定手段
　をさらに有する付記１乃至６のいずれか１項に記載の位置管理装置。
（付記８）
　前記経路判定手段により前記移動物体の経路が適切でないと判定された場合、移動方向又は速度の変更を前記移動物体に通知する通知手段
　をさらに有する付記７に記載の位置管理装置。
（付記９）
　前記通知手段は、前記センサが距離を測定するために射出するビームが当たるように移動方向を前記移動物体に通知する
　付記８に記載の位置管理装置。
（付記１０）
　航空機と、位置管理装置とを備え、
　前記位置管理装置は、
　　前記航空機の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
　　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
　　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記航空機の位置を推定する位置推定手段と
　を有し、
　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
　位置管理システム。
（付記１１）
　前記位置管理装置は、
　　前記位置推定手段により推定された前記航空機の位置の推移から予測される前記航空機の経路が適切であるか否かを判定する経路判定手段と、
　　前記経路判定手段により前記航空機の経路が適切でないと判定された場合、移動方向又は速度の変更を前記航空機に通知する通知手段と
　をさらに有し、
　前記航空機は、前記通知手段からの通知に従って飛行を制御する飛行制御手段を有する
　付記１０に記載の位置管理システム。
（付記１２）
　移動物体の複数箇所の距離を単位時間毎にセンサにより測定し、
　前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得し、
　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択し、
　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定し、
　前記座標のペアの選択において、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
　位置管理方法。
（付記１３）
　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサによって第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択ステップと、
　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定ステップと
　をコンピュータに実行させ、
　前記ペア選択ステップでは、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
　プログラムが格納された非一時的なコンピュータ可読媒体。
１　　位置管理装置
２　　センサ
３　　ペア選択部
４　　位置推定部
１０　　位置管理システム
５０　　射出方向
５１　　射出範囲
５２　　ビーム
５３　　走査軌道
５４　　走査軌道
５５　　ビーム
１００　　位置管理装置
１０１　　位置管理装置
１１０　　センサ
１２０　　制御部
１２１　　ペア選択部
１２２　　位置推定部
１２３　　経路判定部
１２４　　通知部
１２５　　クラスタリング部
１５０　　ネットワークインタフェース
１５１　　メモリ
１５２　　プロセッサ
２００　　航空機
２０１　　飛行制御部

Claims (13)

  1. 　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
    　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
    　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定手段と
    　を有し、
    　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
    　位置管理装置。
  2. 　前記ペア選択手段は、前記第１の点の前記センサから見た方向と、前記第２の点の前記センサから見た方向との差が所定の第１の閾値以下であり、かつ、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離との差が所定の第２の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
    　請求項１に記載の位置管理装置。
  3. 　前記ペア選択手段は、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離との差についての統計値に基づいて前記第２の閾値の値を設定する
    　請求項２に記載の位置管理装置。
  4. 　前記点群データに対しクラスタリング処理をしてクラスタを生成するクラスタリング手段をさらに有し、
    　前記位置推定手段は、前記クラスタ毎に前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なう
    　請求項１乃至３のいずれか１項に記載の位置管理装置。
  5. 　　前記点群データに対しクラスタリング処理をしてクラスタを生成するクラスタリング手段をさらに有し、
    　前記ペア選択手段は、前記クラスタ毎に前記統計値に基づいて前記第２の閾値の値を設定し、
    　前記位置推定手段は、前記クラスタ毎に前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なう
    　請求項３に記載の位置管理装置。
  6. 　前記ペア選択手段は、同一の前記第１の点に対し、前記センサから見た方向の差が前記第１の閾値以下である前記第２の点が複数ある場合、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離の差が最小である前記第２の点をペアの候補とし、同一の前記第２の点に対し、前記センサから見た方向の差が前記第１の閾値以下である前記第１の点が複数ある場合、前記第１の点の前記センサからの距離と前記第２の点の前記センサからの距離の差が最小である前記第１の点をペアの候補とする
    　請求項１乃至５のいずれか１項に記載の位置管理装置。
  7. 　前記位置推定手段により推定された前記移動物体の位置の推移から予測される前記移動物体の経路が適切であるか否かを判定する経路判定手段
    　をさらに有する請求項１乃至６のいずれか１項に記載の位置管理装置。
  8. 　前記経路判定手段により前記移動物体の経路が適切でないと判定された場合、移動方向又は速度の変更を前記移動物体に通知する通知手段
    　をさらに有する請求項７に記載の位置管理装置。
  9. 　前記通知手段は、前記センサが距離を測定するために射出するビームが当たるように移動方向を前記移動物体に通知する
    　請求項８に記載の位置管理装置。
  10. 　航空機と、位置管理装置とを備え、
    　前記位置管理装置は、
    　　前記航空機の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサと、
    　　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択手段と、
    　　前記ペア選択手段により選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記航空機の位置を推定する位置推定手段と
    　を有し、
    　前記ペア選択手段は、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
    　位置管理システム。
  11. 　前記位置管理装置は、
    　　前記位置推定手段により推定された前記航空機の位置の推移から予測される前記航空機の経路が適切であるか否かを判定する経路判定手段と、
    　　前記経路判定手段により前記航空機の経路が適切でないと判定された場合、移動方向又は速度の変更を前記航空機に通知する通知手段と
    　をさらに有し、
    　前記航空機は、前記通知手段からの通知に従って飛行を制御する飛行制御手段を有する
    　請求項１０に記載の位置管理システム。
  12. 　移動物体の複数箇所の距離を単位時間毎にセンサにより測定し、
    　前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得し、
    　第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択し、
    　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定し、
    　前記座標のペアの選択において、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
    　位置管理方法。
  13. 　移動物体の複数箇所の距離を単位時間毎に測定し、前記複数箇所の空間上の座標を表わす点群データを前記単位時間毎に取得するセンサによって第１の時点で取得された前記点群データである第１の点群データと、前記第１の時点よりも前記単位時間だけ前である第２の時点で取得された前記点群データである第２の点群データとの間で、前記座標のペアを選択するペア選択ステップと、
    　選択されたペアの両座標を互いに対応させて、前記第１の点群データと前記第２の点群データとの位置合わせ処理を行なうことにより、前記移動物体の位置を推定する位置推定ステップと
    　をコンピュータに実行させ、
    　前記ペア選択ステップでは、前記第１の点群データに属する第１の点の前記センサから見た方向と、前記第２の点群データに属する第２の点の前記センサから見た方向との差が所定の第１の閾値以下である場合、前記第１の点と前記第２の点をペアとすることにより、前記座標のペアを選択する
    　プログラムが格納された非一時的なコンピュータ可読媒体。
PCT/JP2019/018474 2019-05-09 2019-05-09 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体 WO2020225894A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
PCT/JP2019/018474 WO2020225894A1 (ja) 2019-05-09 2019-05-09 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体
US17/606,803 US20220187455A1 (en) 2019-05-09 2019-05-09 Position management device, position management system, position management method and non-transitory computer-readable medium having program stored thereon
JP2021518268A JP7160187B2 (ja) 2019-05-09 2019-05-09 位置管理装置、位置管理方法及びプログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/018474 WO2020225894A1 (ja) 2019-05-09 2019-05-09 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体

Publications (1)

Publication Number Publication Date
WO2020225894A1 true WO2020225894A1 (ja) 2020-11-12

Family

ID=73051489

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/018474 WO2020225894A1 (ja) 2019-05-09 2019-05-09 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体

Country Status (3)

Country Link
US (1) US20220187455A1 (ja)
JP (1) JP7160187B2 (ja)
WO (1) WO2020225894A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023120430A1 (ja) * 2021-12-23 2023-06-29 パイオニア株式会社 情報処理装置、制御方法、プログラム及び記憶媒体

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017224123A (ja) * 2016-06-15 2017-12-21 日本電気株式会社 無人飛行装置制御システム、無人飛行装置制御方法および無人飛行装置
JP2018054380A (ja) * 2016-09-27 2018-04-05 株式会社トプコン レーザスキャナシステム及び点群データのレジストレーション方法
JP2019039868A (ja) * 2017-08-28 2019-03-14 株式会社トプコン 情報処理装置、情報処理方法および情報処理用プログラム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017224123A (ja) * 2016-06-15 2017-12-21 日本電気株式会社 無人飛行装置制御システム、無人飛行装置制御方法および無人飛行装置
JP2018054380A (ja) * 2016-09-27 2018-04-05 株式会社トプコン レーザスキャナシステム及び点群データのレジストレーション方法
JP2019039868A (ja) * 2017-08-28 2019-03-14 株式会社トプコン 情報処理装置、情報処理方法および情報処理用プログラム

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023120430A1 (ja) * 2021-12-23 2023-06-29 パイオニア株式会社 情報処理装置、制御方法、プログラム及び記憶媒体

Also Published As

Publication number Publication date
JPWO2020225894A1 (ja) 2020-11-12
US20220187455A1 (en) 2022-06-16
JP7160187B2 (ja) 2022-10-25

Similar Documents

Publication Publication Date Title
CN101430207B (zh) 使用结构光产生三维地图的设备和方法
KR102063534B1 (ko) 라이다를 이용한 지도 생성 방법
US10191496B2 (en) Unmanned aerial vehicle and a landing guidance method using the same
US10157468B2 (en) Object detection device, object detection method, and object detection system
Krajník et al. External localization system for mobile robotics
CN104484870B (zh) 校验飞机定位方法
CN110178046A (zh) 用于无人机的基于雷达的避障***和方法
CN110709791A (zh) 用于无人机的飞行高度调整、飞行控制的方法和装置
CN111801591A (zh) 一种用于校准光强度的***及方法
WO2020225894A1 (ja) 位置管理装置、位置管理システム、位置管理方法及びプログラムが格納された非一時的なコンピュータ可読媒体
AU2022259832A1 (en) Target detection in a point cloud
CN109145902A (zh) 一种利用泛化特征对几何标识进行识别及定位的方法
Sun et al. Aim: Acoustic inertial measurement for indoor drone localization and tracking
KR102014897B1 (ko) 항공측량을 위한 3차원 경로 비행 방법 및 장치
KR102349818B1 (ko) 개선된 cnn 기반으로 한 도로 균열 감지 자율 비행 드론
CN105865457B (zh) 一种基于文化算法的动态环境下航迹规划方法
CN114173281B (zh) 室内nlos环境下基于toa的定位***信标节点的优化布局方法
CN114371726B (zh) 无人机空地一体化探测定位方法、装置、***与设备
CN113504794B (zh) 一种无人机集群重构方法、***和电子设备
Lee et al. Real‐time collision‐free landing path planning for drone deliveries in urban environments
KR102172974B1 (ko) 레이더를 이용한 무인 비행체 식별 장치 및 그 방법
KR101642186B1 (ko) 위치 추적 방법, 위치 추적 시스템 및 이를 수행하기 위한 기록매체
CN113835101A (zh) 一种基于雷达点云的车辆定位方法、装置及存储介质
CN109001724B (zh) 一种目标自动起始航迹与跟踪定位方法
Li et al. Infrared camera array system for air robot autolanding without GPS

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19928199

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2021518268

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19928199

Country of ref document: EP

Kind code of ref document: A1