Position determination system and method
By using the vehicle-mounted unit and roadside unit system, the vehicle position is calculated based on the transmission time and altitude of the positioning signal, which solves the positioning problem when the GPS signal is weak, reduces measurement errors and time synchronization requirements, and achieves accurate positioning.
Patent Information
- Application Number
- CN202111116300.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-09-23
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2041-09-23
AI Technical Summary
Existing vehicle positioning methods rely on GPS signals, which makes it impossible to locate a vehicle in the absence of a signal or when the signal is weak. Furthermore, positioning via roadside units requires multiple base stations and high time synchronization accuracy, resulting in large measurement errors.
The system employing an onboard unit and at least two roadside units sends a positioning request signal when the global positioning signal is unavailable. The position of the onboard unit is calculated using the positioning signal transmission time fed back by the two roadside units, the roadside signal transmission time, the height of the roadside unit, and the distance to the target roadside unit.
It achieves accurate positioning even in situations with weak or no GPS signal, reduces measurement errors, and lowers the requirements for the number of roadside units and time synchronization accuracy.
Smart Images

Figure CN113866714B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of positioning technology, and in particular, to a position determination system and method. Background Art
[0002] With the development of science and technology and the improvement of living standards, more and more vehicles are entering people's lives. At the same time, it is becoming more and more important to locate and determine the position of vehicles. Existing positioning methods usually rely on GPS for positioning, and provide the position of the vehicle-mounted unit OBU through a high-precision global positioning system GPS module. When there is no GPS signal or the GPS signal is weak, the position of the vehicle-mounted OBU is lost, and the vehicle to everything (V2X) warning function cannot be realized. In addition, the cost of GPS modules is relatively high.
[0003] In a system using three base stations for positioning, the time between the three roadside units RSU base stations and the vehicle-mounted OBU must be accurately calibrated. When measuring, the three time differences of the vehicle-mounted OBU position positioning request signals (with OBU timestamps) received between the three RSU base stations must be combined with the known coordinates of the three RSU base stations in the spatial Cartesian coordinate system to solve the three-variable quadratic equation to obtain the coordinates of the OBU. In a system using four or more base stations for positioning, the time between the four RSU base stations must be accurately calibrated, while the vehicle-mounted OBU does not need to be accurately calibrated. When measuring, the three time differences of the vehicle-mounted OBU position positioning request signals (without timestamps) received between the four RSU base stations must be combined with the known coordinates of any three RSU base stations in the spatial Cartesian coordinate system to solve the three-variable quadratic equation to obtain the coordinates of the OBU.
[0004] Among the above methods of determining the OBU position, the GPS positioning method has a higher cost and cannot be used in places where the GPS signal is weak; when positioning through RSU, a large number of RSUs are required, and a large number of devices need to be synchronized, making accurate synchronization difficult; inaccurate coordinates of any base station have a greater impact on the results; and a longer measurement time is required, which makes it easier to introduce measurement errors. Summary of the invention
[0005] The present invention provides a position determination system and method to realize accurate positioning of a vehicle-mounted unit.
[0006] In a first aspect, an embodiment of the present invention provides a position determination system, the system comprising: an onboard unit and at least two roadside units;
[0007] The on-board unit is used to send a positioning request signal to each of the roadside units when the global positioning signal does not meet the preset conditions, and determine the location of the on-board unit itself according to the positioning signal transmission time feedback from the two roadside units on one side, the roadside signal transmission time, the roadside unit height and the distance to the target roadside unit;
[0008] Each of the roadside units is used to determine the transmission duration of the positioning signal based on the vehicle time information and signal information in the received positioning request signal combined with the roadside time information, and to determine the transmission duration of the roadside signal by sending a measurement signal to other roadside units.
[0009] In a second aspect, an embodiment of the present invention further provides a method for determining a position, which is executed by a vehicle-mounted unit described in any one of the embodiments of the present invention, and the method includes:
[0010] When the global positioning signal does not meet the preset conditions, a positioning request signal is sent to the roadside unit;
[0011] Receive the positioning signal transmission duration, roadside signal transmission duration, roadside unit height and target roadside unit distance fed back by each of the roadside units, wherein the positioning signal transmission duration is determined by each roadside unit according to the vehicle time information and signal information in the positioning request signal combined with the roadside time information, and the roadside signal transmission duration is determined by the roadside unit sending a measurement signal to other roadside units;
[0012] The location of the vehicle-mounted unit itself is determined according to the positioning signal transmission duration, roadside signal transmission duration, roadside unit height and target roadside unit distance fed back by the two roadside units on one side.
[0013] The embodiment of the present invention provides a position determination system and method, which includes a vehicle-mounted unit and at least two roadside units. The vehicle-mounted unit is used to send a positioning request signal to each of the roadside units when the global positioning signal does not meet the preset conditions, and determine the location of the vehicle-mounted unit itself according to the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by the two roadside units on one side; each of the roadside units is used to determine the positioning signal transmission time according to the vehicle-mounted time information and signal information in the received positioning request signal combined with the roadside time information, and determine the roadside signal transmission time by sending a measurement signal to other roadside units. The problem that the GPS signal is weak and cannot be positioned when the vehicle-mounted unit is positioned, and the problem that the number of roadside units is large and accurate timing is required when positioning by the roadside unit is solved. The location of the vehicle-mounted unit is calculated by the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by the two roadside units, which is not easy to introduce measurement errors, and accurate positioning of the vehicle-mounted unit is achieved. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] Figure 1 is a structural diagram of a position determination system in Embodiment 1 of the present invention;
[0015] Figure 2 is a structural diagram of a position determination system in Embodiment 2 of the present invention;
[0016] Figure 3 This is an example diagram of an implementation of calculating candidate coordinates in the second embodiment of the present invention;
[0017] Figure 4 This is a schematic diagram of the positions of a roadside unit and a vehicle-mounted unit in Embodiment 2 of the present invention;
[0018] Figure 5 It is a flow chart of a location determination method in Embodiment 3 of the present invention. DETAILED DESCRIPTION
[0019] In order to make the purpose, technical solutions and advantages of the present application clearer, the embodiments of the present application will be further described in detail below in conjunction with the accompanying drawings. It should be clear that the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present application.
[0020] When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with the present application. Instead, they are only examples of devices and methods consistent with some aspects of the present application as detailed in the attached claims.
[0021] In the description of the present application, it should be understood that the terms "first", "second", "third", etc. are only used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence, nor can they be understood as indicating or implying relative importance. For those of ordinary skill in the art, the specific meanings of the above terms in the present application can be understood according to the specific circumstances. In addition, in the description of the present application, unless otherwise specified, "multiple" refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can represent: A exists alone, A and B exist at the same time, and B exists alone. The character " / " generally indicates that the objects associated before and after are in an "or" relationship.
[0022] Embodiment 1
[0023] Figure 1A structural schematic diagram of a position determination system provided in Embodiment 1 of the present application is given. The system includes: an on-board unit 11 and at least two roadside units 12.
[0024] The vehicle-mounted unit 11 is used to send a positioning request signal to each roadside unit 12 when the global positioning signal does not meet the preset conditions, and determine the location of the vehicle-mounted unit 11 itself according to the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by two roadside units 12 on one side;
[0025] Each roadside unit 12 is used to determine the positioning signal transmission duration based on the vehicle time information and signal information in the received positioning request signal combined with the roadside time information, and to determine the roadside signal transmission duration by sending a measurement signal to other roadside units 12.
[0026] In this embodiment, the on-board unit 11 is an On Board Unit (OBU), and the roadside unit 12 is a Road Side Unit (RSU). The on-board unit 11 is a device that uses Dedicated Short Range Communication (DSRC) technology or C-V2X technology to communicate with the roadside unit 12. The on-board unit 11 is usually placed on the vehicle, and the roadside unit 12 is installed on the side of the road. The embodiment of the present application takes the on-board unit 11 installed on the vehicle as an example to illustrate the positioning process.
[0027] In this embodiment, the global positioning signal can be specifically understood as a global satellite positioning signal, such as a GPS signal, a Beidou satellite signal, a GLONASS signal, etc. The preset condition can be specifically understood as a pre-set condition, such as a minimum signal strength. The positioning request signal can be specifically understood as a communication signal requesting the positioning of the vehicle-mounted unit 11. The positioning signal transmission duration can be specifically understood as the time taken for the positioning request signal to be transmitted from the vehicle-mounted unit 11 to the roadside unit 12. The roadside signal transmission duration can be specifically understood as the time taken for the signal to be transmitted from one roadside unit 12 to another roadside unit 12. The roadside unit height can be specifically understood as the height of the roadside unit 12. The target roadside unit distance can be specifically understood as the distance between two roadside units 12 used when calculating the position of the vehicle-mounted unit 11.
[0028] Specifically, the vehicle-mounted unit 11 receives the global positioning signal for positioning, and receives the global positioning signal to determine whether the preset conditions are met. For example, if the signal strength of the global positioning signal is lower than a certain threshold, or the signal stability of the global positioning signal is poor, it can be considered that the preset conditions are not met. When the global positioning signal does not meet the preset conditions, a positioning request signal is generated and sent to the roadside unit 12. The positioning request signal should include relevant information about the signal sending time. The positioning signal transmission duration, roadside signal transmission duration, roadside unit height, and target roadside unit distance fed back by each roadside unit 12 are received, and two roadside units 12 on one side are selected from each roadside unit 12, for example, both roadside units 12 are on the right side of the vehicle. The signal transmission speed is determined according to the target roadside unit distance and the roadside signal transmission time. The projection distance between the roadside unit 12 and the vehicle-mounted unit 11 is calculated according to the transmission speed, the positioning signal transmission time and the roadside unit height. The two roadside units 12 are connected, and a plane rectangular coordinate system is established with the middle point as the origin. A circle is drawn according to the projection distance. The two roadside units 12 can draw two circles, and the intersection of the two circles is calculated. The position of the vehicle-mounted unit 11 is determined according to the coordinates of the intersection.
[0029] It should be noted that the location of the onboard unit 11 calculated in the embodiment of the present application is the relative position of the onboard unit 11, and the location of the onboard unit 11 in the global coordinate system can be determined based on the coordinates of a roadside unit 12 in the global positioning system.
[0030] In this embodiment, the on-board time information can be specifically understood as the time information involved when the on-board unit 11 sends a positioning request signal, such as the local time of the on-board unit 11 read and the time taken to read the local time. The signal information can be specifically understood as the basic signal information of the positioning request signal, such as the signal length and the signal baud rate. The roadside time information can be specifically understood as the local time information of the roadside unit 12, such as the local time at the reading moment and the time length from the frame end of the positioning request signal to the moment when the reading of the local time is completed. The measurement signal can be specifically understood as a signal used to measure the transmission time. In this application, in order to avoid introducing errors, the measurement signal used is of the same signal type as the positioning request signal.
[0031] Specifically, for each roadside unit 12, after receiving the positioning request signal, it is necessary to determine and feedback the positioning signal transmission time. The signal sending time is calculated based on the vehicle time information and signal information, the signal receiving time is calculated based on the roadside time information, and the positioning signal transmission time is determined based on the sending time and the receiving time.
[0032] At the same time, the roadside unit 12 also needs to send a measurement signal to other roadside units 12 to determine the roadside signal transmission time. Since the transmission time between two roadside units 12 only needs to be determined once, in order to reduce the amount of data processing, the roadside signal transmission time between the two roadside units 12 can be measured only once, that is, the roadside unit 12A as the sending end sends a measurement signal to the roadside unit 12B as the receiving end to obtain the roadside signal transmission time, and there is no need for the roadside unit 12B to send a measurement signal to the roadside unit 12A again. If the roadside unit 12A and the roadside unit 12B send measurement signals to each other to determine the transmission time of the two roadside signals, the roadside signal transmission time used for the final calculation can be determined based on the two roadside signal transmission time, for example, taking an average value, or selecting one as the roadside signal transmission time used for the final calculation based on factors such as signal stability and strength. The method of calculating the roadside signal transmission time based on the measurement signal is the same as the method of calculating the positioning signal transmission time using the positioning request signal.
[0033] The embodiment of the present invention provides a position determination system, which includes a vehicle-mounted unit and at least two roadside units. The vehicle-mounted unit is used to send a positioning request signal to each of the roadside units when the global positioning signal does not meet the preset conditions, and determine the location of the vehicle-mounted unit itself according to the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by the two roadside units on one side; each of the roadside units is used to determine the positioning signal transmission time according to the vehicle-mounted time information and signal information in the received positioning request signal combined with the roadside time information, and determine the roadside signal transmission time by sending a measurement signal to other roadside units. The problem that the GPS signal is weak and cannot be positioned when the vehicle-mounted unit is positioned, and the problem that the number of roadside units is large and accurate timing is required when positioning by the roadside unit is solved. The location of the vehicle-mounted unit is calculated by the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by the two roadside units, which is not easy to introduce measurement errors, and accurate positioning of the vehicle-mounted unit is achieved.
[0034] Embodiment 2
[0035] Figure 2 This is a schematic diagram of the structure of a position determination system provided in Embodiment 2 of the present invention. The technical solution of this embodiment is further refined on the basis of the above technical solution, such as Figure 2 As shown, the roadside unit 12 and the vehicle-mounted unit 11 are further refined:
[0036] The roadside unit 12 includes:
[0037] The sending time determination subunit 121 is used to parse the positioning request signal, determine the vehicle time information and signal information, determine the signal sending time point according to the vehicle time information, and determine the sending duration of the positioning request signal according to the signal information;
[0038] A receiving time determining subunit 122, configured to determine a signal receiving time point according to the acquired roadside time information;
[0039] The sending time point determination subunit 123 is used to add the signal sending time point and the sending duration to obtain a target sending time point;
[0040] The transmission duration determining subunit 124 is used to determine the positioning signal transmission duration by subtracting the target sending time point from the signal receiving time point.
[0041] In this embodiment, the sending time determining subunit 121 can be specifically understood as a data processing subunit in the roadside unit 12 for calculating the sending time of the positioning request signal. The signal sending time can be specifically understood as the sending time of the positioning request signal.
[0042] Specifically, the sending time determination subunit 121 parses the positioning request signal according to the communication protocol format of the positioning request signal, determines the vehicle time information carried in the positioning request signal, and the signal information of the positioning request signal, determines the signal sending time point according to the vehicle time information, and calculates the sending duration required to send the positioning request signal according to the signal information, that is, the time taken to send the first frame to the last frame of the positioning request signal.
[0043] In this embodiment, the receiving time determination subunit 122 can be specifically understood as a data processing subunit in the roadside unit 12 for determining the receiving time of the positioning request signal. The signal receiving time can be specifically understood as the time when the frame tail of the positioning request signal is received. After receiving the positioning request signal, the receiving time subunit 122 identifies the positioning request signal. When the positioning request signal is identified, the signal receiving time point is calculated according to the roadside time information recorded locally in the roadside unit.
[0044] In this embodiment, the sending time point determination subunit 123 can be specifically understood as a data processing subunit in the roadside unit 12 for calculating the time point of sending the positioning request signal. The target sending time point can be specifically understood as the time point when the positioning request signal is sent. The sending time point determination subunit 123 adds the signal sending time point and the sending duration, and the obtained time point is the target sending time point.
[0045] In this embodiment, the transmission duration determination subunit 124 can be specifically understood as a data processing subunit for calculating the transmission duration of the positioning signal in the roadside unit 12. The transmission duration determination subunit 124 obtains the transmission duration of the positioning signal by calculating the time difference between the signal reception time point and the target transmission time point.
[0046] As an optional embodiment of this embodiment, this optional embodiment further optimizes and includes that the vehicle-mounted time information at least includes the vehicle-mounted local time of the vehicle-mounted unit 11 at the time of reading, and the interval length from the time when the vehicle-mounted local time is read to the time when it is sent;
[0047] Accordingly, the sending time determining subunit 121 is specifically configured to:
[0048] Determine the sum of the vehicle-mounted local time and the interval duration as the signal sending time point;
[0049] The sending duration of the positioning request signal is determined according to the ratio of the signal length and the signal baud rate in the signal information.
[0050] Specifically, when the vehicle-mounted unit 11 sends a positioning request signal to the roadside unit 12, the vehicle-mounted time information is carried in the positioning request signal. The vehicle-mounted time information includes the vehicle-mounted local time T1 of the vehicle-mounted unit 11 at the time of reading, and the interval length t1 from the time when the vehicle-mounted local time T1 is read to the time of sending recorded by the internal high-precision timer. The sending time determination subunit 121 in the roadside unit 12 calculates the sum of the vehicle-mounted local time and the interval length, and determines the obtained time point as the signal sending time point. And parse the positioning request signal to determine the signal information. Calculate the ratio of the signal length Lb and the signal baud rate B in the signal information, and use the ratio as the sending duration of the positioning request signal.
[0051] Further, the receiving time determining subunit 122 is specifically configured to:
[0052] Acquire the roadside local time of the roadside unit 12 at the time of reading in the roadside time information, and the time length from the frame end of the positioning request signal to the time of completion of reading the roadside local time;
[0053] The difference between the roadside local time and the time length is determined as the signal reception time point.
[0054] In this embodiment, the roadside local time can be specifically understood as the local time of the roadside unit 12. After receiving the positioning request signal, the receiving time subunit 122 identifies the positioning request signal. After the identification is completed that it is a positioning request signal, the local high-precision timer of the roadside unit 12 is started, the roadside local time T2 is read, and the time length t2 from the end of the positioning request signal frame recorded by the high-precision timer to the completion time of reading the roadside local time T2 is read. After obtaining the roadside local time T2 and the time length t2, the difference between the roadside local time T2 and the time length t2 is calculated, and the obtained difference is determined as the signal reception time point.
[0055] It can be known that the calculated positioning signal transmission time △T1=T2-t2-Lb / B-(T1+t1). Different roadside units 12 are calculated in the same way. The positioning signal transmission time △T2=T3-t3-Lb / B-(T1+t1) of another roadside unit 12 is used as an example to illustrate the position determination process of the vehicle-mounted unit 11, where T3 is the roadside local time, and t3 is the time length from the recognition of the end of the positioning request signal frame to the completion of reading T3.
[0056] It should be noted that when the GPS signal is normal, the on-board unit and each roadside unit in the present application need to rely on the GPS signal to complete the precise time synchronization of the internal high-speed clock to ensure the accuracy of the time.
[0057] Furthermore, the vehicle-mounted unit 11 is also used to screen the roadside units 12 to obtain the roadside units 12 located on one side of the vehicle-mounted unit 11 .
[0058] Specifically, each roadside unit 12 can be marked in advance, that is, each roadside unit can be distinguished. Since the roadside unit usually does not change its position after installation, each roadside unit on one side can be determined in advance. Whether each roadside unit is on one side is determined according to the mark of the roadside unit.
[0059] It should be noted that when calculating the position of the vehicle-mounted unit 11, the two roadside units used in this application must be installed on one side of the road, not in the middle of the road. Preferably, they need to be installed on the outer side of the curve, and after the connecting line is projected onto the ground, the distance from the shoulder on that side shall not exceed one lane width.
[0060] Furthermore, the two roadside units 12 on one side are a first roadside unit 12A and a second roadside unit 12B. Accordingly, the vehicle-mounted unit 11 includes:
[0061] An acquisition subunit 111 is used to acquire the positioning signal transmission duration, roadside signal transmission duration, roadside unit height, and target roadside unit distance fed back by the first roadside unit 12A and the second roadside unit 12B on one side, wherein the positioning information transmission duration includes the first positioning signal transmission duration fed back by the first roadside unit 12A and the second positioning signal transmission duration fed back by the second roadside unit 12B, and the roadside unit height includes the first roadside unit height of the first roadside unit 12A and the second roadside unit height of the second roadside unit 12B;
[0062] The transmission speed determination subunit 112 is used to determine the signal transmission speed according to the ratio of the target roadside unit distance to the roadside signal transmission time;
[0063] A distance determination subunit 113, configured to determine a first distance and a second distance according to the signal transmission speed, a first positioning signal transmission duration, and a second positioning signal transmission duration;
[0064] A projection distance determination subunit 114, configured to determine a first projection distance and a second projection distance according to the first distance, the second distance, the first roadside unit height, and the second roadside unit height;
[0065] The position determination subunit 115 is used to determine the candidate coordinates according to the target roadside unit distance, the first projection distance and the second projection distance in combination with a predetermined coordinate calculation formula, and determine the location of the vehicle-mounted unit 11 itself according to each of the candidate coordinates.
[0066] In this embodiment, the acquisition subunit 111 can be specifically understood as a data processing subunit in the vehicle-mounted unit that acquires information such as distance and time. The acquisition subunit acquires the first positioning signal transmission duration and the first roadside unit height fed back by the first roadside unit 12A, and the second positioning signal transmission duration and the second roadside unit height fed back by the second roadside unit 12B, and acquires the roadside signal transmission duration and the target roadside unit distance at the same time. Since the roadside signal transmission duration and the target roadside unit distance between the first roadside unit 12A and the second roadside unit 12B only need to take one value, even if the first roadside unit 12A and the second roadside unit 12B both provide feedback, only one value is taken. Therefore, one of the first roadside unit 12A and the second roadside unit 12B can provide feedback, and when providing feedback, it is sufficient to identify which two roadside units the roadside signal transmission duration and the target roadside unit distance are between. The distances between the roadside units 12 are known in advance and can be stored according to the identification of the roadside unit 12.
[0067] In this embodiment, the transmission speed determination subunit 112 can be specifically understood as a data processing subunit that determines the signal transmission speed in the vehicle-mounted unit 11. The signal transmission speed can be specifically understood as the speed of signal transmission. The ratio of the target roadside unit distance to the roadside signal transmission time is calculated, and the ratio is determined as the signal transmission speed.
[0068] In this embodiment, the distance determination subunit 113 can be specifically understood as a data processing subunit in the vehicle-mounted unit 11 for calculating the distance between the vehicle-mounted unit 11 and the roadside unit 12. Under the condition that the signal transmission speed, the first positioning signal transmission time and the second positioning signal transmission time are known, the first distance and the second distance are calculated according to the calculation formula between speed, time and distance. Among them, the first distance is the distance between the first roadside unit 12A and the vehicle-mounted unit 11, and the second distance is the distance between the second roadside unit 12B and the vehicle-mounted unit 11.
[0069] In this embodiment, the projection distance determination subunit 114 can be specifically understood as a data processing subunit in the vehicle-mounted unit 11 that calculates the distance between the projection of the roadside unit 12 and the vehicle-mounted unit 11. The first projection distance is the distance between the first roadside unit 12A and the vehicle-mounted unit 11 after being vertically projected to the ground position; the second projection distance is the distance between the second roadside unit 12B and the vehicle-mounted unit 11 after being vertically projected to the ground position. The projection distance determination subunit 114 calculates the first projection distance according to the first distance, the height of the first roadside unit, and the triangle knowledge, and calculates the second projection distance according to the second distance, the height of the second roadside unit, and the triangle knowledge.
[0070] In this embodiment, the position determination subunit 115 can be specifically understood as a data processing subunit in the vehicle-mounted unit 11 for determining the position of the vehicle-mounted unit 11. The candidate coordinates can be specifically understood as candidate coordinates of the position coordinates of the vehicle-mounted unit 11.
[0071] Specifically, a coordinate system is established based on the plane (i.e., the ground) where the first roadside unit 12A, the second roadside unit 12B, and the vehicle-mounted unit are located, with the line between the first roadside unit 12A and the second roadside unit 12B as the X-axis, the midpoint of the line segment of the line as the origin, and the Y-axis direction pointing to the side where the road is located (given the relative positional relationship between the road and the roadside unit 12 and the vehicle-mounted unit 11, since the vehicle equipped with the vehicle-mounted unit 11 is always on the road, the Y-axis coordinate of the vehicle-mounted unit is always greater than 0). The vehicle-mounted unit 11 draws a circle with a radius of the first projection distance in the plane where the road surface is located with the first roadside unit 12A as the center, and draws a circle with a radius of the second projection distance in the plane where the road surface is located with the second roadside unit 12A as the center. The predetermined coordinate calculation formula is as follows:
[0072] (XL / 2) 2 +Y2 =L1 2 ;
[0073] (X+L / 2) 2 +Y 2 =L2 2 ;
[0074] Among them, (X, Y) is the candidate coordinate of the vehicle-mounted unit 11; L is the target roadside unit distance; L1 is the first projection distance; L2 is the second projection distance. By substituting the target roadside unit distance, the first projection distance and the second projection distance into the coordinate calculation formula, two sets of candidate coordinates (i.e., intersection coordinates) are obtained. By judging the positional relationship between the first roadside unit 12A and the second roadside unit 12B and the vehicle-mounted unit 11, i.e., the left side or the right side, the candidate coordinates are screened to obtain the location of the vehicle-mounted unit itself.
[0075] For example, Figure 3 FIG. 1 is an example diagram of an implementation of calculating candidate coordinates provided by an embodiment of the present invention. Figure 3 As shown, a coordinate system is established according to the projection point 12A' of the first roadside unit 12A, the projection point 12B' of the second roadside unit 12B and the plane where the vehicle-mounted unit is located, with the connecting line between the first roadside unit 12A and the second roadside unit 12B as the X-axis, the midpoint of the connecting line segment as the origin, the Y-axis direction points to the side where the road is located, and a circle is drawn according to the first projection distance and the second projection distance, with the projection point 12A' of the first roadside unit 12A and the projection point 12B' of the second roadside unit 12B being the two centers of the circle respectively.
[0076] Further, the distance determination subunit 113 is specifically configured to:
[0077] Determine a first distance between the first roadside unit and the vehicle-mounted unit according to the product of the signal transmission speed and the first positioning signal transmission time length;
[0078] The second distance between the second roadside unit and the vehicle-mounted unit is determined according to the product of the signal transmission speed and the second positioning signal transmission duration.
[0079] The projection distance determination subunit 114 is specifically used for:
[0080] Taking the difference between the square of the first distance and the square of the first roadside unit height as a first difference, and determining the square root of the first difference as a first projection distance;
[0081] A difference between the square of the second distance and the square of the second roadside unit height is taken as a second difference, and a square root of the second difference is determined as a second projection distance.
[0082] For example, Figure 4 A schematic diagram of the positions of a roadside unit and a vehicle-mounted unit provided in an embodiment of the present application. In which, h1 is the first roadside unit height of the first roadside unit 12A, l1 is the first distance, L1 is the first projection distance, and the projection of the first roadside unit 12A is 12A'. h2 is the second roadside unit height of the second roadside unit 12B, l2 is the second distance, L2 is the second projection distance, and the projection of the second roadside unit 12B is 12B'.
[0083] Calculated according to the Pythagorean theorem, the first projection distance L1 = SQRT(l1^2-h1^2); the second projection distance L2 = SQRT(l2^2-h2^2).
[0084] Furthermore, the location determination subunit 115 is specifically configured to:
[0085] The candidate coordinates are screened according to the relative position between the first roadside unit or the second roadside unit and the vehicle-mounted unit, the target coordinates are determined, and the position corresponding to the target coordinates is determined as the position of the vehicle-mounted unit itself.
[0086] In this embodiment, the target coordinates can be specifically understood as the position coordinates of the vehicle-mounted unit 11 relative to the roadside unit 12. Since the first roadside unit 12A and the second roadside unit 12B are on the same side of the vehicle-mounted unit 11, it is only necessary to know the relative position of the first roadside unit or the second roadside unit and the vehicle-mounted unit to achieve the screening of the candidate coordinates. The position of the roadside unit 12 relative to the vehicle is determined during the driving process of the vehicle. For example, when communicating with the first roadside unit or the second roadside unit, the image of the roadside unit 12 is collected by an image acquisition device, and the relative position of the roadside unit 12 and the vehicle-mounted unit 11 is determined by analyzing the image. If the roadside unit 12 is only installed on one side of the road, the relative position of the roadside unit 12 and the vehicle-mounted unit 11 can be directly determined. If the roadside unit 12 is installed on both sides of the road, the side of the road where the roadside unit 12 is located can be determined based on the identification of the first roadside unit 12A or the second roadside unit 12B, and then the driving direction of the vehicle can be determined based on the vehicle's driving trajectory, the destination displayed by the navigation, or historical GPS signals and other information, thereby determining the relative position of the first roadside unit 12A or the second roadside unit 12B and the vehicle-mounted unit 11. Based on the relative position, it is determined whether the road on which the vehicle is traveling is on the left or right side of the line connecting the first roadside unit 12A and the second roadside unit 12B, that is, whether the Y coordinate is positive or negative, thereby implementing the screening of the candidate coordinates and determining the target coordinates. The position corresponding to the target coordinates is determined as the location of the vehicle-mounted unit itself.
[0087] The embodiment of the present invention provides a position determination system, which solves the problem that the GPS signal is too weak to be positioned when the vehicle-mounted unit is positioned, and the problem that the number of roadside units is large and accurate timing is required when positioning through roadside units. The position of the vehicle-mounted unit is calculated by the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by two roadside units, which is not easy to introduce measurement errors, thereby achieving accurate positioning of the vehicle-mounted unit. The signal transmission speed is calculated by the target roadside unit distance and the roadside signal transmission time, avoiding the measurement error introduced by directly using the signal transmission speed. Less equipment is required for measurement, reducing the impact of time errors and inaccurate timing on the measurement results.
[0088] Embodiment 3
[0089] Figure 5 This is a flow chart of a location determination method provided in Embodiment 3 of the present invention. The method is executed by the vehicle-mounted unit provided in any embodiment of the present invention, and specifically includes:
[0090] S201. When the global positioning signal does not meet a preset condition, send a positioning request signal to a roadside unit.
[0091] S202, receiving the positioning signal transmission duration, roadside signal transmission duration, roadside unit height and target roadside unit distance fed back by each of the roadside units, wherein the positioning signal transmission duration is determined by each roadside unit based on the vehicle-mounted time information and signal information in the positioning request signal combined with the roadside time information, and the roadside signal transmission duration is determined by the roadside unit by sending a measurement signal to other roadside units.
[0092] S203, determining the location of the vehicle-mounted unit itself according to the positioning signal transmission duration, roadside signal transmission duration, roadside unit height, and target roadside unit distance fed back by the two roadside units on one side.
[0093] Furthermore, the method further includes: screening each of the roadside units to obtain each roadside unit located on one side of the vehicle-mounted unit.
[0094] Further, the two roadside units on one side are a first roadside unit and a second roadside unit. Accordingly, the location of the vehicle-mounted unit itself is determined according to the positioning signal transmission duration, the roadside signal transmission duration, the roadside unit height and the target roadside unit distance fed back by the two roadside units on one side, including:
[0095] Acquire the positioning signal transmission duration, roadside signal transmission duration, roadside unit height, and target roadside unit distance fed back by the first roadside unit and the second roadside unit on one side, wherein the positioning information transmission duration includes the first positioning signal transmission duration fed back by the first roadside unit and the second positioning signal transmission duration fed back by the second roadside unit, and the roadside unit height includes the first roadside unit height of the first roadside unit and the second roadside unit height of the second roadside unit;
[0096] Determine the signal transmission speed according to the ratio of the target roadside unit distance to the roadside signal transmission time;
[0097] Determine the first distance and the second distance according to the signal transmission speed, the first positioning signal transmission duration and the second positioning signal transmission duration;
[0098] Determine a first projection distance and a second projection distance according to the first distance, the second distance, the first roadside unit height, and the second roadside unit height;
[0099] The position determination subunit is used to determine the candidate coordinates according to the target roadside unit distance, the first projection distance and the second projection distance in combination with a predetermined coordinate calculation formula, and determine the location of the vehicle-mounted unit itself according to each of the candidate coordinates.
[0100] Further, determining the first distance and the second distance according to the signal transmission speed, the first positioning signal transmission duration, and the second positioning signal transmission duration includes:
[0101] Determine a first distance between the first roadside unit and the vehicle-mounted unit according to the product of the signal transmission speed and the first positioning signal transmission time length;
[0102] The second distance between the second roadside unit and the vehicle-mounted unit is determined according to the product of the signal transmission speed and the second positioning signal transmission duration.
[0103] Further, determining the first projection distance and the second projection distance according to the first distance, the second distance, the first roadside unit height, and the second roadside unit height includes:
[0104] Taking the difference between the square of the first distance and the square of the first roadside unit height as a first difference, and determining the square root of the first difference as a first projection distance;
[0105] A difference between the square of the second distance and the square of the second roadside unit height is taken as a second difference, and a square root of the second difference is determined as a second projection distance.
[0106] Further, determining the location of the vehicle-mounted unit itself according to each of the candidate coordinates includes:
[0107] The candidate coordinates are screened according to the relative position between the first roadside unit or the second roadside unit and the vehicle-mounted unit, the target coordinates are determined, and the position corresponding to the target coordinates is determined as the position of the vehicle-mounted unit itself.
[0108] The embodiment of the present invention provides a position determination method, which solves the problem that the GPS signal is too weak to be positioned when the vehicle-mounted unit is positioned, and the problem that the number of roadside units is large and accurate timing is required when positioning through roadside units. The position of the vehicle-mounted unit is calculated by the positioning signal transmission time, roadside signal transmission time, roadside unit height and target roadside unit distance fed back by two roadside units, which is not easy to introduce measurement errors, thereby achieving accurate positioning of the vehicle-mounted unit. The signal transmission speed is calculated by the target roadside unit distance and the roadside signal transmission time, avoiding the measurement error introduced by directly using the signal transmission speed. Less equipment is required for measurement, reducing the impact of time errors and inaccurate timing on the measurement results.
[0109] It is worth noting that in the embodiment of the above-mentioned position determination system, the various units and modules included are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be achieved; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of the present invention.
[0110] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A position determination system, characterized in that: include: On-board unit and at least two roadside units; The on-board unit is used to send a positioning request signal to each of the roadside units when the global positioning signal does not meet the preset conditions, and determine the location of the on-board unit itself according to the positioning signal transmission duration, roadside signal transmission duration, roadside unit height and target roadside unit distance fed back by two roadside units on one side, wherein the positioning signal transmission duration is the transmission duration of the positioning request signal between the on-board unit and the roadside unit, the roadside signal transmission duration is the transmission duration of the measurement signal between the roadside units, and the target roadside unit distance is the distance between the two roadside units; Each of the roadside units is used to determine the transmission duration of the positioning signal according to the vehicle time information and signal information in the received positioning request signal combined with the roadside time information, and to determine the transmission duration of the roadside signal by sending a measurement signal to other roadside units; The two roadside units on one side are a first roadside unit and a second roadside unit. Accordingly, the vehicle-mounted unit includes: an acquisition subunit, used for acquiring the positioning signal transmission duration, the roadside signal transmission duration, the roadside unit height and the target roadside unit distance fed back by the first roadside unit and the second roadside unit on one side, wherein the positioning signal transmission duration includes the first positioning signal transmission duration fed back by the first roadside unit and the second positioning signal transmission duration fed back by the second roadside unit, and the roadside unit height includes the first roadside unit height of the first roadside unit and the second roadside unit height of the second roadside unit; A transmission speed determination subunit, used to determine the signal transmission speed according to the ratio of the target roadside unit distance to the roadside signal transmission time; A distance determination subunit, configured to determine a first distance and a second distance according to the signal transmission speed, a first positioning signal transmission duration, and a second positioning signal transmission duration; The projection distance determination subunit is used to determine the first projection distance and the second projection distance according to the first distance, the second distance, the height of the first roadside unit and the second roadside unit, wherein the first projection distance is the distance between the first roadside unit and the vehicle-mounted unit after being vertically projected to the ground position, and the second projection distance is the distance between the second roadside unit and the vehicle-mounted unit after being vertically projected to the ground position; The position determination subunit is used to determine the candidate coordinates according to the target roadside unit distance, the first projection distance and the second projection distance in combination with a predetermined coordinate calculation formula, and determine the location of the vehicle-mounted unit itself according to each of the candidate coordinates.
2. The system according to claim 1, characterized in that The roadside unit comprises: a sending time determination subunit, configured to parse the positioning request signal, determine the vehicle time information and the signal information, determine the signal sending time point according to the vehicle time information, and determine the sending duration of the positioning request signal according to the signal information; A receiving time determination subunit, used to determine a signal receiving time point according to the acquired roadside time information; A sending time point determination subunit, used for adding the signal sending time point and the sending duration to obtain a target sending time point; The transmission duration determination subunit is used to determine the positioning signal transmission duration by subtracting the target sending time point from the signal receiving time point.
3. The system according to claim 2, characterized in that The vehicle-mounted time information at least includes the vehicle-mounted local time of the vehicle-mounted unit at the time of reading, and the interval between the time when the vehicle-mounted local time is read and the time when it is sent; Accordingly, the sending time determination subunit is specifically used for: Determine the sum of the vehicle-mounted local time and the interval duration as the signal sending time point; The sending duration of the positioning request signal is determined according to the ratio of the signal length and the signal baud rate in the signal information.
4. The system according to claim 2, characterized in that The receiving time determination subunit is specifically used for: Acquire the roadside local time of the roadside unit at the time of reading in the roadside time information, and the time length from the frame end of the positioning request signal to the time when the reading of the roadside local time is completed; The difference between the roadside local time and the time length is determined as the signal reception time point.
5. The system according to claim 1, characterized in that The vehicle-mounted unit is further used to screen the roadside units to obtain the roadside units located on one side of the vehicle-mounted unit.
6. The system according to claim 1, characterized in that The distance determination subunit is specifically used for: Determine a first distance between the first roadside unit and the vehicle-mounted unit according to the product of the signal transmission speed and the first positioning signal transmission time length; The second distance between the second roadside unit and the vehicle-mounted unit is determined according to the product of the signal transmission speed and the second positioning signal transmission duration.
7. The system according to claim 1, characterized in that The projection distance determination subunit is specifically used for: Taking the difference between the square of the first distance and the square of the first roadside unit height as a first difference, and determining the square root of the first difference as a first projection distance; A difference between the square of the second distance and the square of the second roadside unit height is taken as a second difference, and a square root of the second difference is determined as a second projection distance.
8. The system according to claim 1, characterized in that The position determination subunit is specifically used for: The candidate coordinates are screened according to the relative position between the first roadside unit or the second roadside unit and the vehicle-mounted unit, the target coordinates are determined, and the position corresponding to the target coordinates is determined as the position of the vehicle-mounted unit itself.
9. A method for determining a position, characterized in that: The method is performed by the vehicle-mounted unit according to any one of claims 1 to 8, comprising: When the global positioning signal does not meet the preset conditions, a positioning request signal is sent to the roadside unit; Receive the positioning signal transmission duration, roadside signal transmission duration, roadside unit height and target roadside unit distance fed back by each of the roadside units, wherein the positioning signal transmission duration is determined by each roadside unit according to the vehicle-mounted time information and signal information in the positioning request signal combined with the roadside time information, the roadside signal transmission duration is determined by the roadside unit by sending a measurement signal to other roadside units, the positioning signal transmission duration is the transmission duration of the positioning request signal transmitted between the vehicle-mounted unit and the roadside unit, the roadside signal transmission duration is the transmission duration of the measurement signal transmitted between roadside units, and the target roadside unit distance is the distance between two roadside units; Determine the location of the vehicle-mounted unit itself according to the transmission duration of the positioning signal fed back by the two roadside units on one side, the transmission duration of the roadside signal, the height of the roadside unit, and the distance to the target roadside unit; The two roadside units on one side are a first roadside unit and a second roadside unit. Accordingly, the location of the vehicle-mounted unit itself is determined according to the positioning signal transmission duration, the roadside signal transmission duration, the roadside unit height and the target roadside unit distance fed back by the two roadside units on one side, including: Acquire the positioning signal transmission duration, roadside signal transmission duration, roadside unit height, and target roadside unit distance fed back by the first roadside unit and the second roadside unit on one side, wherein the positioning signal transmission duration includes the first positioning signal transmission duration fed back by the first roadside unit and the second positioning signal transmission duration fed back by the second roadside unit, and the roadside unit height includes the first roadside unit height of the first roadside unit and the second roadside unit height of the second roadside unit; Determine the signal transmission speed according to the ratio of the target roadside unit distance to the roadside signal transmission time; Determine the first distance and the second distance according to the signal transmission speed, the first positioning signal transmission duration and the second positioning signal transmission duration; Determine a first projection distance and a second projection distance according to the first distance, the second distance, the height of the first roadside unit and the height of the second roadside unit, wherein the first projection distance is the distance between the first roadside unit and the vehicle-mounted unit after being vertically projected to the ground position, and the second projection distance is the distance between the second roadside unit and the vehicle-mounted unit after being vertically projected to the ground position; According to the target roadside unit distance, the first projection distance and the second projection distance combined with a predetermined coordinate calculation formula, candidate coordinates are determined, and the location of the vehicle-mounted unit itself is determined according to each of the candidate coordinates.
