Measurement device, equipment distance measurement system, equipment distance measurement method, and measurement program

The system uses a measurement vehicle with a horizontal laser and correcting methods to accurately measure distances between facilities, addressing the inaccuracies of MMS in satellite-invisible conditions and improving safety and efficiency.

JP7595540B2Active Publication Date: 2024-12-06MITSUBISHI ELECTRIC CORP
View PDF 9 Cites 0 Cited by

Patent Information

Application Number
JP2021141287
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-08-31
Publication Date
2024-12-06
Estimated Expiration
2041-08-31

AI Technical Summary

Technical Problem

Existing methods for measuring distances between facilities, such as using measuring tapes or mobile mapping systems (MMS), fail to achieve accurate results when satellite visibility is limited.

Method used

A system and method utilizing a measurement vehicle equipped with a measurement unit, horizontal laser, and a measuring device that includes position and orientation calculation, horizontal point cloud generation, and inter-equipment distance calculation to correct and calculate distances between facilities using three-dimensional point groups.

Benefits of technology

Enables accurate measurement of distances between facilities, improving upon the limitations of MMS by ensuring high accuracy even in satellite-invisible conditions, enhancing safety and efficiency compared to manual tape measurements.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007595540000001
    Figure 0007595540000001
  • Figure 0007595540000002
    Figure 0007595540000002
  • Figure 0007595540000003
    Figure 0007595540000003
Patent Text Reader

Abstract

To enable a facility-to-facility distance to be calculated with high accuracy using a mobile mapping system.SOLUTION: A measurement device 200 generates position attitude data using measured data which is obtained by a measurement unit 110 which is installed to a measurement vehicle 101 having a measurement laser. The measurement device 200 generates horizontal point cloud data using the position attitude data and the horizontal laser data which is obtained by a horizontal laser 120 installed in the measurement vehicle 101. The measurement device 200 corrects the position attitude data on the basis of the horizontal point cloud data at each time of day. The measurement device 200 generates three-dimensional point cloud data using the corrected position attitude data and the measured laser data which is obtained by the measurement laser. Then the measurement device 200 calculates a facility-to-facility distance using the three-dimensional point cloud data.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present disclosure relates to a technique for measuring the distance between facilities. [Background technology]

[0002] In railways, it is necessary to accurately know the distances between facilities, for example, from signals to platforms, level crossings and points. Traditionally, the distance between facilities has been measured using a manual tape measure.

[0003] In recent years, there has been research into whether it is possible to reduce the labor required for measuring the distance between facilities by using a mobile mapping system (MMS) to generate point clouds and then measuring the distance between the point clouds. However, when using MMS, it has been confirmed that while sufficient distance accuracy can be obtained when the satellite is visible, the desired accuracy cannot be obtained when the satellite is not visible.

[0004] US Pat. No. 5,399,633 discloses an example of a vehicle for use in an MMS. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] JP 2012-242317 A Summary of the Invention [Problem to be solved by the invention]

[0006] An object of the present disclosure is to enable the facility-to-facility distance to be calculated with high accuracy using an MMS. [Means for solving the problem]

[0007] The measurement device of the present disclosure is a position and orientation calculation unit that generates position and orientation data indicating a measured position and measured orientation at each time using measurement data obtained by a measurement unit having a measurement laser and installed on the measurement vehicle; a horizontal point cloud calculation unit that generates horizontal point cloud data indicating the positions of each measurement point measured at each time by the horizontal laser using the position and orientation data and horizontal laser data obtained by a horizontal laser installed on the measurement vehicle together with the measurement unit; a position and orientation correction unit that corrects the position and orientation data based on the horizontal point cloud data at each time; a three-dimensional point cloud calculation unit that generates three-dimensional point cloud data indicating positions of each measurement point measured by the measurement laser, using the corrected position and orientation data and measurement laser data obtained by the measurement laser; The measurement device further includes an equipment distance calculation unit that calculates an equipment distance, which is the distance between equipment present in a measurement area, using the three-dimensional point cloud data. Effect of the Invention

[0008] According to the present disclosure, the facility-to-facility distance can be calculated with high accuracy using MMS. [Brief description of the drawings]

[0009] [Figure 1] FIG. 1 is a configuration diagram of a facility-to-facility distance measurement system 100 according to a first embodiment. [Diagram 2] FIG. 2 is a configuration diagram of a measurement vehicle 101 according to the first embodiment. [Diagram 3] FIG. 2 is a configuration diagram of a measurement device 200 according to the first embodiment. [Figure 4] 4 is a flowchart of a method for measuring the distance between facilities in the first embodiment. [Diagram 5] 4 is a flowchart of step S200 in the first embodiment. [Figure 6] FIG. 2 is a diagram for explaining the concept of correction in the first embodiment. [Figure 7] FIG. 2 is a diagram for explaining the concept of correction in the first embodiment. [Figure 8]FIG. 2 is a diagram for explaining the concept of correction in the first embodiment. [Figure 9] FIG. 2 is a diagram for explaining the concept of correction in the first embodiment. [Figure 10] 13 is a flowchart of step S240 in the first embodiment. [Figure 11] FIG. 1 shows three overhead poles 192 at different times in the first embodiment. [Figure 12] 13 is a flowchart of step S241 in the first embodiment. [Figure 13] FIG. 4 is a diagram showing a rotation angle θ in the first embodiment. [Figure 14] FIG. 4 is a diagram showing a movement amount M in the first embodiment. [Figure 15] FIG. 11 is a diagram showing how overhead poles 192 at different times overlap in the first embodiment. [Figure 16] 4A to 4C are diagrams showing how laser measurements are performed from different positions on a cylindrical overhead pole in the first embodiment. [Figure 17] FIG. 4 is a diagram showing the relationship between measurement positions and a horizontal point cloud 191 in the first embodiment. [Figure 18] 4A to 4C are diagrams showing how laser measurements are performed from different positions on a rectangular overhead pole in the first embodiment. [Figure 19] FIG. 4 is a diagram showing the relationship between measurement positions and a horizontal point cloud 191 in the first embodiment. [Figure 20] FIG. 4 is a diagram showing an example of alignment of a horizontal point group 191 according to the first embodiment. [Figure 21] 3 is a cross-sectional view of a wall inside a tunnel in the first embodiment. [Figure 22] 13 is a flowchart of step S241 in the first embodiment. [Diagram 23] FIG. 11 is a diagram showing how overhead poles 192 at different times overlap in the first embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0010] In the embodiments and drawings, the same or corresponding elements are denoted by the same reference numerals. Descriptions of elements denoted by the same reference numerals as those of the elements described above will be omitted or simplified as appropriate. Arrows in the drawings mainly indicate data flow or processing flow.

[0011] Embodiment 1 The inter-facility distance measurement system 100 will be described with reference to FIGS.

[0012] ***Outline of the First Embodiment*** An overview of the first embodiment will be described with reference to FIG. The facility-to-facility distance measurement system 100 is a system for measuring the distance between facilities. Specifically, the facility-to-facility distance measurement system 100 measures the distance between railway facilities. Specific examples of railway facilities include signals, platforms, railroad crossings, and points. However, the facility-to-facility distance measurement system 100 may also measure the distance between facilities other than railways. The facility distance measurement system 100 includes a measurement vehicle 101 and a measurement device 200 .

[0013] The measurement vehicle 101 is a vehicle for performing various measurements. A specific example of the vehicle is a road-rail vehicle. The measurement vehicle 101 includes a measurement unit 110 and a horizontal laser 120 .

[0014] The measurement unit 110 corresponds to a group of measurement devices mounted on a vehicle of a mobile mapping system (MMS), and includes various measurement devices. The horizontal laser 120 is a laser scanner installed on the measurement vehicle 101 so that a laser beam is irradiated horizontally toward the measurement vehicle 101. The horizontal laser 120 irradiates a laser beam in each direction in the horizontal direction, and measures the distance and direction to each measurement point in the horizontal direction. A measurement point is a point measured by laser measurement, that is, a point where a laser beam is irradiated and reflected.

[0015] The measurement device 200 calculates the measurement position and the measurement attitude at each time using the data obtained by the measurement unit 110, and corrects the measurement position and the measurement attitude at each time using the data obtained by the horizontal laser 120. Then, the measurement device 200 calculates the facility-to-facility distance based on the data obtained by the measurement unit 110, the corrected measurement position at each time, and the corrected measurement attitude at each time. The measurement position is the position of the measurement vehicle 101 when a measurement is performed using the measurement unit 110. The measurement attitude is the attitude of the measurement vehicle 101 when measurement is performed using the measurement unit 110.

[0016] The measurement device 200 may be provided separately from the measurement vehicle 101 or may be mounted on the measurement vehicle 101 .

[0017] ***Configuration Description*** The configuration of the measurement vehicle 101 will be described with reference to FIG. The measurement vehicle 101 includes a measurement unit 110 and a horizontal laser 120 . The measurement unit 110 includes a measurement laser 111, a receiver 112, an IMU 113, a camera 114, and an odometer 119. However, the camera 114 and the odometer 119 do not necessarily have to be included in the measurement unit 110. The measurement laser 111 is a laser scanner installed on the measurement vehicle 101 so as to irradiate laser light in three-dimensional directions. The three-dimensional direction means a direction shifted from the horizontal direction. However, the horizontal direction may be included in the three-dimensional direction. Specifically, the measurement unit 110 includes two measurement lasers 111. One measurement laser 111 is installed at the front so as to irradiate the laser light downward, and the other measurement laser 111 is installed in the center so as to irradiate the laser light upward. The measurement laser 111 irradiates laser light in each direction in the three-dimensional direction and measures the distance and direction to each measurement point. The receiver 112 is a receiver for a satellite positioning system. The satellite positioning system is also called a Global Navigation Satellite System (GNSS). A specific example is the Global Positioning System (GPS). The receiver 112 receives positioning signals transmitted from each of a plurality of positioning satellites and performs positioning. The IMU 113 is an inertial measurement unit that measures the acceleration and angular velocity of the measurement vehicle 101 . The camera 114 captures the surroundings of the measurement vehicle 101. For example, the measurement unit 110 includes two cameras 114. One camera 114 captures the left front of the measurement vehicle 101, and the other camera 114 captures the right front of the measurement vehicle 101. The odometer 119 measures the distance traveled by the measurement vehicle 101. For example, the odometer 119 is provided on the axle.

[0018] The configuration of the measuring device 200 will be described with reference to FIG. The measuring device 200 is a computer including hardware such as a processor 201, a memory 202, an auxiliary storage device 203, a communication device 204, and an input / output interface 205. These hardware components are connected to each other via signal lines.

[0019] The processor 201 is an IC that performs arithmetic processing and controls other hardware. For example, the processor 201 is a CPU. IC is an abbreviation for Integrated Circuit. CPU is an abbreviation for Central Processing Unit.

[0020] The memory 202 is a volatile or non-volatile storage device. The memory 202 is also called a primary storage device or a main memory. For example, the memory 202 is a RAM. Data stored in the memory 202 is saved in the secondary storage device 203 as necessary. RAM is an abbreviation for Random Access Memory.

[0021] The auxiliary storage device 203 is a non-volatile storage device. For example, the auxiliary storage device 203 is a ROM, a HDD, a flash memory, or a combination of these. Data stored in the auxiliary storage device 203 is loaded into the memory 202 as needed. ROM is an abbreviation for Read Only Memory. HDD is an abbreviation for Hard Disk Drive.

[0022] The communication device 204 is a receiver and a transmitter. For example, the communication device 204 is a communication chip or a NIC. The communication of the measurement device 200 is performed using the communication device 204. NIC is an abbreviation for Network Interface Card.

[0023] The input / output interface 205 is a port to which an input device and an output device are connected. For example, the input / output interface 205 is a USB terminal, the input device is a keyboard and a mouse, and the output device is a display. Input and output of the measurement device 200 is performed using the input / output interface 205. USB is an abbreviation for Universal Serial Bus.

[0024] The measurement device 200 includes elements such as a measurement data receiving unit 210, a position and orientation calculation unit 220, a horizontal point cloud calculation unit 230, a position and orientation correction unit 240, a three-dimensional point cloud calculation unit 250, an inter-facility distance calculation unit 260, and a distance data output unit 270. These elements are realized by software.

[0025] The auxiliary storage device 203 stores measurement programs for causing the computer to function as a measurement data receiving unit 210, a position and orientation calculation unit 220, a horizontal point cloud calculation unit 230, a position and orientation correction unit 240, a three-dimensional point cloud calculation unit 250, an inter-facility distance calculation unit 260, and a distance data output unit 270. The measurement programs are loaded into the memory 202 and executed by the processor 201. The auxiliary storage device 203 further stores an OS. At least a portion of the OS is loaded into the memory 202 and executed by the processor 201. The processor 201 executes the measurement program while executing the OS. OS is an abbreviation for Operating System.

[0026] Input and output data of the measurement program are stored in the storage unit 290 . The memory 202 functions as the storage unit 290. However, a storage device such as the auxiliary storage device 203, a register in the processor 201, or a cache memory in the processor 201 may function as the storage unit 290 instead of the memory 202 or together with the memory 202.

[0027] The measurement device 200 may include multiple processors instead of the processor 201 .

[0028] The measurement program can be recorded (stored) in a computer-readable manner on a non-volatile recording medium such as an optical disk or a flash memory.

[0029] ***Explanation of Operation*** The operation procedure of the facility-to-facility distance measurement system 100 corresponds to a facility-to-facility distance measurement method, and the operation procedure of the measurement device 200 corresponds to a processing procedure according to a measurement program. The following description will be given taking as an example a method for measuring the distance between facilities related to railways. A measuring vehicle 101 is a road-rail vehicle.

[0030] A method for measuring the distance between facilities will be described with reference to FIG. In step S100, the measurement vehicle 101 performs measurement in a measurement area. The measurement area is an area in which the facility-to-facility distance is measured. Specifically, a user drives the measurement vehicle 101, the measurement vehicle 101 travels along the track, and the measurement unit 110 and the horizontal laser 120 perform various measurements.

[0031] Data obtained by measurement using the measurement unit 110 is referred to as measurement data. The measurement data includes measurement laser data, positioning data, inertial measurement data, image data, and mileage data. The measurement laser data is data obtained by laser measurement using the measurement laser 111, and indicates the measurement distance and measurement direction for each measurement point at each time. The measurement distance is the distance from the measurement laser 111 to the measurement point. The measurement direction is the direction from the measurement laser 111 to the measurement point. The positioning data is data obtained by positioning using the receiver 112, and indicates the position (three-dimensional coordinate values) of the measurement vehicle 101 at each time. The inertial measurement data is data obtained by measurement using the IMU 113, and indicates the three-dimensional acceleration and three-dimensional angular velocity of the measurement vehicle 101 at each time. The image data is data obtained by photographing using a camera, and indicates an image at each time. Each image shows the surroundings of the measurement vehicle 101. The travel distance data is data obtained by measurement using the odometer 119, and indicates the travel distance of the measurement vehicle 101 at each time.

[0032] The data obtained by laser measurement using the horizontal laser 120 is referred to as horizontal laser data. The horizontal laser data indicates the measurement distance and measurement direction for each measurement point for each time. The measurement distance is the distance from the horizontal laser 120 to the measurement point. The measurement direction is the direction from the horizontal laser 120 to the measurement point.

[0033] In step S200, the measurement device 200 calculates the facility-to-facility distance based on the measurement data and the horizontal laser data.

[0034] The procedure of step S200 will be described with reference to FIG. In step S210, the measurement data receiving unit 210 receives the measurement data and the horizontal laser data.

[0035] In step S220, the position and orientation calculation unit 220 calculates the measured position at each time using the measurement data. The position and orientation calculation unit 220 may use the position of the measurement vehicle 101 at each time indicated in the positioning data as the measured position at each time, or may calculate the measured position at each time using inertial measurement data. Furthermore, the position and orientation calculation unit 220 may calculate the measured position at each time with higher accuracy by using the positioning data and the inertial measurement data. The method for calculating the measurement position is a conventional technique in MMS.

[0036] Furthermore, the position and orientation calculation unit 220 calculates the measured orientation at each time using the measurement data. The orientation is expressed by a roll angle, a pitch angle, and a yaw angle. Specifically, the position and orientation calculation unit 220 calculates the measured orientation at each time using the inertial measurement data. The method for calculating the measurement attitude is a conventional technique in MMS.

[0037] Then, the position and orientation calculation section 220 generates position and orientation data. The position and orientation data indicates the measurement position and the measurement orientation at each time.

[0038] In step S230, the horizontal point cloud calculation unit 230 calculates a horizontal point cloud at each time using the horizontal laser data and the position and orientation data. The horizontal point cloud is a three-dimensional point cloud calculated using horizontal laser data. The three-dimensional point cloud indicates the position (three-dimensional coordinate value) of each measurement point. Specifically, the horizontal point cloud calculation unit 230 adds the measurement orientation of the measurement point to the attitude of the measurement vehicle 101 to calculate the direction (relative direction) of the measurement point relative to the measurement vehicle 101. Then, the horizontal point cloud calculation unit 230 calculates the position of a point that is away from the position of the measurement vehicle 101 by the measurement distance in the relative direction. The calculated position is the position of the measurement point. The method of calculating the three-dimensional point cloud is a conventional technique in MMS.

[0039] Then, the horizontal point cloud calculation unit 230 generates horizontal point cloud data for each time. The horizontal point cloud data indicates a horizontal point cloud.

[0040] In step S240, the position and orientation correction unit 240 corrects the position and orientation data based on the horizontal point cloud data at each time. Step S240 will be described in detail later.

[0041] In step S250, the 3D point cloud calculation unit 250 calculates a 3D point cloud at each time using the measurement laser data and the corrected position and orientation data. The method of calculating the 3D point cloud is the same as the method of calculating the horizontal point cloud, and is a conventional technique in MMS. Then, the position and orientation correction unit 240 generates three-dimensional point group data. The three-dimensional point group indicates a group of three-dimensional points.

[0042] In step S260, the facility-to-facility distance calculation unit 260 calculates the facility-to-facility distance for each of the facilities that exist in the measurement area, using the three-dimensional point cloud data. Then, the inter-facility distance calculation unit 260 generates distance data. The distance data indicates the distance between facilities and the identifier of each facility.

[0043] Specifically, the distance between each piece of equipment is calculated as follows. First, the facility-to-facility distance calculation unit 260 extracts a three-dimensional point cloud of the facility from the three-dimensional point cloud data for each facility. For example, the facility-to-facility distance calculation unit 260 displays the three-dimensional point cloud shown in the three-dimensional point cloud data on a display. The user selects a three-dimensional point cloud of a facility from the displayed three-dimensional point cloud. Then, the facility-to-facility distance calculation unit 260 extracts the selected three-dimensional point cloud from the three-dimensional point cloud data. For example, equipment characteristic data is pre-stored in the storage unit 290. The equipment characteristic data indicates the characteristics (shape, size, etc.) of each piece of equipment. Then, the equipment distance calculation unit 260 extracts a three-dimensional point cloud that matches the equipment characteristics indicated in the equipment characteristic data from the three-dimensional point cloud data. Next, the facility-to-facility distance calculation unit 260 calculates the position of each facility based on the three-dimensional point cloud. For example, the facility distance calculation unit 260 calculates the center position of the three-dimensional point cloud. The calculated position is the facility position. Then, the inter-facility distance calculation unit 260 calculates the distance between each piece of equipment based on the position of each piece of equipment. The distance from one piece of equipment to the other piece of equipment is the inter-facility distance.

[0044] In step S270, the distance data output unit 270 outputs the distance data. For example, the distance data output unit 270 displays the distance data on a display.

[0045] ***Explanation of correction based on horizontal point cloud*** The concept of correction based on the horizontal point cloud will be described with reference to Fig. 6. Fig. 6 shows the measurement vehicle 101 and the reference object 190 as viewed from above. The reference object 190 is an object that is fixed in position and does not move. For the purpose of correction, the horizontal point cloud of the reference object 190 is referenced. A plurality of points arranged in a semicircle on the surface of the reference object 190 represents a horizontal point cloud of the reference object 190.

[0046] Assume that the measured position is calculated based on the distance traveled measured by an odometer. (1) If the mileage is correct, the horizontal point clouds of the reference object 190 at each time overlap. (2) However, if a traveled distance that is shorter than the actual distance is measured, the farther the reference object 190 is, the farther the horizontal point cloud will deviate from the correct position, and the closer the reference object 190 is, the closer the horizontal point cloud will be to the correct position. (3) Also, even if a traveled distance that is longer than the actual distance is measured, the horizontal point cloud will deviate farther from the correct position as the reference object 190 is farther away, and the horizontal point cloud will approach the correct position as the reference object 190 is closer. By correcting this deviation, the correct distance traveled can be obtained, i.e., the measurement position can be corrected.

[0047] The concept of correction will be further explained with reference to Figs. 7 shows a measurement vehicle 101 and a number of reference objects 190. Dotted or dashed lines drawn on the surface of each reference object 190 represent a horizontal point cloud. FIG. 8 shows the horizontal laser 120 and the horizontal point cloud 191 of each reference 190 at each time. The horizontal laser 120 performs one rotation at each time and performs laser measurement. The horizontal point cloud 191 is obtained for each rotation of the horizontal laser 120. For example, the horizontal laser 120 rotates once every 1 / 200 seconds or 1 / 100 seconds. Since the reference object 190 does not move, if the measurement position and measurement attitude at each time are correct, the horizontal point cloud 191 does not move even if the horizontal laser 120 moves. 8, the measurement position and the measurement attitude at each time are correct, so that the horizontal point cloud 191 at each time overlaps with each reference object 190. 9, the measurement position and the measurement attitude at each time are not correct. Therefore, the horizontal point clouds 191 at each time are shifted from each other for each reference object 190. However, the relative relationship of the horizontal point clouds 191 between the reference objects 190 at each time does not change. If the measurement position and measurement attitude at each time are corrected so that the horizontal point group 191 at each time overlaps with each reference object 190, the correct measurement position and correct measurement attitude at each time can be estimated. Furthermore, if the horizontal point cloud 191 at each time for each reference object 190 is misaligned with respect to each other, it can be noticed that the measurement position and the measurement attitude at each time are incorrect.

[0048] The procedure of the correction (step S240) will be described with reference to FIG. In step S241, the position and orientation correction unit 240 calculates the movement amount of the measurement position at each time and the rotation angle of the measurement orientation at each time using the horizontal point cloud data at each time. The amount of movement of the measurement position corresponds to an error in the measurement position, that is, a correction amount for the measurement position. The rotation angle of the measured attitude corresponds to the error of the measured attitude in the yaw direction, that is, the correction amount of the measured attitude. Specifically, the position and orientation correction unit 240 calculates a rotational movement amount and a translational movement amount that represent an error in the position of the reference object based on the horizontal point cloud data at the target time relative to the position of the reference object based on the horizontal point cloud data at the reference time. The calculated rotational movement amount is the rotation angle of the measured orientation at the target time, and the calculated translational movement amount is the movement amount of the measured position at the target time. Step S241 will be described later in detail.

[0049] In step S242, the position and orientation correction unit 240 corrects the position and orientation data using the movement amount of the measurement position at each time and the rotation angle of the measured orientation at each time. Specifically, the position and orientation correction unit 240 adds the amount of movement to the measured position and adds the angle of rotation to the measured orientation for each time point.

[0050] The calculation of the movement amount and rotation angle (step S241) will be described in detail below. An arbitrary time that serves as a reference for correction is called a reference time. The time to be corrected is called the target time. For example, the time immediately before the target time or the time immediately after the target time is the reference time.

[0051] Reference is now made to object 190. The reference 190 may be anything that is measured by the horizontal laser 120 , and two or more references 190 may be within the measurement range of the horizontal laser 120 . Electrified above-ground tracks have overhead poles spaced at 25 or 50 metre intervals. Therefore, in an electrified above-ground line, an overhead pole can be used as the reference object 190.

[0052] 11 shows the measurement vehicle 101 and three overhead poles 192 at the reference time T+1 and the target time T. The overhead poles 192 are represented by a horizontal point cloud 191. The overhead pole 192 at the reference time T+1 is assumed to be the correct overhead pole 192, and the overhead pole 192 at the target time T is assumed to be the overhead pole 192 to be corrected. In this case, the measurement position and the measurement attitude at the target time T are corrected so that the overhead pole 192 at the target time T overlaps with the overhead pole 192 at the reference time T+1. Incidentally, since the measurement posture at the target time T is incorrect, even if the three overhead poles 192 at the target time T are translated, the three overhead poles 192 at the target time T will not overlap with the three overhead poles 192 at the reference time T+1.

[0053] The procedure of step S241 will be described with reference to FIG. The position and orientation correction unit 240 executes steps S2411 to S2414 on the horizontal point cloud data at each time.

[0054] In step S2411, the position and orientation correction unit 240 uses the horizontal point cloud data at the reference time to calculate the positions of the two reference objects 190. Specifically, the position and orientation correction unit 240 calculates the position of each reference object 190 based on the horizontal point cloud of each reference object 190 included in the horizontal point cloud data at the reference time. Furthermore, the position and orientation correction unit 240 uses the horizontal point cloud data at the target time to calculate the positions of the two reference objects 190. Specifically, the position and orientation correction unit 240 calculates the position of each reference object 190 based on the horizontal point cloud of each reference object 190 included in the horizontal point cloud data at the target time. It should be noted that the two references 190 at the target time are the same as the two references 190 at the reference time. The horizontal point cloud for each reference 190 may be selected by a user or extracted based on the characteristics of the reference 190, similar to the 3D point cloud of the facility in step S260. Step S2411 will be described later in detail.

[0055] In step S2412, the position and orientation correction unit 240 calculates the rotation angle of the measured orientation at the target time based on the position of each reference object 190 at the base time and the position of each reference object 190 at the target time.

[0056] The rotation angle of the measurement attitude is calculated as follows. First, the position and orientation correction unit 240 calculates a straight line that passes through the positions of the two reference objects 190 at the reference time. Furthermore, the position and orientation correction unit 240 calculates a straight line that passes through the positions of the two reference objects 190 at the target time. Then, the position and orientation correction unit 240 calculates the angle formed by the two straight lines. The calculated angle is the rotation angle of the measurement attitude.

[0057] FIG. 13 shows the rotation angle θ of the measurement attitude. The rotation angle θ is the angle between the straight lines Ls and Lt. The straight line Ls is a straight line that passes through the positions of the two overhead poles 192 at the reference time T+1. The straight line Lt is a straight line that passes through the positions of the two overhead poles 192 at the target time T.

[0058] Returning to FIG. 12, the description will continue from step S2413. In step S2413, the position and orientation correction unit 240 corrects the position of each reference object 190 at the target time based on the rotation angle of the measured orientation. Specifically, the position and orientation correction unit 240 rotates and moves the position of each reference object 190 at the target time by the rotation angle of the measurement orientation, with the measurement position at the target time as the base point.

[0059] In FIG. 14, the position of each pole 192 at the target time T is corrected based on the rotation angle θ.

[0060] Returning to FIG. 12, step S2414 will be described. In step S2414, the position and orientation correction unit 240 calculates the amount of movement of the measurement position based on the position of the one reference object 190 at the reference time and the corrected position of the one reference object 190 at the target time. Note that the one reference object 190 at the reference time and the one reference object 190 at the target time are the same. Specifically, the position and orientation correction unit 240 calculates the difference between the position of the reference object 190 at the base time and the corrected position of the reference object 190 at the target time. The calculated difference is the movement amount of the measurement position.

[0061] FIG. 14 shows the movement amount M of the measurement position. The amount of movement M is the difference between the position of the overhead pole 192 at the target time T and the position of the overhead pole 192 at the reference time T+1.

[0062] 15, the three overhead poles 192 at the target time T are translated by a movement amount M. The three overhead poles 192 at the target time T overlap with the three overhead poles 192 at the reference time T+1.

[0063] The calculation of the position of the reference object 190 (step S2411) will be described in detail below using an overhead power pole as an example. There are two types of overhead poles: cylindrical and rectangular.

[0064] FIG. 16 shows how laser measurements are performed from different positions on a cylindrical overhead pole. It is not possible to perform laser measurement of the entire circumference of an overhead pole at once, and the part of the pole that is laser measured varies depending on the measurement position. The position and orientation correction unit 240 calculates the center of the overhead pole in the horizontal direction as the position of the overhead pole based on the horizontal point group 191 of the overhead pole.

[0065] A method for calculating the center of the pole will be described with reference to FIG. Laser measurements near the overhead pole yield a semicircular horizontal point cloud 191. First, the position and orientation correction unit 240 calculates the radius r of the overhead pole based on the semicircular horizontal point group 191. Next, the position and orientation correction unit 240 selects the closest measurement point to the measurement position from the horizontal point group 191, and calculates a vector from the measurement position to the selected measurement point. The length of the vector, that is, the length from the measurement position to the selected measurement point, is defined as "h". Then, the position and orientation correction unit 240 calculates a position that is a distance h+r away from the measurement position in the direction of the vector. The calculated position is the center of the pole.

[0066] Laser measurements far from the pole do not provide a semicircular horizontal point cloud 191. First, the position and orientation correction unit 240 calculates a vector from the measurement position point to the center of the line represented by the horizontal point group 191. The length of the vector is set to "L". Then, the position and attitude correction unit 240 calculates a position that is a distance h+r away from the measurement position in the vector direction by using the radius r calculated based on the horizontal point cloud 191 at another time. The calculated position is the center of the overhead pole.

[0067] FIG. 18 shows how laser measurements are performed from different positions on a rectangular overhead pole. It is not possible to perform laser measurement of the entire circumference of an overhead pole at once, and the part of the pole that is laser measured varies depending on the measurement position.

[0068] A method for calculating the center of the pole will be described with reference to FIG. First, the position and orientation correction unit 240 calculates the length of each side of the overhead pole based on the horizontal point cloud 191 of the overhead pole at one or more times. Then, the position and orientation correction unit 240 calculates the center of the pole based on the relationship between the measurement positions, the horizontal point group 191, and the lengths of the sides of the pole. Since the length of each side of the pole can be calculated, it is possible to predict the pole's center, although this is somewhat complicated. However, if the pole is not installed so that one side is parallel to the track, the calculation becomes more complicated.

[0069] FIG. 20 shows a horizontal point cloud 191 at a corner of a pole. The position and orientation correction unit 240 may calculate the corner of the rectangular pillar as the position of the overhead pole instead of the center of the rectangular pillar. The pole 192 at each time can be aligned with a corner of the pole as the base point.

[0070] *** Description of the Example *** A method for utilizing a reference object 190 in the tunnel will now be described. Reference is now made to object 190. A cross section of a side wall in a tunnel is shown in Figure 21. Within the tunnel there are panel joints 194 spaced at intervals of 10 meters or less. Panel joint 194 is a joint between concrete panels 193, exists in a recess between the panels, and has a width of about 5 centimeters and a depth of about 2 centimeters. In a tunnel, a panel joint 194 can be used as a reference 190. There only needs to be one panel joint 194 within the measurement range of the horizontal laser 120.

[0071] The procedure of step S240 is the same as that in FIG. However, the procedure of step S241 is different from the procedure in FIG.

[0072] The procedure of step S241 will be described with reference to FIG. The position and orientation correction unit 240 executes steps S2411 to S413 on the horizontal point cloud data at each time.

[0073] In step S2411, the position and orientation correction unit 240 calculates the rotation angle of the measured orientation based on the horizontal point cloud at the reference time and the horizontal point cloud at the target time.

[0074] The rotation angle of the measurement attitude is calculated as follows. First, the position and orientation correction unit 240 calculates a straight line representing the wall surface of the tunnel based on the horizontal point cloud of the horizontal point cloud data at the reference time. Furthermore, the position and orientation correction unit 240 calculates a straight line representing the wall surface of the tunnel based on the horizontal point cloud of the horizontal point cloud data at the target time. Then, the position and orientation correction unit 240 calculates the angle formed by the line of the reference time and the line of the target time. The calculated angle is the rotation angle of the measurement attitude.

[0075] In step S2412, the position and orientation correction unit 240 corrects the position of the reference object 190 at the target time based on the rotation angle of the measured orientation. Specifically, the position and orientation correction unit 240 rotates and moves the position of the reference object 190 at the target time by the rotation angle of the measured orientation, using the measured position at the target time as a base point.

[0076] In step S2413, the position and orientation correction unit 240 calculates the amount of movement of the measurement position based on the position of the reference object 190 at the base time and the corrected position of the reference object 190 at the target time. Specifically, the position and orientation correction unit 240 calculates the difference between the position of the reference object 190 at the base time and the corrected position of the reference object 190 at the target time. The calculated difference is the movement amount of the measurement position.

[0077] The position and orientation correction unit 240 may calculate the amount of movement separately in the travel direction and the transverse direction. In this case, the position and orientation correction unit 240 calculates the difference between the position of the reference object 190 at the reference time and the corrected position of the reference object 190 at the target time in the travel direction as the amount of movement. The position and orientation correction unit 240 also corrects the straight line at the target time based on the rotation angle of the measurement orientation, and calculates the difference between the straight line at the reference time and the corrected straight line at the target time in the transverse direction as the amount of movement. Then, the position and orientation correction unit 240 calculates the amount of movement of the measurement position by summing the amount of movement in the travel direction and the amount of movement in the transverse direction.

[0078] FIG. 23 shows how the position of panel seam 196 measured at different times overlaps due to rotational and translational movements. Concrete panel 195 is a concrete panel 193 represented by horizontal point cloud 191 . Panel seam 196 is panel seam 194 represented by horizontal point cloud 191 .

[0079] In FIG. 23(1), the straight line representing the concrete panel 195 at each target time is rotated by the rotation angle θ at each target time. 23(2), the panel joint 196 at each target time is translated by the movement amount M at each target time. The movement amount M can be expressed as the difference in the position of the panel joint 196 in the traveling direction and the difference in the position of the concrete panel 195 in the transverse direction. In FIG. 23(3), the panel seams 196 at each time point overlap due to rotational and translational movements. ***Features of the First Embodiment*** The first embodiment is characterized in that the measurement vehicle 101 is equipped with a horizontal laser 120. Conventionally, there is a technology called Simultaneous Localization and Mapping (SLAM). The horizontal point cloud overlap in the first embodiment is an application of SLAM. SLAM is a technology for simultaneous self-localization and mapping by moving objects, and is used in robots or self-driving cars. SLAM uses 3D lasers and 2D cameras to perform point cloud matching. On the other hand, the first embodiment uses the horizontal laser 120. This allows point cloud matching to be performed in two dimensions, reducing the amount of calculation.

[0080] SLAM calculates the self-location, but cannot correct errors in the self-location. On the other hand, the first embodiment can calculate the self-location and correct the error of the self-location. Therefore, a correct three-dimensional point cloud can be generated based on the correct self-location. Then, the correct three-dimensional point cloud can be used to calculate the accurate distance between the facilities.

[0081] ***Advantages of the First Embodiment*** According to the first embodiment, the distance between facilities can be measured more accurately. When a person measures using a tape measure, accurate measurement is possible, but it is costly and dangerous. When a three-dimensional point cloud generated by an MMS is used for measurement, safety can be ensured and efficiency and labor can be reduced. However, the accuracy of a three-dimensional point cloud obtained by measurement when the satellite is not visible is inferior to that of measurement using a tape measure. According to the first embodiment, the accuracy of the three-dimensional point cloud can be improved. As a result, the distance between facilities can be measured accurately without measuring using a tape measure.

[0082] ***Supplementary explanation of implementation form*** The first embodiment is an example of a preferred embodiment, and is not intended to limit the technical scope of the present disclosure. The first embodiment may be implemented partially or in combination with other embodiments. The procedure described using the flow chart, etc. may be modified as appropriate.

[0083] The "units" that are elements of the measurement device 200 may be realized by software, hardware, firmware, or a combination of these. The "unit" that is an element of the measuring device 200 may be read as a "process," a "step," a "circuit," or a "circuitry." [Explanation of symbols]

[0084] 100 Facility distance measurement system, 101 measurement vehicle, 110 measurement unit, 111 measurement laser, 112 receiver, 113 IMU, 114 camera, 119 odometer, 120 horizontal laser, 190 reference object, 191 horizontal point cloud, 192 overhead pole, 193 concrete panel, 194 panel joint, 195 concrete panel, 196 panel joint, 200 measurement device, 201 processor, 202 memory, 203 auxiliary storage device, 204 communication device, 205 input / output interface, 210 measurement data reception unit, 220 position and orientation calculation unit, 230 horizontal point cloud calculation unit, 240 position and orientation correction unit, 250 three-dimensional point cloud calculation unit, 260 facility distance calculation unit, 270 distance data output unit, 290 storage unit.

Claims

1. a position and orientation calculation unit that generates position and orientation data indicating a measured position and measured orientation at each time using measurement data obtained by a measurement unit having a measurement laser and installed on the measurement vehicle; a horizontal point cloud calculation unit that generates horizontal point cloud data indicating the positions of each measurement point measured at each time by the horizontal laser using the position and orientation data and horizontal laser data obtained by a horizontal laser installed on the measurement vehicle together with the measurement unit; a position and orientation correction unit that corrects the position and orientation data based on the horizontal point cloud data at each time; a three-dimensional point cloud calculation unit that generates three-dimensional point cloud data indicating positions of each measurement point measured by the measurement laser, using the corrected position and orientation data and measurement laser data obtained by the measurement laser; an equipment distance calculation unit that calculates an equipment distance, which is a distance between equipment present in a measurement area, by using the three-dimensional point cloud data; A measuring device comprising:

2. The position and orientation correction unit calculates a movement amount of the measurement position at each time and a rotation angle of the measurement orientation at each time using the horizontal point cloud data at each time, and corrects the position and orientation data using the movement amount of the measurement position at each time and the rotation angle of the measurement orientation at each time. The measurement device according to claim 1 .

3. The position and orientation correction unit calculates a rotational movement amount and a translational movement amount that represent an error in a position of the reference object based on the horizontal point cloud data at a target time relative to a position of the reference object based on the horizontal point cloud data at a reference time, as the rotation angle of the measured orientation at the target time and the movement amount of the measured position at the target time. The measurement device according to claim 2 .

4. a measurement vehicle on which a measurement unit having a measurement laser and a horizontal laser are installed; a measuring device that calculates a facility-to-facility distance, which is a distance between facilities present in a measurement area, using measurement data obtained by the measurement unit and horizontal laser data obtained by the horizontal laser; The measuring device includes: a position and orientation calculation unit that generates position and orientation data indicating a measured position and a measured orientation at each time using the measurement data; a horizontal point cloud calculation unit that generates horizontal point cloud data indicating positions of each measurement point measured by the horizontal laser at each time using the position and orientation data and the horizontal laser data; a position and orientation correction unit that corrects the position and orientation data based on the horizontal point cloud data at each time; a three-dimensional point cloud calculation unit that generates three-dimensional point cloud data indicating positions of each measurement point measured by the measurement laser, using the corrected position and orientation data and measurement laser data obtained by the measurement laser; an inter-facility distance calculation unit that calculates the inter-facility distance using the three-dimensional point cloud data; Equipped Equipment distance measurement system.

5. A measurement vehicle having a measurement unit with a measurement laser and a horizontal laser is installed to perform a measurement on the measurement area; generating position and orientation data indicating a measured position and a measured orientation at each time using the measurement data obtained by the measurement unit; generating horizontal point cloud data indicating positions of each measurement point measured by the horizontal laser at each time using the position and orientation data and horizontal laser data obtained by the horizontal laser; correcting the position and orientation data based on the horizontal point cloud data at each time; generating three-dimensional point cloud data indicating positions of each measurement point measured by the measurement laser using the corrected position and orientation data and measurement laser data obtained by the measurement laser; The three-dimensional point cloud data is used to calculate an inter-facility distance, which is a distance between the facilities present in the measurement area. How to measure the distance between facilities.

6. a position and orientation calculation unit that generates position and orientation data indicating a measured position and measured orientation at each time using measurement data obtained by a measurement unit having a measurement laser and installed on the measurement vehicle; a horizontal point cloud calculation unit that generates horizontal point cloud data indicating the positions of each measurement point measured at each time by the horizontal laser using the position and orientation data and horizontal laser data obtained by a horizontal laser installed on the measurement vehicle together with the measurement unit; a position and orientation correction unit that corrects the position and orientation data based on the horizontal point cloud data at each time; a three-dimensional point cloud calculation unit that generates three-dimensional point cloud data indicating positions of each measurement point measured by the measurement laser, using the corrected position and orientation data and measurement laser data obtained by the measurement laser; An equipment distance calculation unit that calculates an equipment distance, which is a distance between equipment present in a measurement area, using the three-dimensional point cloud data, A measurement program that makes a computer function.

Citation Information

Patent Citations

  • Method and apparatus for measuring isolation value of overhead line

    JP1994147844A

  • Automated guided vehicle

    JP1996166821A

  • Position measuring apparatus for mobile

    JP1999183174A

  • Position detecting facility for moving object

    JP2001074458A

  • Autonomous moving apparatus

    JP2010079869A