Positioning device and positioning method
The integration of satellite and sensor-based positioning systems in a railway vehicle device enhances accuracy by dynamically switching between methods based on signal conditions, addressing measurement inaccuracies in environments with signal blockage.
Patent Information
- Application Number
- JP2021046427
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-03-19
- Publication Date
- 2024-12-16
- Estimated Expiration
- 2041-03-19
AI Technical Summary
Satellite-based positioning systems for railway vehicles face accuracy issues due to multipath interference and signal blockage in environments like tunnels and underpasses, leading to potential loss of position measurement.
A positioning device that integrates satellite reception control with independent measurement control using sensors, determining the optimal control method based on signal reception status and environmental conditions, and switches between the two as needed.
Improves measurement accuracy by seamlessly switching between satellite and sensor-based positioning, ensuring precise location tracking even in environments where satellite signals are unreliable.
Smart Images

Figure 0007600005000002 
Figure 0007600005000003 
Figure 0007600005000004
Abstract
Description
[Technical field]
[0001] FIELD OF THE DISCLOSURE The present invention relates to a positioning device. [Background technology]
[0002] The position of railway vehicles is measured by satellite reception control using radio signals transmitted from artificial satellites, but depending on the environment along the railway line, problems such as multipath can cause the measurement accuracy to deteriorate to a maximum of ±10m. As a result, satellite reception control may not be accurate enough to measure the position of railway vehicles in automatic operation. Also, in tunnels, under elevated tracks such as overpasses and underground sections of stations on bridges, etc., where radio waves transmitted by satellites do not reach, there is a risk that the running position of railway vehicles cannot be determined even in areas where satellite reception control is impossible.
[0003] For this reason, there is a demand to switch to independent measurement control during execution of satellite reception control, in which the position of the railway vehicle is measured using, for example, a speed sensor, an acceleration sensor, or the like provided on the railway vehicle. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2016-005373 A Summary of the Invention [Problem to be solved by the invention]
[0005] In order to solve such problems, an object of the present invention is to provide a positioning device and a positioning method that are capable of improving measurement accuracy. [Means for solving the problem]
[0006] A positioning device according to an embodiment includes a satellite reception control unit, an autonomous measurement control unit, and a discrimination unit. The satellite reception control unit performs first control related to reception of first information transmitted from an artificial satellite and used to measure the position of the vehicle. The autonomous measurement control unit performs second control related to reception of second information transmitted from a sensor and used to measure the position of the vehicle. The discrimination unit discriminates whether to perform at least one of satellite reception control and autonomous measurement control depending on the reception status of the first information and the second information. [Brief description of the drawings]
[0007] [Figure 1] FIG. 1 is a block diagram showing an overview of a positioning device according to the first embodiment. [Diagram 2] FIG. 2 is a block diagram showing the configuration of the reception processing device. [Diagram 3] FIG. 3 is a flowchart showing the process of the positioning signal calculation unit. [Figure 4] FIG. 4 is a flowchart showing the process of the independent measurement calculation unit. [Diagram 5] FIG. 5 is a conceptual diagram showing a situation in which the position of a railway vehicle is measured. [Figure 6] FIG. 6 is a flowchart (part 1) showing the process of the state determination unit. [Figure 7] FIG. 7 is a flowchart (part 2) showing the process of the state determination unit. [Figure 8] FIG. 8 is a flow chart showing the process of controlling the elevation angle of the satellite reception control unit. [Figure 9] FIG. 9 is a flow chart showing the process of controlling the radio signal reception sensitivity of the satellite reception control section. [Figure 10] FIG. 10 is a flowchart showing the process of the switching determination unit. [Figure 11] FIG. 11 is an explanatory diagram of the situation when the satellite reception control section selects an artificial satellite. [Figure 12] FIG. 12 is an explanatory diagram of a situation in which the elevation angle is controlled by the satellite reception control section. [Figure 13]FIG. 13 is an explanatory diagram showing the situation in which artificial satellites located within the area of the satellite reception control section are selected. [Figure 14] FIG. 14 is an explanatory diagram showing the situation in which the satellite reception control unit 22 selects an artificial satellite 12 based on the priority order of the areas. [Figure 15] FIG. 15 is a flow chart showing the situation in which a decision is made as to whether or not to execute stand-alone measurement control while satellite reception control is being executed. [Figure 16] FIG. 16 is a conceptual diagram showing an error of a positioning point in satellite positioning control. [Figure 17] FIG. 17 is a flow chart showing the satellite selection process in the satellite reception control unit 22. [Figure 18] FIG. 18 is a conceptual diagram showing distance estimation errors in satellite reception control. [Figure 19] FIG. 19 is a flowchart (part 1) showing the flow of satellite reception control processing. [Figure 20] FIG. 20 is a flowchart (part 2) showing the flow of satellite reception control processing. [Figure 21] FIG. 21 is an explanatory diagram showing the execution status of the map-linked control. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0008] Hereinafter, a positioning device and a positioning method according to an embodiment will be described in detail with reference to the accompanying drawings.
[0009] FIG. 1 is a block diagram showing an overview of a positioning device 10 according to the first embodiment. The positioning device 10 is mounted on a railroad car 11 and is capable of measuring the position of the railroad car 11 based on radio signals SX transmitted from an artificial satellite 12. The positioning device 10 includes a receiving antenna device 13, an external device 14, and a reception calculation processing device 15. Note that in this embodiment, the radio signals SX1 to SXn and the artificial satellites 12-1 to 12-n are illustrated with n=4, but this is not limiting. For example, n may be a natural number equal to or greater than 5.
[0010] The receiving antenna device 13 is an antenna device capable of receiving the radio signal SX. The radio signal SX is a signal including information for measuring the position of the railcar 11. The external device 14 is a device that performs running control of the railcar 11 based on the positioning result, and is, for example, a train control management system (TCMS), a driver assistance control device for automatic driving, an on-board monitor, etc. The receiving calculation processing device 15 performs calculation processing for identifying the position of the railcar 11 based on the radio signal SX output from the receiving antenna device 13, and outputs the calculation result to the external device 14.
[0011] Fig. 2 is a block diagram showing the configuration of the reception calculation processing device 15. The reception calculation processing device 15 has a positioning signal calculation section 21, a satellite reception control section 22, an independent measurement calculation section 23, a state determination section 24, a vehicle position correction section 25, a switching determination section 26, a storage device 27, a communication connection device 28, and a map DB 29. Fig. 2 also shows a three-axis sensor unit CSU. The three-axis sensor unit CSU is a three-axis sensor including, for example, a three-axis acceleration sensor, a three-axis gyro sensor, and a three-axis geomagnetic sensor.
[0012] The positioning signal calculation unit 21 calculates the position coordinates of the railway vehicle 11 based on the radio signal SX received by the receiving antenna device 13, and outputs a satellite positioning data group DG. The satellite positioning data group DG includes the position coordinates of the railway vehicle 11, time, satellite orbit information included in the radio signal SX (e.g., satellite almanac information and satellite ephemeris information), and the received signal strength of the radio signal SX.
[0013] The satellite reception control section 22 performs satellite reception control using the radio signal SX transmitted by the artificial satellite 12, and measures the position of the railway vehicle 11.
[0014] Specifically, the satellite reception control unit 22 calculates the elevation angle from the position of the artificial satellite 12 in the z direction, based on the traveling direction DR and position coordinates (x, y, z) of the railcar 11.
[0015] The satellite reception control unit 22 also calculates the azimuth angle from the position of the artificial satellite 12 in the x and y directions, based on the traveling direction DR and position coordinates (x, y, z) of the railway vehicle 11. The satellite reception control unit 22 may also calculate the elevation angle and azimuth angle based on satellite almanac information.
[0016] The satellite reception control unit 22 also calculates a value for PDOP (rate of change of position accuracy estimated from received signals). DOP (Dilution of Precision) is an index of the satellite arrangement, and is highly correlated with the measurement accuracy of the target position. For example, the smaller the value, the higher the accuracy of measuring the position of the railway vehicle 11 tends to be. DOP includes HDOP (Horizontal DOP), which indexes the horizontal geometric arrangement of the satellites, VDOP (Vertical DOP), which indexes the vertical geometric arrangement of the satellites, and PDOP (Position DOP), which combines these. In this embodiment, the normal PDOP value is used.
[0017] Furthermore, the satellite reception control unit 22 calculates the value of PACC3D. PACC is an index showing the measurement accuracy of the position of the railway vehicle 11 and the signal strength of the radio signal SX transmitted by the artificial satellite 12. For example, the smaller the value, the higher the accuracy of measuring the position of the railway vehicle 11 and the tendency for the signal strength of the radio signal SX to be high. PACC includes PACCH, which indexes the horizontal position accuracy of the railway vehicle, PACCV, which indexes the vertical position accuracy of the railway vehicle, and PACC3D, which indexes the position accuracy in three axial (xyz) directions of the railway vehicle. In this embodiment, the value of PACC3D is normally used.
[0018] The autonomous measurement calculation unit 23 outputs an autonomous positioning data group DS based on the output of the three-axis sensor unit CSU. The autonomous positioning data group DS includes time, speed, acceleration, angle, and running vector. That is, the autonomous measurement calculation unit 23 performs autonomous measurement control to measure the position of the railway vehicle 11 by calculating these using a general calculation method. For example, the running vector in the three-axis direction is calculated by integrating the acceleration in the three-axis direction over time based on the output of the three-axis acceleration sensor. Also, the speed can be calculated as, for example, the absolute value of the running vector in the three-axis direction. In other words, the autonomous measurement calculation unit 23 performs autonomous measurement control regarding the reception of the radio signal SX transmitted from the sensor and including information for measuring the position of the railway vehicle 11.
[0019] Furthermore, the autonomous measurement calculation unit 23 corrects and calculates the position coordinates of the railway vehicle 11 based on the satellite positioning data group DG using the information of the autonomous positioning data group DS, and outputs position information of the railway vehicle 11. That is, the autonomous measurement calculation unit 23 calculates the time-series change in the position coordinates of the railway vehicle 11 from the reference position using the information of the autonomous positioning data group DS.
[0020] The autonomous measurement calculation unit 23 calculates the speed, acceleration and angle in three axial directions, outputs an autonomous positioning data group DS including this information, and stores it together with the time in the storage device 27. At this time, the autonomous measurement calculation unit 23 calculates the position coordinates of the railway vehicle 11 based on the autonomous positioning data group DS, and stores it together with the time in the storage device 27.
[0021] The status determination unit 24 determines the status of the railway vehicle 11 (for example, whether the railway vehicle 11 is running, stopped, or broken down, etc.) based on, for example, the satellite positioning data group DG and the autonomous positioning data group DS.
[0022] The vehicle position correction unit 25 calculates the time series change of the position coordinates of the railway vehicle 11 from the reference position using at least the information included in the satellite positioning data group DG or the information included in the autonomous positioning data group DS. This reference position is the average position of the positions where positioning or autonomous calculation was performed in the past. For example, the reference position is the average value of the past 10 measured positions when passing the same ground coil.
[0023] The switching determination unit 26 determines whether to perform at least one of satellite reception control and independent measurement control depending on the reception conditions of information transmitted from artificial satellites to measure the vehicle's position, and information transmitted from sensors to measure the vehicle's position.
[0024] In addition, the switching determination unit 26 determines whether the position coordinates measured by the satellite reception control unit 22 through satellite reception control or the position coordinates output by the autonomous measurement calculation unit 23 through autonomous measurement control should be used as the position coordinates of the railway vehicle 11.
[0025] For example, the switching determination unit 26 determines whether or not the radio signal SX is blocked and the railway vehicle 11 is in an environment in which it is not possible to capture the artificial satellite 12. If the satellite reception control unit 22 determines that satellite reception control is not possible in an environment in which it is not possible to capture the artificial satellite 12, the autonomous measurement calculation unit 23 executes autonomous measurement control and measures the position of the artificial satellite 12.
[0026] The storage device 27 may be, for example, a RAM (Random Access Memory), This is realized by semiconductor memory elements such as flash memory, hard disks, optical disks, etc. The storage device 27 stores various information. The communication connection device 28 communicates between the storage device 27 and the external device 14.
[0027] The map DB 29 stores map information that indicates, for example, specific areas on a map where the reception of the radio signal SX transmitted by the artificial satellite 12 is poor, such as tunnels, train stations, and bridges, as well as the entrances and exits of these areas. Then, for example, the satellite reception control unit 22 or the autonomous measurement calculation unit 23 performs map-linked control, which is control that performs satellite reception control or autonomous measurement control in parallel while referring to the map information stored in the map DB 29. Note that the satellite reception control unit 22 and the autonomous measurement calculation unit 23 may perform map-linked control while performing satellite reception control and autonomous measurement control, respectively.
[0028] 3 is a process flowchart of the positioning signal calculation unit 21. The positioning signal calculation unit 21 receives the radio signals SX1 to SX4 via the receiving antenna device 13 (step S11).
[0029] Next, the positioning signal calculation unit 21 extracts a time signal from the radio signals SX1 to SX4 to obtain data related to time information (step S12). Next, the positioning signal calculation unit 21 obtains data related to position information including satellite orbit information (e.g., satellite almanac information and satellite ephemeris information) and latitude information and longitude information based on the obtained time signal (step S13).
[0030] Here, the method of acquiring the position information will be described in detail. The positioning signal calculation unit 21 calculates the position coordinates (x, y, z) of the railway vehicle 11 using, for example, orbit information from the artificial satellites 12-1 to 12-4. That is, the position coordinates (x, y, z) of the railway vehicle 11 are calculated from information that is a set of the positions of the artificial satellites 12-1 to 12-4 and the distances between the artificial satellites 12-1 to 12-4 and the reception calculation processing device 15 at that moment. In this case, if there are three or more sets of information on the positions of the artificial satellites and the distances between the artificial satellites and the reception calculation processing device 15 at that moment, the coordinates (x, y, z) can be calculated. In addition, a fourth satellite is generally required to guarantee the accuracy of the time.
[0031] More specifically, the positioning signal calculation unit 21 calculates the position coordinates (x, y, z) of the railway vehicle 11 based on the satellite orbit information (for example, satellite almanac information and satellite ephemeris information) and the obtained time signal using the following formula.
[0032]
number
[0033] In the above formula, (x, y, z) are parameters of coordinate values of the position to be found, and (xn, yn, zn) are parameters of coordinate values of the position of the artificial satellite 12 transmitting the radio signal SX. Furthermore, t is a parameter of the time of positioning, and tn is a parameter of the time of transmitting the radio signal SX from the artificial satellite 12. Note that the positioning signal calculation unit 21 may receive the radio signal SX via a terrestrial base station or the like. The positioning signal calculation unit 21 calculates the desired position information using these four parameters by the least squares method or the like.
[0034] Next, the positioning signal calculation unit 21 acquires data related to the artificial satellites 12 that measure the position of the railway vehicle 11 (step S14). For example, the positioning signal calculation unit 21 acquires the number of artificial satellites 12 used for measurement based on a predetermined calculation.
[0035] Furthermore, the positioning signal calculation unit 21 acquires other data. The positioning signal calculation unit 21 outputs a satellite positioning data group DG including these pieces of information, and stores the same in the storage device 27.
[0036] 4 is a flowchart showing the processing of the independent measurement calculation unit 23. The independent measurement calculation unit 23 acquires data of the triaxial acceleration sensor from the triaxial sensor unit CSU (step S21), acquires data of the triaxial gyro sensor (step S22), and acquires data of the triaxial geomagnetic sensor (step S23). Note that it is not necessary to acquire data of the triaxial geomagnetic sensor, and only two types of data of the triaxial acceleration sensor and the triaxial gyro sensor may be acquired.
[0037] Next, the independent measurement calculation unit 23 judges whether data for 0.1 seconds has been acquired from each sensor. If it is judged that data for 0.1 seconds has not been acquired (No in step S24), the process returns to step S21 and is repeated. If it is judged that data for 0.1 seconds has been acquired (Yes in step S24), the average value of the data for each sensor is calculated (step S25), and the process ends.
[0038] 5 is a conceptual diagram showing a situation in which the position of the railway vehicle 11 is measured. For example, when the autonomous measurement calculation unit 23 calculates that the railway vehicle 11 is located at a position on the track indicated by a circle, the state determination unit 24 determines that the position of the railway vehicle 11 can be measured only by autonomous measurement control. On the other hand, when the autonomous measurement calculation unit 23 calculates that the railway vehicle 11 is located at a position on the track indicated by a cross, the switching determination unit 24 determines that it is necessary to perform satellite reception control instead of or in parallel with the autonomous measurement control to measure the position of the railway vehicle 11.
[0039] 6 is a flowchart (part 1) showing the processing of the state discrimination unit. The state discrimination unit 24 judges whether or not the positioning signal calculation unit 21 has calculated the speed of the railcar 11 based on the radio signal SX received from the artificial satellite 12 (step S31). If the positioning signal calculation unit 21 judges that the speed has not been calculated (No in step S31), the state discrimination unit 24 judges that the radio signal SX cannot be received from the artificial satellite 12 (step S32) and proceeds to step S36. If the positioning signal calculation unit 21 judges that the speed has been calculated (Yes in step S31), the state discrimination unit 24 judges whether or not the speed of the railcar 11 is smaller than a threshold value (step S33). If the speed is smaller than the threshold value (Yes in step S33), the state discrimination unit 24 judges that the railcar 11 is stopped (step S34) and proceeds to step S36. If the speed is not smaller than the threshold value (Yes in step S33), the state determination unit 24 determines that the railway vehicle 11 is stopped (step S35), and proceeds to step S36.
[0040] Next, the state discrimination unit 24 judges whether or not the autonomous measurement calculation unit 23 has calculated the acceleration (step S36). If it is judged that the acceleration has not been calculated (No in step S36), the state discrimination unit 24 judges that the acceleration sensor cannot be used (step S37), and proceeds to step S41. If it is judged that the acceleration has been calculated (Yes in step S36), the state discrimination unit 24 judges whether or not the acceleration of the railcar 11 is smaller than a threshold value (step S38). If the acceleration is smaller than the threshold value (Yes in step S38), the state discrimination unit 24 judges that the railcar 11 is stopped (step S39), and proceeds to step S41. If the acceleration is not smaller than the threshold value (No in step S38), the state discrimination unit 24 judges that the railcar 11 is moving (step S40), and proceeds to step S41.
[0041] Next, the state discrimination unit 24 judges whether or not the self-sustaining measurement calculation unit 23 has calculated the angle (step S41). If it is judged that the angle has not been calculated (No in step 41), the state discrimination unit 24 judges that the angle sensor cannot be used (step S42), and proceeds to step S51. If it is judged that the angle has been calculated (Yes in step 41), the state discrimination unit 24 judges whether or not the angle of the railcar 11 is smaller than a threshold value (step S43). If it is judged that the angle is smaller than the threshold value (Yes in step 43), the state discrimination unit 24 judges that the railcar 11 is stopped (step S44), and proceeds to step 51. If the angle is not smaller than the threshold value (No in step 43), the state discrimination unit 24 judges that the railcar 11 is moving (step S45), and proceeds to step S51 (continued to A in FIG. 7).
[0042] 7 is a flowchart (part 2) showing the processing of the state determination unit 24. The state determination unit 24 determines whether or not at least one of the speed, acceleration, and angle has not been calculated (step S51). When it is determined that at least one of the speed, acceleration, and angle has not been calculated (Yes in step S51), the state determination unit 24 determines that the railway vehicle 11 has a malfunction (step S52) and ends the processing.
[0043] When it is determined that at least one of the speed, acceleration, and angle has been calculated (No in step S51), the state discrimination unit 24 determines whether or not a stop determination has been made at least once (step S53). That is, the state discrimination unit 24 determines whether the vehicle is in a stopped state where the vehicle is stopped, or in a running state where the vehicle is running. When it is determined that a stop determination has been made at least once (Yes in step S53), the state discrimination unit 24 determines that the railway vehicle 11 is stopped (step S54). Thereafter, the state discrimination unit 24 acquires the position of the railway vehicle 11 100 ms before (step S55), outputs data indicating that the railway vehicle 11 has been stopped since then (step S56), and ends the process.
[0044] If it is determined that a stop determination has not been made at least once (No in step S53), the state determination unit 24 determines that the railway vehicle 11 is moving (step S57) and proceeds to steps S61 and S71 (continued in B of FIG. 8 and C of FIG. 9).
[0045] 8 is a flow chart showing the process of controlling the elevation angle of the satellite reception control unit 22. The state determination unit 24 determines whether or not the satellite reception control unit 22 has calculated the PDOP (step S61). If it is determined that the satellite reception control unit 22 has not calculated the PDOP (No in step S61), the satellite reception control unit 22 outputs a reset value for the elevation angle (angle) and ends the process.
[0046] If it is determined that the satellite reception control unit 22 has calculated the PDOP (Position Dilution of Precision) (Yes in step S61), the state determination unit 24 determines whether the PDOP is within the range between the minimum and maximum values (step S63).If it is determined that the PDOP is within the range between the minimum and maximum values (Yes in step S63), a reset value for the elevation angle is output and the process ends.
[0047] If it is determined that the PDOP is not within the range between the minimum and maximum values (No in step S63), the state determination unit 24 determines whether or not the PDOP is greater than the maximum value (step S65). If it is determined that the PDOP is not greater than the maximum value (No in step S65), the satellite reception control unit 22 outputs the minimum value of PDOP (step S66) and ends the process. If it is determined that the PDOP is greater than the maximum value (Yes in step S65), the satellite reception control unit 22 calculates the elevation angle (step S67). Then, the satellite reception control unit 22 outputs the elevation angle (step S68) and ends the process.
[0048] 9 is a flow chart showing the process of controlling the reception sensitivity of radio signal SX by satellite reception control unit 22. State determination unit 24 determines whether or not satellite reception control unit 22 has calculated PACC3D (step S71). If it is determined that satellite reception control unit 22 has not calculated PACC3D (No in step S71), satellite reception control unit 22 outputs a reset value for the reception sensitivity and ends the process.
[0049] If it is determined that satellite reception control unit 22 has calculated PACC3D (Yes in step S71), state determination unit 24 determines whether PACC3D is within the range of predetermined minimum and maximum values (step S73).If it is determined that PACC3D is not within the range of predetermined minimum and maximum values (No in step S73), satellite reception control unit 22 outputs a reset value for reception sensitivity and ends the process.
[0050] If it is determined that PACC3D is within the range between the predetermined minimum and maximum values (Yes in step S73), the state determination unit 24 determines whether PACC3D is greater than the predetermined maximum value (step S75). If it is determined that PACC3D is not greater than the predetermined maximum value (No in step S75), the satellite reception control unit 22 outputs the minimum value of PACC3D (step S76) and ends the process. If it is determined that PACC3D is greater than the maximum value (Yes in step S75), the satellite reception control unit 22 calculates the reception sensitivity (step S77). Then, the satellite reception control unit 22 outputs the reception sensitivity (step S78) and ends the process.
[0051] 10 is a flowchart showing the processing of the switching determination unit 26. The switching determination unit 26 determines whether or not the situation is such that the satellite reception control unit 22 should start or continue satellite reception control (step S81). If it is determined that the situation is such that satellite reception control should be started or continued (Yes in step S81), the satellite reception control unit 22 starts satellite reception control (step S82) and proceeds to step S83.
[0052] If it is determined that the situation is not such that satellite reception control should be started or continued (No in step S81), or after the processing of step S82, the switching discriminator 26 determines whether the situation is such that the autonomous measurement calculation unit 23 should start or continue autonomous measurement control (step S83). If it is determined that the situation is such that the autonomous measurement calculation unit 23 should start or continue autonomous measurement control (No in step S83), the switching discriminator 26 ends the processing. If it is determined that the situation is such that the autonomous measurement control should be started or continued (Yes in step S83), the autonomous measurement calculation unit 23 starts autonomous measurement control (step S84).
[0053] Thereafter, the switching determination unit 26 judges whether or not the situation requires the satellite reception control unit 22 to end satellite reception control (step S85). If it is judged that the situation requires the satellite reception control to end (Yes in step S85), the satellite reception control unit 22 ends satellite reception control (step S86).
[0054] The switching discriminator 26 judges whether the situation is such that the independent measurement control is to be ended by the independent measurement calculation unit 23 (step S87). If it is judged that the situation is such that the independent measurement control is to be ended (Yes in step S87), the independent measurement calculation unit 23 ends the independent measurement control (step S88), and the switching discriminator 26 ends the processing. If it is judged that the situation is such that the independent measurement control is not to be ended (No in step S87), the switching discriminator 26 ends the processing.
[0055] Fig. 11 is an explanatory diagram of the situation when the satellite reception control unit 22 selects a satellite. Fig. 11(a) is an image diagram of satellite orbit information. In Fig. 11(a), the antenna 13 of the railway vehicle 11 is placed at the centre of the circle. In Fig. 11(a), the circle represents the current position of the satellite 12, and the curve passing through the current position of the satellite 12 represents the satellite orbit information of the satellite 12.
[0056] In the situation shown in FIG. 11(a), the signal is actually received by the antenna 13 of the railway vehicle 11. The possible range varies depending on the arrangement position of the antenna 13 and the running position of the railway vehicle 11. For example, as shown in FIG. 11(b), the satellite reception control section 22 determines whether the effective reception area AE and a reception invalid area AN is set, and the traveling direction D is determined based on the traveling direction DR of the railroad vehicle 11. For R, the azimuth angles are set to, for example, 135 degrees in both the clockwise and counterclockwise directions.
[0057] Furthermore, the satellite reception control unit 22 sets a satellite position determination area AD for determining the position of the artificial satellite 12 to select the artificial satellite 12 so that the effective reception area AE corresponding to the set azimuth angle is at 90 degrees in both the clockwise and counterclockwise directions with respect to the traveling direction DR of the railway vehicle 11, as shown in Figure 11 (c), and continuously performs the process of identifying the artificial satellite to be selected next.
[0058] Figure 12 is an explanatory diagram of the situation in which the elevation angle is controlled by the satellite reception control unit 22. As shown in Figure 12(a), the satellite reception control unit 22 controls the elevation angle EL so as to include all of the artificial satellites 12E that are valid for measuring the position of the railway vehicle 11 and that have been selected by the above-mentioned satellite selection process, but not to include the artificial satellites 12N (= artificial satellites 12N21 and 12N22) that are invalid for measuring the position of the railway vehicle 11.
[0059] As a result, the effective elevation angle range AEL becomes as shown in Figure 12(b), and the satellite reception control unit 22 then performs processing to identify the effective reception area AE of the railway vehicle 11, as shown in Figure 11(c).As a result, it becomes possible to maintain the measurement accuracy of the position of the railway vehicle 11 at a desired value or higher.
[0060] That is, the satellite reception control unit 22 sets a range of elevation angles of the satellite relative to the vehicle, sets a range of azimuth angles of the satellite relative to the vehicle within the set elevation angle range, and divides the area included in the elevation angle range and the azimuth angle range into multiple regions.
[0061] In this case, the satellite reception control unit 22 periodically obtains the traveling direction DR of the railway vehicle 11 from the azimuth angle for a fixed period of time (for example, one second) and obtains the averaged azimuth angle as the traveling direction angle. The artificial satellite 12 that exists at this traveling direction angle may be selected from the satellite orbit information.
[0062] Furthermore, if the azimuth angle of the traveling direction DR changes significantly (for example, by 10°) due to a curve, a route change, etc., the satellite reception control unit 22 may acquire the traveling direction angle as needed and select the artificial satellite 12 from the satellite orbit information. This enables the satellite reception control unit 22 to select only radio signals SX that can improve the accuracy with which the position of the railway vehicle 11 is detected.
[0063] 13 is an explanatory diagram showing the situation when selecting a satellite 12 located within the area of the satellite reception control unit 22. Five satellites 12 are located in area e, which is included in the valid elevation angle range AEL and is an area surrounded by a thick line. The satellite reception control unit 22 selects from these five satellites 12 two valid satellites 12E and three satellites 12L that are not used for position measurement, depending on, for example, the arrangement of the satellites 12 within area e. In other words, the satellite reception control unit 22 selects a satellite 12 to use for satellite reception control from one or more satellites 12 located in multiple areas.
[0064] At this time, the satellite reception control unit 22 selects two of the five satellites 12 as valid satellites 12E so that the satellites are evenly distributed within area e. For example, the satellite reception control unit 22 may select satellites 12 that are close to each other or overlap within area e as satellites 12L that will not be used for position measurement. The satellite reception control unit 22 performs similar processing in other areas depending on the distribution of the satellites 12. Note that if the satellites 12 include geostationary satellites, the satellite reception control unit 22 may preferentially select the geostationary satellites.
[0065] FIG. 14 is an explanatory diagram showing a situation in which the satellite reception control unit 22 selects a satellite 12 based on the priority order of the areas. The satellite reception control unit 22 sets a priority order (for example, a rank from 1 to 24 as shown in FIG. 14) for each relevant area based on the elevation angle, azimuth angle, and reception sensitivity. For example, the satellite reception control unit 22 gives priority to selecting a satellite 12 located in an area with a high priority order. In other words, the satellite reception control unit 22 selects multiple areas based on a predetermined priority order. If a geostationary satellite is included in the relevant area, the satellite reception control unit 22 may give priority to selecting an area that includes a geostationary satellite. Note that in FIGS. 13 and 14, the elevation angle is basically in increments of 15° or 30°, and the azimuth angle is basically 30° or 45°, but is not limited to the angles shown here.
[0066] 15 is a flow chart showing the situation in which a decision is made as to whether or not to perform standalone measurement control while satellite reception control is being executed. First, the satellite reception control unit 22 acquires the number of satellites used to measure the current position of the railway vehicle 11. Next, the state determination unit 24 decides whether the number of satisfied conditions is equal to or greater than a prescribed threshold value (step S92). If it is decided that the number is not equal to or greater than the threshold value (No in step S92), the state determination unit 24 decides whether or not the satellite reception control unit 22 performed satellite reception control a prescribed time ago (for example, 100 ms ago) (step S93).
[0067] If it is determined that satellite reception control was performed a predetermined time ago (Yes in step S93), the process proceeds to D in Fig. 10, where the switching discriminator 26 continues processing. If it is determined that satellite reception control was not performed a predetermined time ago (No in step S93), the process proceeds to E in Fig. 10, where the switching discriminator 26 continues processing.
[0068] If it is determined in step S92 that the value is equal to or greater than the threshold value (Yes in step S92), the state determination unit 24 determines whether the value is equal to or greater than the threshold value two consecutive times (step S94). If it is determined that the value is equal to or greater than the threshold value two consecutive times (Yes in step S94), the process proceeds to F in Fig. 10, where the switching determination unit 26 continues the process. If it is determined that the value is not equal to or greater than the threshold value two consecutive times (No in step S94), the process proceeds to D in Fig. 10, where the switching determination unit 26 continues the process.
[0069] Fig. 16 is a conceptual diagram showing an error of a positioning point in satellite positioning control. In Fig. 16, the range between a central axis that passes through the center of gravity (or near the center of gravity) of the railway vehicle 11 and extends along the traveling direction DR of the railway vehicle 11 and a square mark located on an arc centered on a central point that passes through the center of gravity of the railway vehicle 11 and is a point on a line perpendicular to the central axis is shown as the allowable error range. In Fig. 16, a circle mark is located within the allowable error range, and a cross mark is located outside the allowable error range.
[0070] For example, if the state discrimination unit 24 determines that the measurement point is within the allowable error range a predetermined threshold or more times while satellite positioning control is being executed, the switching discrimination unit 26 determines that the satellite reception control unit 22 is in a situation to perform satellite positioning control, and the satellite positioning control unit 22 continues the satellite positioning control. If the state discrimination unit 24 determines that the positioning point is not within the allowable error range a predetermined threshold or more times while satellite positioning control is being executed, the switching discrimination unit 26 determines that the autonomous measurement control is in a situation to perform autonomous measurement control, and the autonomous measurement calculation unit 23 starts autonomous measurement control.
[0071] 17 is a flowchart showing the satellite selection process in the satellite reception control unit 22. The satellite reception control unit 22 acquires a target elevation angle control value and reception sensitivity control value (step S101). Next, the satellite reception control unit 22 acquires the azimuth, elevation angle, and reception sensitivity of each artificial satellite 12 (step S102). The satellite reception control unit 22 then counts the number of all artificial satellites 12 within the area (step S103). After that, the satellite reception control unit 22 counts the number of artificial satellites 12 with a reception sensitivity equal to or greater than the threshold value for each divided area (step S104).
[0072] Here, the satellite reception control unit 22 determines whether or not eccentricity has occurred in the arrangement of the artificial satellites within the area (step S105). If eccentricity has not occurred (No in step S105), the process returns to step S101 and is repeated. If eccentricity has occurred (Yes in step S105), the satellite reception control unit 22 acquires the reception sensitivity of all artificial satellites 12 (step S106).
[0073] Next, the satellite reception control unit 22 obtains the number of satellites with a reception sensitivity equal to or greater than the threshold for each elevation angle (step S107). Next, the satellite reception control unit 22 obtains the elevation angles of the artificial satellites 12 with a reception sensitivity equal to or greater than the threshold (step S108). Next, the satellite reception control unit 22 calculates the minimum elevation angle from the obtained elevation angles (step S109), and sets this value as the elevation angle control value (step S110).
[0074] If there are two or more satellites 12 in each divided area, the satellite reception control unit 22 selects one satellite 12 with the best reception conditions (reception sensitivity) (step S111). From these, the satellite reception control unit 22 selects a valid satellite 12E whose reception sensitivity variation is equal to or greater than a threshold (step S112). Then, from these valid satellites 12E, the satellite reception control unit 22 selects the satellite 12 to use in calculating position information (step S113).
[0075] Figure 18 is a conceptual diagram showing the estimated distance error in satellite reception control. As shown in Figure 18, vector L0 is a vector indicating the distance traveled by the railway vehicle, obtained by multiplying the measured speed by the measurement period T. On the other hand, vector L1 is a vector indicating the actual distance traveled by the railway vehicle 11 per unit time. The absolute value of the difference between vector L1 and vector L0 is called the estimated distance error. Switching discrimination unit 26 calculates vector L0, vector L1, and the estimated distance error.
[0076] 19 is a flowchart (part 1) showing the flow of satellite reception control processing. The state determination unit 24 judges whether or not the positioning signal calculation unit 21 has acquired, for example, one second's worth of radio signal SX (step S121). If it is determined that one second's worth of radio signal SX has not been acquired (No in step S121), the process is repeated. If it is determined that one second's worth of radio signal SX has been acquired (Yes in step S121), the vector length is calculated from the current coordinates and the coordinates from 0.1 seconds ago (step S122).
[0077] Next, the satellite reception control unit 22 acquires the speed of the railway vehicle 11 from the satellite positioning data group DG (step S123). The satellite reception control unit 22 then calculates the length of a vector equivalent to the distance traveled by the railway vehicle 11 from the speed of the railway vehicle 11 and the measurement interval (for example, 0.1 seconds) (step S124), and calculates the difference between the two vectors (step S125). This vector difference corresponds to the estimated distance error.
[0078] Here, state determination unit 24 judges whether the estimated distance error is greater than a predetermined threshold value (step S126). That is, state determination unit 24 uses the estimated distance error to determine whether to perform at least one of satellite reception control and independent measurement control. If the estimated distance error is not greater than the threshold value (No in step S126), the process returns to step S121 and is repeated. If the difference is greater than the threshold value (Yes in step S126), satellite reception control unit 22 acquires the estimated position error (step S127).
[0079] Here, state determination unit 24 judges whether the estimated position error is greater than a predetermined threshold value (step S128). That is, state determination unit 24 calculates the estimated position error related to the measurement accuracy of the vehicle's position in the three axial directions, and judges whether to perform at least one of satellite reception control and independent measurement control based on the estimated position error. If it is not greater than the threshold value (No in step S128), the process returns to step S121 and is repeated. If it is greater than the threshold value (Yes in step S128), satellite reception control unit 22 obtains the average value of the estimated position errors (step S129).
[0080] Then, satellite reception control unit 22 calculates the rate of change of the estimated position error using the average value of the estimated position error (step S130). Next, state determination unit 24 judges whether or not the average value of the estimated position error is greater than a predetermined threshold value (step S131). That is, state determination unit 24 calculates the amount of change in the estimated position error, and judges whether or not to perform at least one of satellite reception control and independent measurement control based on the amount of change. If it is not greater than the threshold value (No in step S131), the process returns to step S121 and the process is repeated. If it is greater than the threshold value (Yes in step S131), the process proceeds to E in Fig. 10, and switching determination unit 24 continues processing.
[0081] 20 is a flowchart (part 2) showing the flow of satellite reception control processing. The state determination unit 24 determines whether the positioning signal calculation unit 21 has acquired radio signal SX for, for example, 0.02 seconds (step S141). If it determines that 0.02 seconds' worth of signal has not been acquired (No in step S141), the process is repeated. If it determines that 0.02 seconds' worth of signal has been acquired (Yes in step S141), the satellite reception control unit 22 calculates a vector inner product of the current coordinates and the coordinates 0.02 seconds ago (step S142).
[0082] Next, the satellite reception control unit 22 acquires the azimuth angle of the traveling direction DR of the railway vehicle 11 (step S143). The satellite reception control unit 22 then calculates the type of track (straight, curved, etc.) on which the railway vehicle 11 is currently traveling from the current azimuth angle and the azimuth angle 50 Hz ago (step S144), and calculates the speed of the railway vehicle 11 based on the result (step S145). Next, the satellite reception control unit 22 selects a predetermined threshold value stored in the storage device 27 from the speed and type of track of the railway vehicle 11 (step S146). Then, the difference between the azimuth angle of the traveling direction DR of the railway vehicle 11 and the vector inner product is compared with the predetermined threshold value (step S147).
[0083] Here, the state determination section 24 judges whether or not the difference between the two is significantly large based on a predetermined threshold value (step S148). If it is judged that the difference between the two is not significantly large (No in step S148), the process returns to step S141 and repeats. If it is judged that the difference between the two is significantly large (Yes in step S149), the satellite reception control section 22 counts this fact (step S149).
[0084] Then, the state determination unit 24 determines whether or not the error is determined to be significantly large for, for example, five consecutive times (step S150). If it is not determined that the difference between the two is significantly large for five consecutive times (step S150), the process returns to step S141 and is repeated. If it is determined that the difference between the two is significantly large for five consecutive times (Yes in step S150), the process proceeds to E in FIG. 10, where the switching determination unit 24 continues the process.
[0085] FIG. 21 is an explanatory diagram showing the execution status of map-linked control. In FIG. 21, an actual track R1 and a track R2 on a map are provided. The space between two circles shown on the actual track R1 and the space between two triangles shown on the track R2 on the map indicate areas where satellite reception control is impossible, such as tunnels and stations. The two triangles are stored in the map DB 29. On the track R2 on the map, squares are located 100 m before and after each of the two triangles. The two squares are also stored in the map DB 29. That is, the map DB 29 stores map information including the passing area through which the vehicle passes and the specific position.
[0086] For example, if the satellite reception control unit 22 measures that the railway vehicle 11 is traveling 100 m in front of or behind a circle mark on the actual track R1, it will determine that the railway vehicle is traveling at the position on the map that is marked with a corresponding square mark.
[0087] Here, the switching discrimination unit 26 determines whether to perform at least satellite reception control or autonomous measurement control based on the running state of the railway vehicle 11 (running speed, acceleration, etc.), the positions of the △ and □ marks in the map DB 29, the passing area (whether or not satellite reception control is possible), etc. Then, based on the result of the determination by the switching discrimination unit 26, map-linked control is performed in which the satellite reception control unit 22 performs satellite reception control and the autonomous measurement calculation unit 23 performs autonomous measurement control, either separately or simultaneously.
[0088] The positioning device 10 of the embodiment described above includes a satellite reception control unit 22, an independent measurement calculation unit 23, and a switching determination unit 26. The satellite reception control unit 22 performs satellite reception control related to the reception of information transmitted from the artificial satellite 12 and used to measure the position of the railway vehicle 11. The independent measurement calculation unit 23 performs independent measurement control related to the reception of information transmitted from the sensor and used to measure the position of the railway vehicle 11. The switching determination unit 26 determines whether to perform at least one of satellite reception control and independent measurement control depending on the reception status of the above information. This makes it possible for the positioning device 10 to switch from satellite reception control to independent measurement control while the railway vehicle 11 is traveling, or to simultaneously perform satellite reception control and independent measurement control, for example, and to solve problems such as multipath. In addition, the measurement accuracy of the traveling position of the railway vehicle 11 can be improved in tunnels, under elevated tracks such as bridge stations, underground sections, etc.
[0089] The satellite reception control unit 22 sets the range of elevation angles of the artificial satellites 12 relative to the railway vehicle 11. The satellite reception control unit 22 sets the range of azimuth angles of the artificial satellites 12 relative to the railway vehicle 11 within the set elevation angle range. The satellite reception control unit 22 then divides an area included in the elevation angle range and the azimuth angle range into a plurality of areas, and selects an artificial satellite 12 to be used for satellite reception control from one or more artificial satellites 12 arranged in the plurality of areas. This allows the satellite reception control unit 22 to select any artificial satellite 12 depending on the elevation angle, azimuth angle, and reception status of the radio signal SX, and can further improve the measurement accuracy of the position of the railway vehicle 11. Also, when multiple artificial satellites 12 exist within the same area, by selecting artificial satellites 12 so that one or two are present in that area, it is possible to reduce bias in the arrangement of the artificial satellites 12 within that area and make the arrangement of the artificial satellites 12 even.
[0090] The satellite reception control unit 22 sets the range of elevation angles of the artificial satellites 12 relative to the railway vehicle 11, sets the range of azimuth angles of the artificial satellites 12 relative to the railway vehicle 11 within the set elevation angle range, divides the area included in the elevation angle range and azimuth angle range into a plurality of regions, and selects one of the plurality of regions based on a predetermined priority order. This allows the satellite reception control unit 22 to select a satellite 12 with good reception conditions for the radio signal SX and high priority, further improving the measurement accuracy of the position of the railway vehicle 11.
[0091] The state discrimination unit 24 calculates a vector L0, a vector L1, and an estimated distance error. The vector L0 corresponds to the amount of movement of the railway vehicle 11 within a predetermined time based on the speed of the railway vehicle 11. The vector L1 corresponds to the amount of movement of the railway vehicle 11 within a predetermined time. The estimated distance error is based on the vector L0 and the vector L1. The state discrimination unit 24 uses the estimated distance error to determine whether or not to perform at least one of satellite reception control and autonomous measurement control. In addition, the state discrimination unit 24 calculates an estimated position error related to the measurement accuracy of the position of the railway vehicle 11 in the three axial directions, and determines whether or not to perform at least one of satellite reception control and autonomous measurement control based on the estimated position error. Furthermore, the state discrimination unit 24 calculates the amount of change in the estimated position error, and determines whether or not to perform at least one of satellite reception control and autonomous measurement control based on the amount of change. This allows the state determination unit 24 to obtain more judgment indicators for switching between satellite reception control and autonomous measurement control, and allows the switching determination unit 26, for example, to switch between satellite reception control and autonomous measurement control more precisely.
[0092] The positioning device 10 further includes a map DB 29 that stores map information including the passing area through which the railcar 11 passes and the specific position (information on the map of tracks R2, tunnels, underpasses, etc., as well as the entrance and exit points of these, and predetermined points before and after each of the entrances and exits). The switching determination unit 26 determines whether to perform at least one of satellite reception control and autonomous measurement control based on the state of the railcar 11, the passing area, and the specific position. As a result, the switching determination unit 26 starts determining whether to switch from satellite reception control to autonomous measurement control from a predetermined point before the railcar 11 enters an area where the reception of the radio signal SX is poor, such as a tunnel or underpass, thereby optimizing the timing of switching. Furthermore, by referring to the map DB 29, the switching determination unit 26 can eliminate the time lag associated with the switching, and the measurement accuracy of the railcar 11 by the satellite reception control unit 22 and the autonomous measurement calculation unit 23 can be improved.
[0093] State determination unit 24 determines whether railway vehicle 11 is in a stopped state where railway vehicle 11 is stopped, or in a running state where railway vehicle 11 is running. In this way, state determination unit 24 suppresses fluctuations in the measurement results of the position of railway vehicle 11 when railway vehicle 11 is in a stopped state.
[0094] Although some embodiments of the present invention have been described, these embodiments are presented as examples and are not intended to limit the scope of the invention. These embodiments can be implemented in various other forms, and various omissions, substitutions, and modifications can be made without departing from the spirit of the invention. These embodiments and their modifications are included in the scope of the invention and its equivalents described in the claims, as well as in the scope and spirit of the invention. [Explanation of symbols]
[0095] 10 Positioning device, 13 Receiving antenna device, 14 External device, 15 Reception calculation processing device, 21 Positioning signal calculation unit, 22 Satellite reception control unit, 23 Self-sustaining measurement calculation unit, 24 State discrimination unit, 25 Vehicle position correction unit, 26 Switching discrimination unit, 27 Storage device, 28 Communication connection device, 29 Map DB, CSU 3-axis sensor unit, DG Satellite positioning data group, DS Self-sustaining positioning data group
Claims
1. A position measuring device that measures the position of a vehicle, a satellite reception control unit that performs a first control related to reception of first information transmitted from an artificial satellite and used to measure the position of the vehicle; an independent measurement control unit that performs a second control regarding reception of second information transmitted from a sensor and used to measure the position of the vehicle; a determination unit that determines whether to perform at least one of the first control and the second control depending on a receiving state of the first information and the second information; Equipped with The satellite reception control unit: setting a range of elevation angles of the satellite relative to the vehicle; setting a range of azimuth angles of the satellite relative to the vehicle within the set elevation angle range; A region included in the range of the elevation angle and the range of the azimuth angle is divided into a plurality of regions; selecting, from one or more of the artificial satellites arranged in the plurality of regions, an artificial satellite to be used in the first control that does not correspond to an artificial satellite that is close to or overlaps with each other in the plurality of regions; Positioning device.
2. The satellite reception control unit: selecting the plurality of regions based on a predetermined priority order; The positioning device according to claim 1 .
3. The discrimination unit calculates a first vector corresponding to an amount of movement of the vehicle within a predetermined time, a second vector corresponding to an amount of movement of the vehicle within a predetermined time based on a speed of the vehicle, and an estimated distance error based on the first vector and the second vector, and discriminates whether to perform at least one of the first control and the second control using the estimated distance error.
3. The positioning device according to claim 1 or 2.
4. The discrimination unit calculates an estimated position error related to the measurement accuracy of the position of the vehicle in three axial directions, and discriminates whether to perform at least one of the first control and the second control based on the estimated position error. The position measuring device according to any one of claims 1 to 3.
5. The discrimination unit calculates an amount of change in the estimated position error, and determines whether to perform at least one of the first control and the second control based on the amount of change. The positioning device according to claim 4.
6. Further comprising a map information storage unit for storing map information including a passing area through which the vehicle passes and a specific position, The positioning device according to any one of claims 1 to 5, wherein the discrimination unit discriminates whether to perform at least one of the first control and the second control based on the state of the vehicle, the passing area, and the specific position.
7. The discrimination unit discriminates whether the vehicle is in a stopped state where the vehicle is stopped or in a running state where the vehicle is running. The position measuring device according to any one of claims 1 to 6.
8. A positioning method for measuring a position of a vehicle, comprising: a satellite receiving step of performing a first control related to reception of first information transmitted from an artificial satellite and used to measure a position of the vehicle; an independent measurement process of performing a second control regarding reception of second information transmitted from a sensor and used to measure the position of the vehicle; a determination step of determining whether to perform at least one of the first control and the second control depending on a receiving state of the first information and the second information; Equipped with The satellite receiving step includes: setting a range of elevation angles of the satellite relative to the vehicle; setting a range of azimuth angles of the satellite relative to the vehicle within the set elevation angle range; A region included in the range of the elevation angle and the range of the azimuth angle is divided into a plurality of regions; selecting, from one or more of the satellites arranged in the plurality of regions, a satellite to be used in the first control that does not correspond to a satellite that is close to or overlaps with each other in the plurality of regions; Positioning method.
Citation Information
Patent Citations
Controller and server unit for GPS receiver
JP2004184121A
Power reception and transformation system
JP2016005373A
Railway traveling position detection device and method
JP2019189157A
Measuring device
JP2019221081A
Position identification system with multiple cross-checks
US20140324300A1
