The present disclosure relates to a coordinate conversion, a coordinate conversion method, and a coordinate conversion program for converting a three-dimensional point cloud.
Communication services by electric signals and optical signals are provided by being connected to each other from a communication station to a building or a customer's house by physical equipment. Maintenance and management of facilities are essential to provide safe, secure, and stable services, and so far, an on-site worker has been visiting the site to visually check and inspect the condition of each piece of equipment individually. In recent years, the technology for determining the deterioration of utility poles using an MMS (Mobile Mapping System) has been developed, and efficient diagnosis of utility pole equipment has been realized (NPL 1). This technology involves mounting a three-dimensional laser scanner (three-dimensional laser surveying machine), a front camera, an omnidirectional camera, a GPS (Global Positioning System) receiver, an IMU (Inertial Measurement Unit), and an odometer (travel distance meter) in an inspection vehicle to perform three-dimensional laser scanning and image photographing during traveling of the inspection vehicle, thereby performing three-dimensional survey of a structure in a planar manner to acquire three-dimensional point cloud data having reflection intensity and absolute coordinates. The MMS is an effective means for acquiring three-dimensional point cloud data in diagnosing a plurality of utility poles along a road at once.
On the other hand, there is a fixed three-dimensional laser scanner as a means for acquiring three-dimensional point cloud data at a spot such as when the object to be measured is a single utility pole. A fixing base such as a tripod is fixed to the ground surface, and the three-dimensional laser scanner is installed on the fixing base to perform measurement. The three-dimensional laser scanner performs three-dimensional surveying of a structure by emitting a laser beam while rotating in both horizontal and vertical directions relative to the ground surface between 0° to 360°, to acquire three-dimensional point cloud data having reflection intensity and relative coordinates. The three-dimensional point cloud data are constituted of relative coordinates centered at the origin. In order to superimpose the acquired three-dimensional point cloud data on data acquired in absolute coordinates such as the MMS, it is necessary to convert the three-dimensional point cloud data acquired in relative coordinates into absolute coordinates.
Conversion from three-dimensional point cloud data in relative coordinates to three-dimensional point cloud data in absolute coordinates may be performed by measuring the three-dimensional laser scanner including the object to be measured at two measurement points, finding the points of contact of a circle having the distance from the measurement points to the object to be measured as its radius, and rotating the relative coordinates to match the absolute coordinates of the points of contact. However, when an error occurs in measuring the distance from the three-dimensional laser scanner to the utility pole, which is the object to be measured, a single contact point cannot be obtained, and the point cloud of relative coordinates cannot be converted to absolute coordinates.
Therefore, an object of the present disclosure is to enable superimposition of point cloud data in relative coordinates acquired by a three-dimensional laser scanner on point cloud data in absolute coordinates, even when errors occur in the distance measurement by the three-dimensional laser scanner.
The present disclosure performs three-dimensional laser scanner measurement including an object to be measured at two measurement points on a straight line passing through the object to be measured, obtains circles having the distance from the measurement points to the object to be measured as their radii respectively, and identifies the contact points of the obtained two circles by correcting the radius of at least one of the circles if the two circles are not tangent at a single point.
A coordinate conversion device and a coordinate conversion method of the present disclosure:
Specifically, a coordinate conversion program according to the present disclosure is a program for causing a computer to realize functional units of the device according to the present disclosure, and is a program for causing a computer to execute steps of a communication method executed by the device according to the present disclosure.
According to the present disclosure, superimposition of point cloud data in relative coordinates acquired by a three-dimensional laser scanner on point cloud data in absolute coordinates is made possible, even when errors occur in the distance measurement by the three-dimensional laser scanner.
Embodiments of the present disclosure will be described in detail below with reference to the drawings. It is to be understood that the present disclosure is not limited to the embodiments described below. The embodiments are merely exemplary and the present disclosure can be implemented in various modified and improved modes based on knowledge of those skilled in the art. Constituent elements with the same reference signs in the present specification and in the drawings represent the same constituent elements.
Embodiments of the present disclosure will be described below.
The system of the present disclosure performs measurement by a three-dimensional laser scanner at two measurement points on a straight line passing through an object to be measured 16, including, as the measurement range, the object to be measured 16 that is to be digitized as three-dimensional point cloud data. Here, the object to be measured 16 is an arbitrary structure used in a communication system, such as a utility pole. The three-dimensional laser scanner 11 is a three-dimensional laser surveying machine, and acquires point cloud data in which the object to be measured 16 existing in a three-dimensional space is represented by a point cloud. When the three-dimensional laser scanner 11 rotates in a horizontal direction, point cloud data of relative coordinates with the installation position of the three-dimensional laser scanner 11 as an origin is acquired.
In the present embodiment, the three-dimensional laser scanner 11 fixed to a tripod acquires point cloud data of relative coordinates with the relative coordinate origin 12 as an origin at the first measurement position 15, and stores the point cloud data in the storage unit 111. The three-dimensional laser scanner 11′ fixed to a tripod acquires point cloud data of relative coordinates with a relative coordinate origin 12′ as an origin at the second measurement position 15′, and stores the point cloud data in the storage unit 112. The relative coordinate origins 12 and 12′ are positioned on the straight line passing through the object to be measured 16. The point cloud data of the relative coordinates acquired at the first measurement position 15 is referred to as first point cloud data. The point cloud data of the relative coordinates acquired at the second measurement position 15′ is referred to as second point cloud data.
The system of the present disclosure measures absolute coordinates of the origins of point cloud data acquired at the two measurement points. For example, at the first measurement position 15, the GNSS surveying instrument 13 measures the origin absolute coordinate 14 of the three-dimensional laser scanner 11 and stores it in a storage unit 111. At the second measurement position 15′, the GNSS surveying instrument 13 measures the origin absolute coordinate 14′ of the three-dimensional laser scanner 11′ and stores it in the storage unit 112. The origin absolute coordinate 14 measured at the first measurement position 15 is referred to as a first origin. The origin absolute coordinate 14′ measured at the second measurement position 15′ is referred to as a second origin.
The coordinate conversion device 100 includes the storage units 111 and 112 and an arithmetic processing unit 113. The storage unit 111 stores point cloud data (relative coordinates) acquired by the three-dimensional laser scanner 11 and the origin absolute coordinate 14. The storage unit 112 stores point cloud data (relative coordinates) acquired by the three-dimensional laser scanner 11′ and the origin absolute coordinate 14′.
The coordinate conversion device 100 can also be implemented by a computer and a program, and the program can be recorded on a recording medium or provided through a network.
The origin coordinate conversion processing unit #1 converts the coordinates of the first point cloud data into relative coordinates having the absolute coordinates of the first origin at the origin. Specifically, the whole point cloud of the first point cloud data is moved in parallel so that the origin absolute coordinate 14 is the center, and the origin coordinate is converted. Here, the first point cloud data after the origin coordinate conversion indicates the same coordinate information as the origin absolute coordinate 14. The measured object center coordinate arithmetic unit #1 specifies absolute coordinates of the center of the object to be measured 16, which is a first reference point, on the basis of the first point cloud data subjected to coordinate conversion. Here, although the present embodiment describes an example in which the reference point of the object to be measured 16 is the center of the object to be measured 16, but the reference point of the object to be measured 16 is not limited to the center of the object to be measured 16; the reference point can be an arbitrary reference point capable of specifying the position of the object to be measured 16, such as a point on the circumference of the object to be measured 16.
The radius arithmetic unit #1 calculates the distance between the origin absolute coordinate 14 and the absolute coordinate of the center of the object to be measured 16. This distance is referred to as a first distance.
The origin coordinate conversion processing unit #2, the measured object center coordinate arithmetic unit #2, and the radius arithmetic unit #2 are configured to execute the same processing as that of the origin coordinate conversion processing unit #1, the measured object center coordinate arithmetic unit #1, and the radius arithmetic unit #1. Thus obtained absolute coordinate of the center of the object to be measured 16 is a second reference point, and the distance between the origin absolute coordinate 14′ and the absolute coordinate of the center of the object to be measured 16 is referred to as a second distance.
The circle contact point (circle intersection) arithmetic unit specifies the contact point between a first circle centered at the origin absolute coordinate 14 and having the first distance as its radius, and a second circle centered at the origin absolute coordinate 14′ and having the second distance as its radius. When no error occurs in the distance measurement by the three-dimensional laser scanner, these two circles are in contact with each other. However, if an error occurs in the distance measurement by the three-dimensional laser scanner, these two circles have two intersection points, or the two circles have no intersection points. In such a case, a circle contact (circle intersection) arithmetic unit corrects at least one of the first distance and the second distance, and specifies a contact point of the two circles.
The coordinate rotation arithmetic unit specifies a rotation angle for converting the first or second point cloud data into absolute coordinates on the basis of three points, i.e., the absolute coordinate of the specified contact point or intersection point, the origin absolute coordinate 14 or 14′, and the absolute coordinate of the center of the object to be measured 16 or 16′, to rotate the first point cloud data and the second point cloud data.
These two expressions, when taken as simultaneous expressions, yield the following expression.
This expression represents an expression of a straight line passing through the intersection point.
Here,
The expression (3) is represented by the following expression.
By substituting this expression (7) into the expression (1), a quadratic expression for x and a quadratic expression for y are obtained.
is obtained. The solutions of these two expressions are the x-coordinates and y-coordinates of the intersection and contact points.
From the expression (8), a discriminant D is expressed as follows.
The following description will be made by using this discriminant D in a case where two circles have an intersection point (when there are two solutions), a case where the circles have a contact point (when there is one solution), and a case where the circles have no intersection point (when there is no solution).
(i) When Two Circles have an Intersection Point (when there are Two Solutions)
In this case, the condition of the discriminant D is as follows.
From the expressions (8) and (9), using the formula for the solution of a quadratic expression, the following solution can be obtained.
(ii) When the Two Circles have a Contact Point (when there is One Solution)
In this case, the condition of the discriminant D is as follows.
From the expressions (8) and (9), using the formula for the solution of a quadratic expression, the following solution can be obtained.
(iii) When the Two Circles have No Intersection Point (when there is No Solution)
In this case, the condition of the discriminant D is as follows.
When this condition is satisfied, there is no solution satisfying the expressions (8) and (9).
Circle information is extracted from the three-dimensional coordinates of the point cloud data, to create a three-dimensional model of the utility pole by connecting circle models in a vertical direction. In order to avoid erroneous detection of a columnar object other than the utility pole, a column length and a diameter are designated in advance. The three-dimensional model matching the designated range is defined as the utility pole to be detected. The center axis is extracted by vertically connecting the center coordinates of the circular model comprising the utility pole model with a three-dimensional approximation curve. The lowest point of the center axis is used as the center coordinate (xcp1, ycp1, zcp1), that is, the measured object center relative coordinate 33. Similarly, a measured object center relative coordinate 36 is obtained from the point cloud data acquired with the origin coordinate 34 as the origin. A distance 32 between the origin coordinate 31 and the object to be measured is calculated from the origin coordinate 31 and the measured object center relative coordinate 33, a circle 301 having a radius of the distance 32 and centered on the origin coordinate 31, and a distance 35 between the origin coordinate 34 and the object to be measured is calculated from the origin coordinate 34 and the measured object center relative coordinate 36, and a measured object center absolute coordinate 310 is uniquely extracted from the intersection point of the two circles. The two circles have different radii, and the intersection point becomes unique by inscribed contact. The circles 301 and 302 are represented by the following expressions, respectively, as in
Here, the origin coordinate 31 is defined as (x1, y1), and the distance 32 is defined as r1. Similarly, the origin coordinate 34 is defined as (x2, y2), and the distance 35 is defined as r2. Considering that these two expressions are assumed to be simultaneous expressions and have contact points, the following expression can be obtained as in the description of
A coordinate rotation angle 38(θ) is derived from the contact point coordinate, the origin coordinate 31, and the measured object center relative coordinate 33, and the first point cloud data is subjected to coordinate rotation at the rotation angle, so that the first point cloud data made into absolute coordinates can be obtained. For example, when the center coordinates (x1, y1) of the circle 301 are regarded as the origin coordinate (0, 0) and the measured object center relative coordinate (xcp1, ycp1) and the measured object center absolute coordinate 310 (x, y) exist in a first quadrant, the coordinate rotation angle 38(θ) can be derived by the following expression.
Here, θ1 is the angle of the measured object center relative coordinate (xcp1, ycp1) viewed from the center coordinate (x1, y1) of the circle 301, and 82 is the angle of the measured object center absolute coordinates 310 (x, y) viewed from the center coordinate (x1, y1) of the circle 301. The first point cloud data of the relative coordinates are subjected to coordinate rotation by using the derived angle θ, so that the first point cloud data can be converted into absolute coordinates and superimposed on the point cloud data acquired by the MMS. The same applies to the second point cloud data.
Here, the origin coordinate 31 is defined as (x1, y1), and the distance 41 is defined as r3. Similarly, the origin coordinate 34 is defined as (x2, y2), and the distance 43 is defined as r4. Considering that these two expressions are assumed to be simultaneous expressions and the two circles have an intersection point, the following expression can be obtained as in the description of
The intersection coordinates 411 and 412 exist when the conditional expression (11) is satisfied, as described in
[Math. 32]
A specific method is described on the basis of
In actual calculation, it is not practical to adjust the values of r3 and r4 in a stepless manner, and therefore it is necessary to specify a certain width and adjust the values. For example, when the number of digits below the decimal point of the values of the distance 41 between the origin coordinate 31 and the object to be measured and the value of the distance 43 between the origin coordinate 34 and the object to be measured is six digits, the adjustment can be performed in consideration of the effective number by setting 1.0×10−7 as the adjustment width.
Instead of changing at least one of r3 and r4 until the two circles 401 and 402 have one contact point, a middle point obtained by simply averaging two intersection points may be used as the measured object center absolute coordinate 310 after the discriminant D is made to approach the threshold value or less. At this time, it is necessary to adjust the origin coordinate 31 (x1, y1) and the origin coordinate 34 (x2, y2) so as not to deviate from a straight line passing through the object to be measured 16.
Here, the origin coordinate 31 is defined as (x1, y1), and the distance 51 is defined as r5. Similarly, the origin coordinate 34 is defined as (x2, y2), and the distance 53 is defined as r6. When there is no contact point, the condition of the discriminant D is as follows, as in the description of
In order to accurately derive the center absolute coordinate of the object to be measured, it is desirable to obtain it from a contact point of the two circles. That is, the problem we want to solve is to specify the value satisfying the following [Math. 39] when D<0 (no contact point) is established.
A specifying method is described on the basis of
In actual calculation, it is not practical to adjust the values of r5 and r6 in a stepless manner, and therefore it is necessary to specify a certain width and adjust the values. For example, when the number of digits below the decimal point of the values of the distance 51 between the origin coordinate 31 and the object to be measured and the value of the distance 53 between the origin coordinate 34 and the object to be measured is six digits, the adjustment can be performed in consideration of the effective number by setting 1.0×10−7 as the adjustment width.
Therefore, if r8>r7, the distance 66 is expressed by the following expression.
When the two circles having a radius of r7<r8 are inscribed, the following conditions are satisfied between the distance 66 and the distance 63.
In order to accurately derive the center absolute coordinate of the object to be measured, it is desirable to obtain it from a contact point of the two circles. That is, this is when a conditional expression (46) is established. A method of deriving a radius satisfying the conditional expression (46) is described in two cases, that is, a case where the circles have an intersection point and a case where the circles do not have a contact point.
(i) When the Circles have an Intersection Point
When the two circles having a radius of r7<r8 have an intersection point, the following conditions are satisfied.
Therefore, by reducing r7 which is the distance 61 between the origin coordinate 31 and the object to be measured and increasing r8 which is the distance 63 between the origin coordinate 34 and the object to be measured, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
(ii) When the Circles have No Contact Point
When the two circles having a radius of r7<r8 have no contact point, the following conditions are satisfied.
Therefore, by increasing r7 which is the distance 61 between the origin coordinate 31 and the object to be measured and reducing r8 which is the distance 63 between the origin coordinate 34 and the object to be measured, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
Since it is not realistic to realize the conditional expression (46) in the actual calculation, in the case of the condition (i), a threshold value is provided, and after the value of the distance 66 and the value of the distance 63 are brought close to the threshold value or less, a middle point obtained by simply averaging the intersection points is taken as the measured object center absolute coordinate 310′. In the case of the condition (ii), it is necessary to perform the same processing as (i) after the r7 and r8 are adjusted to the condition where the circles have an intersection point.
The x-coordinates and y-coordinates of the intersection points are expressed by the following expressions as in
In order to accurately derive the center absolute coordinate of the object to be measured, it is desirable to obtain it from a contact point of the two circles. That is, this is when a conditional expression (49) is satisfied. However, based on the description of
Similar to
(i) When the Circles have an Intersection Point
When the two circles having a radius of r7<r8 have an intersection point, the condition of the discriminant D shown by an expression (53) is as follows, as in the description of
When r7 that is the distance 61 between the origin coordinate 31 and the object to be measured is reduced, r8 that is the distance 63 between the origin coordinate 34 and the object to be measured is increased, and the conditional expression (49) is satisfied, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling the adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
(ii) When the Circles have No Contact Point
When the two circles having a radius of r7<r8 have no contact point, the condition of the discriminant D shown by the expression (53) is as follows, as in the description of
When r7 that is the distance 61 between the origin coordinate 31 and the object to be measured is increased, r8 that is the distance 63 between the origin coordinate 34 and the object to be measured is reduced, and the conditional expression (49) is satisfied, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling the adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
Since it is not realistic to realize the conditional expression (49) in the actual calculation, in the case of the condition (i), a threshold value is provided, and after the distance 71 which is the x-coordinate difference of the intersection point and the distance 72 which is the y-coordinate distance are brought close to the threshold value or less, a middle point obtained by simply averaging the intersection point coordinates 711 and 712 is taken as the measured object center absolute coordinate 310′. In the case of the condition (ii), it is necessary to perform the same processing as (i) after the r7 and r8 are adjusted to the condition where the circles have an intersection point.
The x-coordinate and the y-coordinate of the intersection point are represented by five expressions (22), (23), (50), (51), Nd (52). In order to accurately derive the center absolute coordinate of the object to be measured, it is desirable to obtain it from a contact point of the two circles. That is, this is when a conditional expression (56) is established. However, based on the description of
(i) When the Circles have an Intersection Point
When the two circles having a radius of r7<r8 have an intersection point, the condition of the discriminant D shown by an expression (50) is as follows, as in the description of
When r7 that is the distance 61 between the origin coordinate 31 and the object to be measured is reduced, r8 that is the distance 63 between the origin coordinate 34 and the object to be measured is increased, and the conditional expression (56) is satisfied, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling the adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
(ii) When the Circles have No Contact Point
When the two circles having a radius of r7<r8 have no contact point, the condition of the discriminant D shown by the expression (53) is as follows, as in the description of
When r7 that is the distance 61 between the origin coordinate 31 and the object to be measured is increased, r8 that is the distance 63 between the origin coordinate 34 and the object to be measured is reduced, and the conditional expression (56) is satisfied, the two circles are inscribed. The values of r7 and r8 can be adjusted to an arbitrary value, enabling the adjustment of only r7 and only r8 and simultaneous adjustment of both r7 and r8.
Since it is not realistic to realize the conditional expression (56) in the actual calculation, in the case of the condition (i), a threshold is provided for the distance 81 between two intersection points, and after the distance 81 is brought close to 0 within the threshold value, a middle point obtained by simply averaging the intersection point coordinates 711 and 712 is taken as the measured object center absolute coordinate 310′. In the case of the condition (ii), it is necessary to perform the same processing as (i) after the r7 and r8 are adjusted to the condition where the circles have an intersection point.
It is considered that the coordinate conversion device, coordinate conversion method, and coordinate conversion program for a three-dimensional point cloud according to the present disclosure have the following advantages to the invention described in the prior application.
In the invention described in the previous application, the two circles whose radii are the origin absolute coordinate of the fixed three-dimensional laser scanner at two points and the distance from the origin coordinates at two points to the object to be measured are inscribed and the contact point is theoretically one, but in reality, due to errors in distance measurement, the two intersection points exist or there is no contact point, affecting the coordinate accuracy when the point cloud of relative coordinates acquired with the fixed three-dimensional laser scanner is converted to absolute coordinates. On the other hand, in the present disclosure, the point cloud of relative coordinates can be automatically and accurately converted into absolute coordinates by performing arithmetic processing in two cases, i.e., a case where two intersection points exist and a case where no contact point exists. Furthermore, by conversion into absolute coordinates, it is possible to correctly superimpose data on data of absolute coordinates acquired by the MMS or the like, and to display position information on a three-dimensional space.
The present disclosure is applicable to information and communication industries.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/004279 | 2/5/2021 | WO |