The present invention relates to a spatial coordinate positioning system, particularly to a spatial coordinate positioning system which is capable of measuring a position of spatial positioning target in high-precision by calculating spatial coordinates of assistant point stations at a predetermined interval on the basis of a coordinate of a ground base point station and distance information between the assistant point stations in a space where the plurality of assistant point stations are installed of which coordinates were unknown.
A satellite navigation system refers to a system that provides a user with user's current position and a route to a desired destination the user by using satellites. Global Positioning System (GPS) is the most prevalent Global Navigation Satellite System (GNSS) provided by the United States.
A typical use of such a satellite navigation system is Car Navigation system. The Car Navigation System refers to a system that identifies the current position of a vehicle to provide a driver with an optimal route to user's desired destination and guides the driver along the provided route. In general, such a Car Navigation System calculates the current position of a vehicle using a GPS sensor and performs route guidance from the current position to a destination.
Meanwhile, recently, an automated driving system for handling the whole task of driving has been developed. In the automated driving system, in order to prevent vehicle lane departure, the accuracy in measuring the position of a vehicle should be high within several centimeters. However, there is a drawback that position calculation errors of the GPS currently in use are high approximating several meters.
Further, since there are limitations on the lifespan and maintenance of satellites constituting the satellite navigation system, a complementary method is required therefor.
Accordingly, in the applicant's patent application No. KR 10-2016-0122139, disclosed is a high-precision spatial information measurement support system which is capable of measuring a position of a positioning target by using several ground base point stations and assistant point stations installed on the ground to increase position calculation accuracy compared to GPS.
However, when actually implementing the high-precise spatial information measurement support system of patent application No. KR 10-2016-0122139, there is a drawback in scalability that a number of ground base point stations at a predetermined interval should be installed within a distance that is capable of securing a visible distance from the national reference point of which spatial coordinates are known. That is, large cost, long-term construction and maintenance will be entailed when installing the ground base point stations at a predetermined interval nationwide, it is likely difficult to implement the aforementioned patent application practically.
The present invention is provided to solve the aforementioned drawbacks, and the object of this invention is to provide a system which is capable of ensuring scalability in the positioning area, reducing the installation cost and measuring high-precision spatial coordinates for the positioning target without long-term construction. Also, the system is capable of securing an efficient system management method
To this end, a spatial coordinate positioning system according to the present invention includes a ground base point station of which position information was already determined and which has a wireless distance measurement function, a plurality of assistant point stations which have a wireless distance measurement function, and an assistant point position calculation server which receives distance information between the ground base point station and the assistant point station, wireless distance information between the ground base point station and the assistant point station and wireless distance information between the assistant point stations at a predetermined time to calculate position information of the assistant point station at a predetermined time on the basis of the multiple distance information and the position information of the ground base point station.
Further, the ground base point station or the assistant point station according to the present invention may include, besides the wireless distance measurement function, a laser module which includes a light source emitting laser and a light receiving portion detecting reflected laser, a distance measurement portion which calculates ultra-precise distance information with other ground base point stations or assistant point stations on the basis of time information related to the emission and detection of laser, and a control portion.
Further, the assistant point station according to the present invention includes a wireless communication portion which transmits and receives a radio signal to and from other assistant point stations, transmits wireless distance information with other assistant point stations to the assistant point position calculation server and receives position information of the assistant point from the assistant point position calculation server, a distance measurement portion which calculates wireless distance information with the other assistant point stations, and a control portion which generates and transmits broadcast information composed of the position information and time information of the assistant point station to transmit the broadcast information through the wireless communication portion.
Further, a method for calculating position information of assistant point station according to the present invention calculates spatial coordinates of assistant point stations by an assistant point position calculation device of a spatial coordinate positing system composed of a ground base point station of which spatial coordinate was known and a plurality of assistant point stations of which spatial coordinates were not known, the method including steps of: receiving distance information between the ground base point station and a specific assistant point station, receiving wireless distance information between the plurality of assistant point stations, obtaining each equation with respect to the wireless distance information and generating a system of equations for the each equation and calculating spatial coordinates of the plurality of assistant point stations by solving the system of equations.
Further, the spatial coordinate position system according to the present invention includes a ground base point station of which position information was already determined and which has a wireless distance measurement function, a plurality of assistant point stations of which position information was not known but variable and which have a wireless distance measurement function and an assistant point position calculation server which receives distance information between the ground base point station and the assistant point station, wireless distance information between the ground base point station and the assistant point station and wireless distance information between the assistant point stations at a predetermined time and calculates position information of the assistant point station at a predetermined time, on the basis of the multiple distance information and the position information of the ground base point station.
Further, the spatial coordinate positioning system according to the present invention includes a ground base point station of which position information was already determined and which has a wireless distance measurement function and a plurality of assistant point stations of which position information was not known but variable and which has a wireless distance measurement function, the ground base point station receiving wireless distance information between the assistant point stations at a predetermined time and calculating position information of the assistant point station at a predetermined time, on the basis of the multiple distance information and its own position.
As aforementioned, the present invention has the effect of measuring a position of a positioning target in high-precision in the space where a plurality of assistant point stations of which inaccurate spatial coordinates of the initial installation stage may be variable is installed. That is, the present invention is capable of accurately calculating coordinates of the assistant point stations which may be variable differently from the initial installation position, at a predetermined time, on the basis of the spatial coordinate of the ground base point station which was already known, the distance information between the ground base point and the assistant point station and distance information between the assistant point and the assistant point station. Thereby, there is an effect of measuring the position of the positioning target existing on a positioning space in high-precision.
The accompanying drawings in the specification illustrate an embodiment of the present invention. The technical essence of the present invention will be more clearly understood from the following detailed description taken in conjunction with the accompanying drawings. Therefore, the present invention will not be interpreted to be limited to the drawings in which:
The terms or words used in the present specification and claims should not be construed as being limited to their usual or dictionary meanings but should be interpreted as a meaning and concept consistent with the technical idea of the present invention on the basis of principal that the inventor may appropriately define the concept of terms in order to describe his own invention in the best way.
Accordingly, the embodiments described in the present specification and the configurations shown in the drawings are only the most preferred embodiments but do not represent the whole technical sprit of the present invention. Thus, it should be understood that there may be various equivalents and modified embodiments which are capable of replacing them at the time of filing the present application.
Hereinafter, the embodiment of the present invention will be described in detail with reference to the accompanying drawings.
Prior to the description of each configuration of the spatial coordinate positioning system, position information means spatial coordinates (x, y, z) of each object, distance information means a distance between two objects and broadcast information means wireless data that includes position information and time information. The spatial coordinates and the position information may be often used interchangeably.
The ground base point station 100 may be installed spacing as far as possible under the condition that satisfies an environment in which a visible distance is securable, and the spatial coordinates are measured retroactively from the national reference point or defined as constant values which are not changed by the positioning system.
A wireless distance measurement function is a function of measuring a distance between two objects on the basis of a radio signal such as Wi-Fi, UWB, etc. to calculate wireless distance information (represented by dotted lines). Also, this is referred to an ultra-precise distance measurement function that measures a distance between two objects existing within the visible distance using laser to calculate an ultra-precise distance information (represented by a solid line).
The ground base point station 100 may transmit the ultra-precise measurement information using laser to the assistant point position calculation server 120 and may transmit wireless distance information with an adjacent assistant point station 110 to the assistant point position calculation server 120.
Further, the ground base point station 100 may collect wireless distance information from the plurality of assistant point stations 110 to transmit the collected wireless distance information to the assistant point position calculation server 120.
The assistant point station 110 may be installed at an interval of several tens of meters on the ground and has a wireless distance measurement function. A distance between two of the adjacent assistant point stations 110 may be measured through the wireless distance measurement function of the assistant point station 110. Further, an ultra-precise distance measurement function using laser may be added to the assistant point station in order to improve the position precision of an assistant point.
A spatial coordinate of the assistant point station 110 is not such a value defined at the installation stage like the ground base point station 100. The spatial coordinate of the assistant point station 110 is a value changeable over time differently from an initial installation position. In the present invention, the assistant point position calculation server 120 calculates the spatial coordinate of the assistant point station 110 in real-time, followed by calibration.
The spatial coordinate of the assistant point station 110 is updated by receiving the calculated spatial coordinate from the assistant point position calculation server 120 at a predetermined time. Accordingly, even if the position of the assistant point is changed by external environment such as vibration, draft, collision, etc. or intentionally changed for a special purpose, accurate position calculation of a moving object may be ensured by the spatial coordinate of the assistant point updated by the assistant point position calculation server.
Each of the assistant point stations 110 may transmit wireless distance information to the assistant point position calculation server 120. However, when the plurality of assistant point stations 110 are composed of a main assistant point station and a sub assistant point station, the main assistant point station may collect wireless distance information from the sub assistant point station to transmit the collected wireless information to the assistant point position calculation server 120.
The assistant point position calculation server 120 receives distance information from the ground base point station 100 and the assistant point station 110 and calculates spatial coordinates of each of the assistant point station 110 by using the spatial coordinate and distance information of the ground base point station 100. The assistant point position calculation server 120 provides the spatial coordinates of the assistant point stations 110 to the assistant point stations 110 at a predetermined interval.
The position calculation terminal 130 receives wireless information transmitted from the ground base point station 100 or the assistant point station 110 to calculate its own position information, alternatively receiving its own position information calculated in the ground base point or the assistant point.
The position calculation terminal 130 obtains a distance spaced apart from the ground base point station 100 or the assistant point station 110 to calculate the position information by fording out a point at which each sphere having the distance as a radius intersects.
The position calculation terminal 130 may be any type of apparatus or device provided that it has a function of transmitting and receiving a radio signal to and from the ground base point station 100 or the assistant point station 110 and of receiving broadcast information therefrom. For example, the position calculation terminal 130 may be a portable terminal such as a smartphone and may be mounted on various objects such as automobile, ships and drones, including people.
In
When the ground base point station 100 includes the function of calculating the position information of the assistant point station 110, the ground base point station 100 collects wireless distance information from the assistant point station 110 to calculate position information of each of the assistant point stations 110 on the basis of distance information between a specific assistant point and itself, wireless distance information collected from the each of the assistant point stations 110 and its own position information.
In
The ground point station 100 calculates super-precise distance information (represented by a solid line) with a specific assistant point station 110 through a laser distance measurement function and also calculates wireless distance information (represented by dotted lines) with the other assistant point stations 110 in the vicinity through a wireless distance measurement function.
The position information of each of the assistant point station 110 may be calculated by using the distance information and multiple wireless distance information calculated as the above as well as the spatial coordinate of the ground base point station 100 which was already known.
The spatial coordinates of the assistant point station 110 may be represented as (x, y, z). Since a height of the assistant point station 110, that is, the Z value is a value that is easily measurable by measuring a distance vertical from the ground when the assistant point station 110 is installed, the number of unknowns of the spatial coordinate of the assistant point station 110 may be reduced to two (x, y).
Accordingly, in the positioning cell configured by one of the ground base point station 100 and five of the assistant point stations 110 as shown in
When each of the assistant point stations 110 transmits broadcast information composed of its own position information, that is, spatial coordinate and time information to the vicinity at a predetermined interval, the position calculation terminal 130 existing in the positioning cell receives the broadcast information from the assistant point stations 110 in the vicinity and to secure its current position by using the received broadcast information.
The wireless communication portion 101 transmits and receives a radio signal to and from the assistant point stations 110 in the vicinity and transmits distant information with the assistant point stations 110 in the vicinity to the assistant point position calculation server 120. The wireless communication portion 101 may be configured as a short-range communication module such as Wi-Fi, ultra-wideband communication (UWB), etc.
Further, the wireless communication portion 101 receives wireless distance information from the assistant point station 110 to transmit the received wireless distance information to the assistant point position calculation server 120, alternatively to receive position information of the assistant point station 110 from the assistant point position calculation server 120, thereby transmitting the position information to the assistant point station 110.
The timer 102 is synchronized with time information of the assistant point station 110 to output a time clock signal. Time information of the timer 102 is necessary to calculate laser distance information and wireless distance information.
In
The distance measurement portion 104 calculates ultra-precise distance information with the ground base point or assistant point station 110 reflecting the laser by using time information related to the emission and detection of the laser.
The control portion 105 is a part that controls each configuration element of the ground base point station 100 overall. The control portion 105 according to the present invention receives time information from the synchronized timer 102 or the GPS receiver and controls driving of the laser module 103, allowing the laser distance information calculated in the distant measurement portion 104 to be transmitted to the assistant point position calculation server 120 through the wireless communication portion 101.
The assistant point station 110 includes a wireless communication 111, a timer 112, a distance measurement portion 113, a control portion 114, etc., similarly to the internal configuration of the ground base point station 100. The wireless communication portion 111 transmits and receives a radio signal to and from the ground base point station 100 and other assistant point stations 110, transmit wireless information with other assistant point stations to the assistant point position calculation server 120 and receive position information of the assistant point station from the assistant point position calculation server 120. The wireless communication portion 111 transmits broadcast information composed of the position information and time information of the assistant point station at a predetermined interval. Further, the wireless communication portion 111 may transmit wireless distance information to the ground base point station 100 or other assistant point stations 110.
The timer 112 is synchronized with the timer of the ground base point station 100 and other assistant point stations 110 to output a time clock signal. The assistant point station 110 may use time information generated in the GPS receiver instead of the internal timer 112.
The distance measurement portion 113 calculates wireless distance information with other assistant point stations on the basis of the radio signal and time information transmitted and received to and from the ground base point station 100 or other assistant point stations 110.
The control portion 114 is a part that controls each configuration element of the assistant point station 110 overall. The control portion 114 according to the present invention controls the wireless distance information calculated in the distance measurement portion 113 to be transmitted to the assistant point position calculation server 120 at a predetermined interval through the wireless communication portion 110 and generates broadcast information from the position information of the assistant point station 110 received through the wireless communication portion 111 and the time information received through the timer 112, allowing transmitting the generated broadcast information through the wireless communication portion 111 at a predetermined interval.
Next, in a distance information transmission step S20, the ground base point station 100 transmits the distance information to the assistant point position calculation server 120 and each of the assistant point stations 110 transmit the wireless distance information to the assistant point position calculation server 120.
According to another embodiment, the ground base point station 100 collects wireless distance information from the assistant point station 110 to transmit the collected distance information to the assistant point position calculation server 120.
Next, in a position information receiving step S30, each of the assistant point stations 110 receives its own position information from the assistant point position calculation server 120. According to another embodiment, each of the assistant point stations 110 may receive its own position information from the ground base point station 100.
Finally, in a broadcast information transmission step S40, each of the assistant point stations 110 transmits time information together with its own position information received at a predetermined interval.
When each of the assistant point stations 110 transmits the broadcast information composed of the position information and the time information, the position calculation terminal 130 may calculate its own position through one-way or two-way distance measurement technology.
Since the aforementioned distance measurement step S10, distance information transmission step S20, position information receiving step S30 and broadcast transmission step S40 are repeated at a predetermined interval to calibrate the position information of each of the assistant point stations 110 in real time, the position calculation terminal 130 may measure its own position accurately on the basis of the calibrated position information even if the external environment is changed.
In the embodiment detailed described above, the ground base point station has both wireless distance and laser distance measurement functions. In a case of the distance measurement way using laser or light, an error is within a few mm allowing very accurate measurement, while an error in a wireless measurement way is relatively large and increases as a mutual distance increases. Accordingly, as using the laser distance information of the ground base point station, it is capable of reduce error rates and calculating the position information of the assistant point station more accurately.
However, when more assistant point stations are installed by a narrowing installation interval even if installation costs increase, the laser distance information of the ground base point station may be omitted in the process of calculating the position information of the assistant point station.
L12=L21=√{square root over ((X1−X2)2+(Y1−Y2)2+(Z1−Z2)2)}
L13=L31=√{square root over ((X1−X3)2+(Y1−Y3)2+(Z1−Z3)2)}
L14=L41=√{square root over ((X1−X4)2+(Y1−Y4)2+(Z1−Z4)2)}
L15=L51=√{square root over ((X1−X5)2+(Y1−Y5)2+(Z1−Z5)2)}
L16=L61=√{square root over ((X1−X6)2+(Y1−Y6)2+(Z1−Z6)2)}
L17=L71=√{square root over ((X1−X7)2+(Y1−Y7)2+(Z1−Z7)2)}
L18=L81=√{square root over ((X1−X8)2+(Y1−Y8)2+(Z1−Z8)2)}
L23=L32=√{square root over ((X2−X3)2+(Y2−Y3)2+(Z2−Z3)2)}
L24=L42=√{square root over ((X2−X4)2+(Y2−Y4)2+(Z2−Z4)2)}
L25=L52=√{square root over ((X2−X5)2+(Y2−Y5)2+(Z2−Z5)2)}
L26=L62=√{square root over ((X2−X6)2+(Y2−Y6)2+(Z2−Z6)2)}
L27=L72=√{square root over ((X2−X7)2+(Y2−Y7)2+(Z2−Z7)2)}
L28=L82=√{square root over ((X2−X8)2+(Y2−Y8)2+(Z2−Z8)2)}
L34=L43=√{square root over ((X3−X4)2+(Y3−Y4)2+(Z3−Z4)2)}
L35=L53=√{square root over ((X3−X5)2+(Y3−Y5)2+(Z3−Z5)2)}
L37=L73=√{square root over ((X3−X7)2+(Y3−Y7)2+(Z3−Z7)2)}
L38=L83=√{square root over ((X3−X8)2+(Y3−Y8)2+(Z3−Z8)2)}
L45=L54=√{square root over ((X4−X5)2+(Y4−Y5)2+(Z4−Z5)2)}
L46−L64=√{square root over ((X4−X6)2+(Y4−Y6)2+(Z4−Z6)2)}
L47−L74=√{square root over ((X4−X7)2+(Y4−Y7)2+(Z4−Z7)2)}
L48−L84=√{square root over ((X4−X8)2+(Y4−Y8)2+(Z4−Z8)2)}
L56−L65=√{square root over ((X5−X6)2+(Y5−Y6)2+(Z5−Z6)2)}
L57−L75=√{square root over ((X5−X7)2+(Y5−Y7)2+(Z5−Z7)2)}
L58−L85=√{square root over ((X5−X8)2+(Y5−Y8)2+(Z5−Z8)2)}
L67−L76=√{square root over ((X6−X7)2+(Y6−Y7)2+(Z4−Z7)2)}
L68−L86=√{square root over ((X6−X8)2+(Y6−Y8)2+(Z4−Z8)2)}
L78−L87=√{square root over ((X7−X8)2+(Y7−Y8)2+(Z7−Z8)2)}
The 28 equations may be represented as follows.
Lij=Lji=√{square root over ((Xi−Xj)2+(Yi−Yj)2+(Zi−Zj)2)}
Wherein I, j=1, 2, . . . , M+N.
Further, the aforementioned apparatus and method are not limited to configurations and methods of the above-described embodiments. Alternatively, the embodiments may be configured by selectively combining the whole of the respective embodiments or a part thereof to allow various modifications.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/KR2019/004718 | 4/18/2019 | WO |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2020/213766 | 10/22/2020 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
20090237639 | Shinozaki | Sep 2009 | A1 |
Number | Date | Country |
---|---|---|
2009-103497 | May 2009 | JP |
10-2021-0021174 | Mar 2001 | KR |
10-2012-0074119 | Jul 2012 | KR |
10-2013-0115725 | Oct 2013 | KR |
10-1342215 | Dec 2013 | KR |
10-1874570 | Jul 2018 | KR |
10-2019-0109830 | Sep 2019 | KR |
Entry |
---|
International Search Report dated Jan. 17, 2020 for PCT/KR2019/004718. |
Number | Date | Country | |
---|---|---|---|
20220163618 A1 | May 2022 | US |