WO2023286865A1 - 演算装置 - Google Patents
演算装置 Download PDFInfo
- Publication number
- WO2023286865A1 WO2023286865A1 PCT/JP2022/027914 JP2022027914W WO2023286865A1 WO 2023286865 A1 WO2023286865 A1 WO 2023286865A1 JP 2022027914 W JP2022027914 W JP 2022027914W WO 2023286865 A1 WO2023286865 A1 WO 2023286865A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- timing
- vehicle
- position information
- information
- estimated
- Prior art date
Links
- 238000012937 correction Methods 0.000 claims description 29
- 238000010801 machine learning Methods 0.000 claims description 3
- 230000006399 behavior Effects 0.000 description 106
- 238000001514 detection method Methods 0.000 description 50
- 238000013473 artificial intelligence Methods 0.000 description 22
- 238000005259 measurement Methods 0.000 description 15
- 238000000034 method Methods 0.000 description 12
- 238000010586 diagram Methods 0.000 description 11
- 238000004891 communication Methods 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 7
- 238000012545 processing Methods 0.000 description 6
- YVGGHNCTFXOJCH-UHFFFAOYSA-N DDT Chemical compound C1=CC(Cl)=CC=C1C(C(Cl)(Cl)Cl)C1=CC=C(Cl)C=C1 YVGGHNCTFXOJCH-UHFFFAOYSA-N 0.000 description 4
- 101710189714 Major cell-binding factor Proteins 0.000 description 4
- 101150008465 pdb1 gene Proteins 0.000 description 3
- 239000000725 suspension Substances 0.000 description 3
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Definitions
- the present invention relates to an arithmetic device.
- Patent Document 1 describes that when information from an external sensor is interrupted, the position of the vehicle is estimated based on the acceleration of the vehicle detected by an IMU (Inertial Measurement Unit).
- IMU Inertial Measurement Unit
- the present invention has been made in view of the above, and it is an object of the present invention to provide an arithmetic device capable of reducing vehicle position estimation errors.
- an arithmetic device includes detected position information, which is a detected value of position information of a vehicle at a first timing, and second position information after the first timing.
- a detection position acquisition unit that acquires detection position information at a timing
- a vehicle behavior acquisition unit that acquires vehicle behavior information indicating behavior of the vehicle
- position information of the vehicle at the second timing based on the vehicle behavior information. and acquires estimated position information at an intermediate timing between the first timing and the second timing based on the vehicle behavior information and the detected position information at the first timing.
- an estimated position acquiring unit correcting the estimated position information at the intermediate timing based on the difference between the detected position information and the estimated position information at the second timing, thereby correcting the position information of the vehicle at the intermediate timing. and a corrected position acquisition unit that calculates corrected position information that is a value.
- FIG. 1 is a schematic block diagram of a detection system according to this embodiment.
- FIG. 2 is a schematic diagram of a vehicle.
- FIG. 3 is a schematic block diagram of an arithmetic device.
- FIG. 4 is a schematic diagram illustrating an example of estimated position information.
- FIG. 5 is a schematic diagram illustrating an example of corrected position information.
- FIG. 6 is a flowchart for explaining the processing flow of the arithmetic device.
- FIG. 1 is a schematic block diagram of a detection system according to this embodiment.
- the detection system 1 includes a vehicle 10 , a measurement data acquisition device 12 and an arithmetic device 14 .
- the detection system 1 is a system that acquires vehicle behavior information of a vehicle 10 traveling on a road and position information of the vehicle 10 .
- the detection system 1 analyzes road surface conditions based on vehicle behavior information and position information.
- the road surface condition here may be, for example, at least one of IRI (International Roughness Index), road surface flatness, cracks, ruts, and MCI (Maintenance Control Index).
- the vehicle 10 detects vehicle behavior information and position information while traveling on a road, and transmits the detected vehicle behavior information and position information to the measurement data acquisition device 12 .
- the measurement data acquisition device 12 is, for example, a device (computer) managed by an entity that manages roads.
- the measurement data acquisition device 12 transmits the vehicle behavior information and position information transmitted from the vehicle 10 to the arithmetic device 14 .
- the calculation device 14 analyzes the road surface condition based on the vehicle behavior information and position information transmitted from the measurement data acquisition device 12 .
- the calculation device 14 then transmits the analysis result of the road surface condition to the measurement data acquisition device 12 . In this way, the arithmetic device 14 acquires vehicle behavior information and position information via the measurement data acquisition device 12, but is not limited to this.
- the detection system 1 may not be provided with the measurement data acquisition device 12 and the arithmetic device 14 may acquire the vehicle behavior information and the position information directly from the vehicle 10 .
- the vehicle behavior information and the position information are used for analyzing the road surface condition, but are not limited to this and may be used for any purpose.
- FIG. 2 is a schematic diagram of a vehicle.
- the vehicle 10 includes a position sensor 10A, a behavior sensor 10B, and a measuring device 10C.
- the position sensor 10A is a sensor that acquires position information of the vehicle 10 .
- the positional information of the vehicle 10 is information indicating the earth coordinates of the vehicle 10 .
- Position sensor 10A is a module for GNSS (Global Navigation Satellite System) in this embodiment. Note that the Z direction in FIG. 2 indicates upward in the vertical direction, and FIG. 2 can be said to be a schematic diagram when the vehicle 10 is viewed from above in the vertical direction.
- GNSS Global Navigation Satellite System
- the behavior sensor 10B is a sensor that detects vehicle behavior information that indicates the behavior of the vehicle 10.
- the vehicle behavior information may be any information that indicates the behavior of the vehicle 10 traveling on the road, but preferably includes at least acceleration information of the vehicle 10 in the present embodiment.
- the behavior sensor 10B is an acceleration sensor that detects acceleration, more preferably an acceleration sensor that detects acceleration on three axes.
- the vehicle behavior information is not limited to acceleration. It may be at least one of ten suspension actuation quantities.
- the behavior sensor 10B that detects the speed of the vehicle 10 is, for example, a speed sensor, the behavior sensor 10B that detects the speed of the vehicle 10 is, for example, a three-axis gyro sensor, and the behavior sensor 10B that detects the steering angle of the vehicle 10 is, for example, a steering wheel.
- the behavior sensor 10B that detects the amount of braking of the vehicle 10 is, for example, a brake sensor, and the behavior sensor 10B that detects the operation of the wipers of the vehicle 10 is, for example, a wiper sensor, and detects the amount of operation of the suspension of the vehicle 10.
- the behavior sensor 10B may be a suspension sensor.
- the number and types of behavior sensors 10B are arbitrary, and are mounted according to vehicle behavior information to be detected.
- the measuring device 10C is a device that controls the position sensor 10A and the behavior sensor 10B to detect position information and vehicle behavior information of the vehicle 10, and records the detected position information and vehicle behavior information. That is, the measuring device 10C functions as a data logger that records the position information and vehicle behavior information of the vehicle 10.
- FIG. The measuring device 10C can also be said to be a computer, and includes a control section 10C1, a storage section 10C2, and a communication section 10C3.
- the control unit 10C1 is an arithmetic unit, that is, a CPU (Central Processing Unit).
- the storage unit 10C2 is a memory that stores various kinds of information such as the calculation contents and programs of the control unit 10C1, the position information of the vehicle 10, and the vehicle behavior information.
- the communication unit 10C3 is a communication module that communicates with an external device, such as an antenna.
- the control unit 10C1 reads the program stored in the storage unit 10C2 and controls the position sensor 10A and the behavior sensor 10B.
- Control unit 10C1 causes behavior sensor 10B to detect vehicle behavior information of vehicle 10 at first predetermined time intervals while vehicle 10 is traveling on the road.
- control unit 10C1 causes position sensor 10A to detect the position information of vehicle 10 every second predetermined time while vehicle 10 is traveling on the road.
- the lengths of the first predetermined time and the second predetermined time may be set arbitrarily, but in the present embodiment, the first predetermined time is shorter than the second predetermined time. In other words, in the present embodiment, the number of times vehicle behavior information is detected per unit time is greater than the number of times position information is detected per unit time.
- the timing at which the position information is detected preferably coincides with the timing at which the vehicle behavior information is detected. That is, when the position information and the vehicle behavior information are detected at a certain timing, only the vehicle behavior information is detected at the subsequent timing, and the position information and the vehicle behavior information are detected again at the subsequent timing.
- the control unit 10C1 transmits the vehicle behavior information and the position information to the measurement data acquisition device 12 via the communication unit 10C3.
- the measurement data acquisition device 12 transmits the vehicle behavior information and position information received from the vehicle 10 to the arithmetic device 14 . If the measurement data acquisition device 12 is not provided, the control section 10C1 may directly transmit the vehicle behavior information and the position information to the arithmetic device 14. FIG.
- the computing device 14 acquires vehicle behavior information and position information.
- the computing device 14 analyzes the road surface condition based on the vehicle behavior information.
- the arithmetic device 14 may acquire the analysis result of the road surface condition using an AI (Artificial Intelligence) model obtained by machine-learning the correspondence relationship between the behavior of the vehicle and the road surface condition.
- AI Artificial Intelligence
- the computing device 14 estimates the position of the vehicle 10 based on the vehicle behavior information, for example, when the position information of the vehicle 10 cannot be properly acquired by the position sensor 10A.
- the computing device 14 will be specifically described below.
- FIG. 3 is a schematic block diagram of an arithmetic unit.
- the computing device 14 is, for example, a computer, and includes a communication section 20, a storage section 22, and a control section 24.
- the communication unit 20 is a communication module that communicates with an external device, such as an antenna.
- the storage unit 22 is a memory that stores various information such as the calculation contents and programs of the control unit 24 and the AI model N to be described later. At least one of non-volatile storage devices is included. Note that the program for the control unit 24 and the AI model N stored in the storage unit 22 may be stored in a recording medium readable by the arithmetic device 14 .
- the control unit 24 is an arithmetic device and includes an arithmetic circuit such as a CPU (Central Processing Unit).
- the control unit 24 includes a detected position acquisition unit 30 , a vehicle behavior acquisition unit 32 , an estimated position acquisition unit 34 and a corrected position acquisition unit 36 .
- the control unit 24 reads and executes a program (software) from the storage unit 22 to implement a detected position acquisition unit 30, a vehicle behavior acquisition unit 32, an estimated position acquisition unit 34, and a corrected position acquisition unit 36, Execute those processes.
- the control unit 24 may execute these processes by one CPU, or may be provided with a plurality of CPUs and may execute the processes by the plurality of CPUs.
- at least a part of the detected position acquisition unit 30, the vehicle behavior acquisition unit 32, the estimated position acquisition unit 34, and the corrected position acquisition unit 36 may be realized by hardware.
- the detected position acquisition unit 30 acquires position information of the vehicle 10 detected by the position sensor 10A. Since the position information of the vehicle 10 is detected every second predetermined time, it can be said that the detected position acquisition unit 30 acquires the position information of the vehicle 10 every second predetermined time. Note that the detected position acquisition unit 30 acquires the position information of the vehicle 10 every second predetermined time from the measurement data acquisition device 12 via the communication unit 20 , but the position information may be acquired directly from the vehicle 10 .
- the position sensor 10A may not be able to detect the position information of the vehicle 10 appropriately.
- the detected position acquisition unit 30 acquires the position information of the vehicle 10 detected by the position sensor 10A during a period in which the position information of the vehicle 10 can be detected appropriately.
- the position information of the vehicle 10 may not be acquired.
- the position information of the vehicle 10 cannot be detected properly refers to a state in which the position information of the vehicle 10 is not detected, a state in which the accuracy of the detection result is lowered even if the position information can be detected, and the like.
- a state in which the accuracy of the detection result is degraded may refer to, for example, a case where the position indicated by the detected position information is separated from the position indicated by the most recent position information by an assumed predetermined distance or more. .
- the position information of the vehicle 10 detected by the position sensor 10A acquired by the detected position acquisition unit 30, that is, the detected value of the position information of the vehicle 10, will be appropriately referred to as detected position information.
- the vehicle behavior acquisition unit 32 acquires vehicle behavior information of the vehicle 10 detected by the behavior sensor 10B.
- the vehicle behavior acquisition unit 32 acquires vehicle behavior information of the vehicle 10 detected by the behavior sensor 10B via the communication unit 20, for example. Since the vehicle behavior information is detected every first predetermined time, it can be said that the vehicle behavior acquisition unit 32 acquires the vehicle behavior information every first predetermined time. Note that the vehicle behavior acquisition unit 32 acquires vehicle behavior information every first predetermined period of time from the measurement data acquisition device 12 via the communication unit 20 , but may also acquire the vehicle behavior information directly from the vehicle 10 .
- the estimated position acquisition unit 34 acquires estimated position information, which is an estimated value of the position information of the vehicle 10 , based on the vehicle behavior information of the vehicle 10 acquired by the vehicle behavior acquisition unit 32 .
- the estimated position information can be said to be the position (coordinates) of the vehicle 10 estimated from the vehicle behavior information.
- the estimated position information acquisition unit 34 calculates the estimated position information of the vehicle 10 during a period when the position sensor 10A cannot properly detect the position information of the vehicle 10.
- FIG. 4 is a schematic diagram illustrating an example of estimated position information.
- FIG. 4 shows an example of detected position information of the vehicle 10 at each timing.
- the X direction and Y direction in FIG. 4 correspond to the X axis and Y axis in plane rectangular coordinates.
- the section AR2 in which the position information of the vehicle 10 could not be detected appropriately is, for example, a section within a tunnel, but is not limited thereto. For example, since the position information of the vehicle 10 may not be detected appropriately even in the section immediately after exiting the tunnel, the section immediately after exiting the tunnel may be included in the section AR2.
- a period during which the position sensor 10A cannot properly detect the position information of the vehicle 10 is called a non-detection period.
- the timing at which the position information of the vehicle 10 is detected immediately before the non-detection period is defined as a first timing TA
- the timing at which the position information of the vehicle 10 is detected immediately after the non-detection period is defined as a first timing TA.
- the second timing TB is defined that the period between the first timing TA and the second timing TB after the first timing TA is the non-detection period.
- the estimated position information acquiring unit 34 calculates the estimated position information of the vehicle 10 at the timing (intermediate timing) at which the position information of the vehicle 10 should have been detected within the non-detection period.
- the estimated position information acquiring unit 34 calculates estimated position information at the timing during the non-detection period based on the vehicle behavior information and the detected position information at the first timing TA. In the example of FIG. 4, timing T1 immediately after the first timing TA (after the second predetermined period from the first timing TA), timing T2 immediately after the timing T1, timing T3 immediately after the timing T2, and timing T3 immediately after the timing T3.
- Timing T4 is the timing at which the position information of the vehicle 10 should have been detected within the non-detection period.
- the estimated position information acquisition unit 34 calculates estimated position information of the vehicle 10 at timings T1, T2, T3, and T4.
- the estimated position information acquisition unit 34 also calculates estimated position information of the vehicle 10 at the second timing TB for use in correcting the estimated position information, which will be described later.
- positions PDA and PDB indicate positions of the vehicle 10 detected by the position sensor 10A at the first timing TA and the second timing TB.
- Positions PE1, PE2, PE3, and PE4 indicate positions (estimated positions of the vehicle 10) indicated by the estimated position information of the vehicle 10 at timings T1, T2, T3, and T4.
- the position PEB indicates the position (estimated position of the vehicle 10) indicated by the estimated position information of the vehicle 10 at the second timing TB.
- the estimated position information acquiring unit 34 inputs the vehicle behavior information of the vehicle 10 to the AI model N that has machine-learned the correspondence relationship between the vehicle behavior information and the information about the position of the vehicle, thereby obtaining the estimated position information.
- the information about the position of the vehicle can be said to be information that can estimate the position of the vehicle, and in this embodiment, indicates the vehicle attitude (azimuth, pitch angle, roll angle) and speed.
- the arithmetic device 14 inputs known vehicle behavior information and known vehicle position information as teaching data to the AI model N before learning, and determines the correspondence between the vehicle behavior information and the vehicle position information. machine learning.
- the vehicle behavior information and vehicle position information used as teaching data may be obtained by any method, but may be data obtained when the vehicle travels on a test course, for example.
- the estimated position information acquisition unit 34 reads the machine-learned AI model N from the storage unit 22 and inputs the vehicle behavior information of the vehicle 10 acquired by the vehicle behavior acquisition unit 32 into the AI model N.
- vehicle behavior information of the vehicle 10 is input as input data, and information regarding the position of the vehicle 10 is output as an output value.
- the AI model N can be said to be a learned program that outputs information about the position of the vehicle when vehicle behavior information is input.
- the estimated position information acquisition unit 34 acquires estimated position information of the vehicle 10 from the information about the position of the vehicle 10 output by the AI model N.
- the estimated position information acquisition unit 34 obtains the time from the timing at which the estimated position information is to be calculated to the immediately preceding timing, and the information regarding the position of the vehicle 10 calculated by the AI model N (in this case, the direction, pitch angle, and roll of the vehicle). angle and speed), the relative position (relative coordinates) of the vehicle 10 at the timing at which the estimated position information is to be calculated is calculated with respect to the immediately preceding position of the vehicle 10 .
- the estimated position acquisition unit 34 acquires the position of the vehicle 10 at the timing at which the estimated position information is to be calculated based on the immediately preceding position of the vehicle 10 and the relative position of the vehicle 10 at the timing at which the estimated position information is to be calculated. calculated as the estimated position information of
- the estimated position information acquisition unit 34 acquires a predetermined time after the timing at which the estimated position information is to be calculated from the past timing, which is a timing that is a predetermined time before (past) the timing at which the estimated position information is to be calculated. It is preferable to input the vehicle behavior information detected at each timing up to the future timing, which is the future timing, into the AI model N to calculate the estimated position information of the vehicle 10 .
- the past timing may be arbitrarily set, but may be, for example, the timing at which the vehicle behavior information is detected a predetermined number of times before the timing at which the estimated position information is to be calculated.
- the future timing may be arbitrarily set, but may be, for example, the timing at which the vehicle behavior information is detected a predetermined number of times after the timing at which the estimated position information is desired to be calculated.
- the estimated position information acquisition unit 34 acquires the position from the past timing of the timing T1 (the timing before the timing T1 by a predetermined time) to the future timing of the timing T1 (the timing after the timing T1 by a predetermined time).
- the vehicle behavior information detected at each timing is input to the AI model N to obtain information on the position of the vehicle at timing T1.
- the estimated position information acquisition unit 34 determines the position of the vehicle 10 at the timing T1. Calculate the estimated position information at.
- the estimated position information acquisition unit 34 inputs the vehicle behavior information detected at each timing from the past timing of timing T2 to the future timing of timing T2 to the AI model N, and obtains information regarding the position of the vehicle at timing T2. to get The estimated position information acquiring unit 34 calculates estimated position information at timing T2 based on the position information (estimated position information) at timing T1 immediately before timing T2 and the information on the position of the vehicle at timing T2.
- the estimated position information at the timings T3, T4, and the second timing TB is also calculated by the same method as the estimated position information at the timing T2, so the explanation is omitted.
- the AI model N may be any type of model.
- the estimated position information acquisition unit 34 filters the vehicle behavior information detected by the behavior sensor 10B to reduce the number of vehicle behavior information, and the remaining vehicle behavior information is input to the AI model N. , or all of the vehicle behavior information detected by the behavior sensor 10B may be used as the vehicle behavior information to be input to the AI model N.
- the corrected position acquisition unit 36 corrects the estimated position information at the timing (intermediate timing) during the non-detection period based on the difference between the detected position information and the estimated position information at the second timing TB.
- the corrected position information at the timing of is calculated.
- the corrected positional information is a correction value of the positional information of the vehicle 10 .
- the corrected position acquisition unit 36 Based on the error between the detected value and the estimated value of the position information at the second timing TB, the corrected position acquisition unit 36 corrects the position information so as to reduce the error in the estimated value at the timing during the non-detection period. It can be said that the corrected position information is calculated.
- a method for calculating corrected position information in this embodiment will be specifically described below.
- FIG. 5 is a schematic diagram illustrating an example of corrected position information.
- the corrected position acquiring unit 36 calculates the position of the vehicle 10 at the second timing TB based on the position PDA of the vehicle 10 at the first timing TA (the position indicated by the detected position information at the first timing TA).
- An angle ⁇ between PDB (the position indicated by the detected position information at the second timing TB) and the position PEB of the vehicle 10 at the second timing TB (position indicated by the estimated position information at the second timing TB) is calculated. That is, it can be said that the corrected position acquiring unit 36 calculates the angle ⁇ between the position PDB and the position PEB in the polar coordinates with the position PDA as a reference.
- the angle ⁇ can also be said to be an angle formed by a straight line connecting the positions PDA and PDB and a straight line connecting the positions PDA and PEB.
- the angle ⁇ corresponds to the amount of angular deviation between the detected position and the estimated position at the second timing TB.
- the corrected position acquisition unit 36 calculates a distance ⁇ L indicating the amount of deviation between the detected position and the estimated position at the second timing TB. Specifically, the corrected position acquiring unit 36 calculates the position PDB1 by shifting the position PDB by an angle ⁇ in a direction toward the position PEB with respect to the position PDA. The corrected position acquisition unit 36 calculates the distance from the position PDB1 to the position PEB as the distance ⁇ L. That is, it can be said that the corrected position acquiring unit 36 calculates the distance ⁇ L between the position PDB1 and the position PEB in the polar coordinates with the position PDA as a reference.
- the corrected position acquisition unit 36 corrects the estimated position (estimated position information) of the vehicle 10 at the timing during the non-detection period based on the angle ⁇ and the distance ⁇ L, and obtains corrected estimation of the vehicle 10 at the timing during the non-detection period.
- a position (corrected position information) is calculated. More specifically, the corrected position acquisition unit 36 converts the angle ⁇ into a corrected angle ⁇ ′ (corrected angular deviation amount), which is the angular deviation amount at the timing when the corrected position information is to be calculated, and converts the distance ⁇ L into the corrected position It is converted into a corrected distance ⁇ L′ (corrected distance deviation amount), which is the distance deviation amount at the timing when the information is to be calculated.
- the corrected position acquisition unit 36 corrects the estimated position information of the timing during the non-detection period using the correction angle ⁇ ' and the correction distance ⁇ L', and calculates the corrected position information of the timing during the non-detection period.
- the corrected position obtaining unit 36 shifts the estimated position of the vehicle 10 at the timing during the non-detection period from the position PEB to the position PDB by the correction angle ⁇ ′ with reference to the position PDA.
- the position obtained by further shifting the shifted position by the correction distance ⁇ L′ in the direction toward the position PEB1 from the position PEB along the line connecting the position PDA and the shifted position is the corrected position (corrected position information) at that timing.
- a position shifted by ⁇ ' is shown as position PE3a.
- a position PC3 obtained by shifting the position PE3a from the position PEB toward the position PEB1 by the correction distance ⁇ L′ along the line connecting the positions PDA and PE3a is the position indicated by the correction position information at the timing T3.
- the corrected position acquisition unit 36 calculates the position PC3 indicated by the corrected position information using the polar coordinates with the position PDA as a reference, as in the following equation (1).
- the coordinates (vector) of the position PDA in equation (1) are zero because the position PDA is used as a reference.
- R3 in equation (1) is the distance from position PDA to position PE3a
- R( ⁇ ') is the rotation matrix.
- the formula (1) is an example in which the position PC3 is farther from the position PDA than the position PE3a.
- the formula (1 ) may be set to ⁇ (R3+ ⁇ L')/R3 ⁇ .
- the correction angle ⁇ ' may be calculated by any method based on the angle ⁇ , it may be calculated as follows in the present embodiment. That is, the angle ⁇ indicates the amount of angular deviation between the estimated position and the detected position when traveling from the first timing TA to the second timing TB. to the timing in the non-detection period, the corrected angle ⁇ ′ is calculated by converting the amount of angular deviation when traveling.
- the corrected position acquiring unit 36 corrects the angle ⁇ with the ratio of the time from the first timing TA to the timing in the non-detection period to the time from the first timing TA to the second timing TB, thereby obtaining the corrected angle ⁇ ′.
- the correction angle ⁇ ′ at the timing T3 is calculated by the following equation (2).
- the corrected position acquisition unit 36 calculates the length of the line connecting the position PDA to the position PDB via each estimated position in the non-detection period (estimated traveling distance from the position PDA to the position PDB),
- the corrected angle ⁇ ' may be calculated by correcting the angle ⁇ with the ratio of the length of the line connecting each estimated position to the position PE3 (estimated traveling distance from the position PDA to the position PE3).
- timing T3 when the estimated traveled distance from position PDA to position PDB is distance Wa, and the estimated traveled distance from position PDA to position PE3 is distance Wb, the correction angle ⁇ ' is given by the following equation ( 3) may be calculated.
- the correction distance ⁇ L' may be calculated by any method based on the distance ⁇ L, but in this embodiment it may be calculated as follows. That is, the corrected position acquiring unit 36 corrects the distance ⁇ L by the ratio of the time from the first timing TA to the timing in the non-detection period to the time from the first timing TA to the second timing TB. Calculate ⁇ L′. Taking the timing T3 as an example, it can be said that the corrected distance ⁇ L′ at the timing T3 is calculated by the following equation (4).
- the method of calculating the correction distance ⁇ L' is not limited to the above.
- the corrected position acquisition unit 36 calculates the length of the line connecting the position PDA to the position PDB via each estimated position in the non-detection period (estimated traveling distance from the position PDA to the position PDB),
- the corrected distance ⁇ L′ may be calculated by correcting the distance ⁇ L with the ratio of the length of the line connecting each estimated position to the position PE3 (estimated traveling distance from the position PDA to the position PE3).
- the correction distance ⁇ L' may be calculated as in the following equation (5).
- the corrected position information at the timing T3 has been described above as an example, the corrected position information at other timings in the non-detection period is also calculated in a similar manner.
- positions PC1, PC2, and PC4 indicated by the corrected position information at timings T1, T2, and T4 are also calculated.
- the method for calculating the corrected position information is not limited to the above.
- the estimated position information at the timing T3 is shifted by the correction angle ⁇ ′ and then shifted by the correction distance ⁇ L to calculate the corrected position information at the timing T3.
- the correction position information at the timing T3 may be calculated by shifting the correction angle ⁇ ′ later.
- the corrected position acquisition unit 36 obtains the estimated position of the vehicle 10 at the timing during the non-detection period, using the position PDA as a reference, along the line connecting the estimated position from the position PDA toward the position PDB from the position PEB.
- the position is shifted by a correction distance ⁇ L′ in the direction, and the shifted position is further shifted by a correction angle ⁇ ′ in the direction toward the position PDB from the position PEB, and the position is calculated as the correction position (correction position information) at that timing.
- the position PE3 at the timing T3 is shifted along the line connecting the positions PDA and PE3 by the correction distance ⁇ L′ toward the position PEB1 from the position PEB
- the position PC3 indicated by the correction position information at the timing T3 may be the position further shifted by the correction angle ⁇ ′ in the direction toward the position PDB from the position PEB.
- the corrected position acquisition unit 36 calculates the corrected position information in the non-detection period as described above.
- the detected position information of the vehicle 10 during a period other than the non-detection period that is, the period during which the position information can be appropriately detected
- the corrected position information of the vehicle 10 during the non-detection period are combined with the vehicle at each timing. 10 location information.
- the arithmetic device 14 calculates the road surface for each position of the road based on the detected position information of the vehicle 10 during a period other than the non-detection period, the corrected position information of the vehicle 10 during the non-detection period, and the vehicle behavior information at each timing. Analyze the state.
- the application of the detected position information and the corrected position information is not limited to analysis of road surface conditions.
- the arithmetic device 14 may output the detected position information and the corrected position information to an external device or to an output unit (such as a display) provided by itself.
- FIG. 6 is a flowchart for explaining the processing flow of the arithmetic device.
- the arithmetic unit 14 acquires the detected position information and the vehicle behavior information of the vehicle 10 by the detected position acquisition unit 30 and the vehicle behavior acquisition unit 32 (step S10).
- the arithmetic unit 14 inputs the vehicle behavior information to the AI model N through the estimated position acquisition unit 34 to acquire estimated position information of the vehicle 10 (step S12).
- the estimated position acquisition unit 34 inputs the vehicle behavior information at the timing of the non-detection period to the AI model N, and calculates the estimated position information at the timing of the non-detection period.
- the estimated position acquisition unit 34 inputs the vehicle behavior information at the second timing TB to the AI model N, and calculates the estimated position information at the second timing TB.
- the calculation device 14 calculates the angle ⁇ (angle deviation amount) and the distance ⁇ L (distance deviation amount) at the second timing by the corrected position acquisition unit 36 (step S14), and calculates the corrected angle ⁇ ′ at the timing of the non-detection period. (Corrected angular print amount) and corrected distance ⁇ L' are calculated (step S16).
- the arithmetic device 14 corrects the estimated position information at the timing of the non-detection period with the corrected angle ⁇ ′ and the corrected distance ⁇ L′ by the corrected position acquisition unit 36, and calculates the corrected position information at the timing of the non-detection period (step S18).
- the arithmetic device 14 includes the detected position acquisition section 30, the vehicle behavior acquisition section 32, the estimated position acquisition section 34, and the corrected position acquisition section .
- the detected position acquisition unit 30 acquires detected position information, which is a detected value of the position information of the vehicle 10 at the first timing TA, and detected position information at the second timing TB after the first timing TA.
- the vehicle behavior acquisition unit 32 acquires vehicle behavior information indicating behavior of the vehicle 10 .
- the estimated position acquisition unit 34 acquires estimated position information, which is an estimated value of the position information of the vehicle 10 at the second timing TB, based on the vehicle behavior information.
- the estimated position acquiring unit 34 acquires an intermediate timing between the first timing TA and the second timing TB (in this embodiment, during the non-detection period) based on the vehicle behavior information and the detected position information at the first timing TA. timing).
- the corrected position acquisition unit 36 corrects the estimated position information at the intermediate timing based on the difference between the detected position information and the estimated position information at the second timing TB, so that the position information of the vehicle 10 at the intermediate timing is corrected. Calculate some corrected position information.
- the arithmetic device 14 when estimating the position of the vehicle 10 at the intermediate timing, the estimated position information calculated based on the vehicle behavior information is replaced with the detected position information at the second timing TB, which is later than the intermediate timing. and the estimated position information. In this way, the arithmetic unit 14 according to the present embodiment corrects the estimated position using future data, so it is possible to reduce the estimation error of the vehicle position. That is, the arithmetic unit 14 of the present embodiment does not estimate the position of the vehicle 10 in real time using the data immediately before the timing at which the position is to be estimated.
- the position sensor 10A may not be able to properly detect the position of the vehicle 10 in some cases.
- the estimation error at the second timing in the future when the position detection can be properly performed is used to estimate the position of the vehicle 10 based on the vehicle behavior information. Since the position is corrected, the position of the vehicle 10 can be properly estimated during periods when the position detection cannot be performed properly.
- the corrected position acquisition unit 36 Based on the position PDA of the vehicle 10 indicated by the detected position information at the first timing TA, the corrected position acquisition unit 36 obtains the position PDB of the vehicle 10 indicated by the detected position information at the second timing TB and the estimated position information at the second timing TB. The angle ⁇ (angle deviation amount) between the position PEB of the vehicle 10 indicated by is calculated. The corrected position acquiring unit 36 calculates the distance ⁇ L (distance deviation amount) between the position PEB1 of the vehicle 10 and the position PEB when the position PEB of the vehicle 10 is shifted by the angle ⁇ .
- the corrected position acquisition unit 36 converts the angle ⁇ into a corrected angle ⁇ ′ (corrected angle deviation amount) indicating the angular deviation at the intermediate timing, and converts the distance ⁇ L into a corrected distance ⁇ L′ (corrected distance deviation amount).
- the corrected position acquisition unit 36 shifts the position of the vehicle 10 indicated by the estimated position information at the intermediate timing (for example, the position PE3) based on the position PDA, based on the corrected angle ⁇ ′ and the corrected distance ⁇ L′. Corrected position information (for example, position PC3) is calculated. According to the arithmetic unit 14, by correcting the estimated position in this way, the error in the estimated position can be reduced more appropriately.
- detection system 10 vehicle 10A position sensor 12 measurement data acquisition device 14 arithmetic device 30 detection position acquisition unit 32 vehicle behavior acquisition unit 34 estimated position acquisition unit 36 corrected position acquisition unit T1 first timing T2 second timing
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
車両位置の推定誤差を低減する。演算装置(14)は、第1タイミング(TA)における検出位置情報と、第2タイミング(TB)における検出位置情報とを取得する検出位置取得部と、車両挙動情報を取得する車両挙動取得部と、車両挙動情報に基づき、第2タイミング(TB)における車両の推定位置情報を取得し、車両挙動情報、及び第1タイミング(TA)における検出位置情報に基づき、第1タイミング(TA)と第2タイミング(TB)との間の中間タイミングにおける推定位置情報を取得する推定位置取得部と、第2タイミング(TB)における検出位置情報と推定位置情報との差異に基づいて、中間タイミングにおける推定位置情報を補正することで、中間タイミングにおける車両(10)の位置情報の補正値である補正位置情報を算出する補正位置取得部と、を含む。
Description
本発明は、演算装置に関する。
外界センサからの情報が途絶した場合に、車両の位置推定を推定する技術が知られている。例えば特許文献1には、外界センサからの情報が途絶した場合に、IMU(Inertial Measurement Unit)により検出した車両の加速度などに基づいて、車両の位置を推定する旨が記載されている。
このように車両の位置を推定する際には、車両位置の推定誤差を低減することが求められている。
本発明は、上記に鑑みてなされたものであって、車両位置の推定誤差を低減可能な演算装置を提供することを目的とする。
上述した課題を解決し、目的を達成するために、本開示に係る演算装置は、第1タイミングにおける、車両の位置情報の検出値である検出位置情報と、前記第1タイミングより後の第2タイミングにおける検出位置情報とを取得する検出位置取得部と、前記車両の挙動を示す車両挙動情報を取得する車両挙動取得部と、前記車両挙動情報に基づき、前記第2タイミングにおける前記車両の位置情報の推定値である推定位置情報を取得し、前記車両挙動情報、及び前記第1タイミングにおける検出位置情報に基づき、前記第1タイミングと前記第2タイミングとの間の中間タイミングにおける推定位置情報を取得する推定位置取得部と、前記第2タイミングにおける検出位置情報と推定位置情報との差異に基づいて、前記中間タイミングにおける推定位置情報を補正することで、前記中間タイミングにおける前記車両の位置情報の補正値である補正位置情報を算出する補正位置取得部と、を含む。
本発明によれば、車両位置の推定誤差を低減することができる。
以下に、本発明の好適な実施形態を図面に基づいて詳細に説明する。なお、以下に説明する実施形態により本発明が限定されるものではない。
(検出システム)
図1は、本実施形態に係る検出システムの模式的なブロック図である。図1に示すように、本実施形態に係る検出システム1は、車両10と、測定データ取得装置12と、演算装置14とを含む。検出システム1は、道路を走行する車両10の車両挙動情報と車両10の位置情報とを取得するシステムである。本実施形態では、検出システム1は、車両挙動情報と位置情報とに基づき、道路の路面状態を分析する。ここでの路面状態は、例えば、IRI(International Roughness Index;国際ラフネス指数)、路面の平たん性、ひび割れ、わだち掘れ、及びMCI(Meintenance Control Index)の少なくとも1つであってもよい。
図1は、本実施形態に係る検出システムの模式的なブロック図である。図1に示すように、本実施形態に係る検出システム1は、車両10と、測定データ取得装置12と、演算装置14とを含む。検出システム1は、道路を走行する車両10の車両挙動情報と車両10の位置情報とを取得するシステムである。本実施形態では、検出システム1は、車両挙動情報と位置情報とに基づき、道路の路面状態を分析する。ここでの路面状態は、例えば、IRI(International Roughness Index;国際ラフネス指数)、路面の平たん性、ひび割れ、わだち掘れ、及びMCI(Meintenance Control Index)の少なくとも1つであってもよい。
検出システム1においては、車両10が、道路を走行しながら車両挙動情報及び位置情報を検出し、検出した車両挙動情報及び位置情報を測定データ取得装置12に送信する。測定データ取得装置12は、例えば道路を管理する主体に管理される装置(コンピュータ)である。測定データ取得装置12は、車両10から送信された車両挙動情報及び位置情報を、演算装置14に送信する。演算装置14は、測定データ取得装置12から送信された車両挙動情報及び位置情報に基づき、道路の路面状態を分析する。そして、演算装置14は、路面状態の分析結果を、測定データ取得装置12に送信する。このように、演算装置14は、測定データ取得装置12を介して車両挙動情報及び位置情報を取得するが、それに限られない。例えば、検出システム1は、測定データ取得装置12が設けられておらず、演算装置14が、車両10から直接車両挙動情報及び位置情報を取得してもよい。また本実施形態では、車両挙動情報と位置情報は、道路の路面状態の分析に用いられるが、それに限られず、任意の用途に用いられてよい。
(車両)
図2は、車両の模式図である。図2に示すように、車両10は、位置センサ10Aと、挙動センサ10Bと、測定装置10Cとを備える。位置センサ10Aは、車両10の位置情報を取得するセンサである。車両10の位置情報とは、車両10の地球座標を示す情報である。位置センサ10Aは、本実施形態ではGNSS(Global Navivation Satelite System)用のモジュールである。なお、図2におけるZ方向は、鉛直方向の上方を指し、図2は鉛直方向上方から車両10を見た場合の模式図といえる。
図2は、車両の模式図である。図2に示すように、車両10は、位置センサ10Aと、挙動センサ10Bと、測定装置10Cとを備える。位置センサ10Aは、車両10の位置情報を取得するセンサである。車両10の位置情報とは、車両10の地球座標を示す情報である。位置センサ10Aは、本実施形態ではGNSS(Global Navivation Satelite System)用のモジュールである。なお、図2におけるZ方向は、鉛直方向の上方を指し、図2は鉛直方向上方から車両10を見た場合の模式図といえる。
挙動センサ10Bは、車両10の挙動を示す車両挙動情報を検出するセンサである。車両挙動情報は、道路を走行中の車両10の挙動を示す情報であれば任意であってよいが、本実施形態では、少なくとも車両10の加速度の情報を含むことが好ましい。この場合、挙動センサ10Bは、加速度を検出する加速度センサであり、より好ましくは3軸での加速度を検出する加速度センサである。また、車両挙動情報は、加速度であることに限られず、例えば、加速度、車両10の速度、車両10の角速度、車両10のステアリング角度、車両10のブレーキ量、車両10のワイパの動作、及び車両10のサスペンションの作動量の少なくとも1つであってよい。車両10の速度を検出する挙動センサ10Bは例えば速度センサであり、車両10の速度を検出する挙動センサ10Bは例えば3軸ジャイロセンサであり、車両10のステアリング角度を検出する挙動センサ10Bは例えばステアリングセンサであり、車両10のブレーキ量を検出する挙動センサ10Bは例えばブレーキセンサであり、車両10のワイパの動作を検出する挙動センサ10Bは例えばワイパセンサが挙げられ、車両10のサスペンションの作動量を検出する挙動センサ10Bは例えばサスペンションセンサが挙げられる。挙動センサ10Bの数及び種類は任意であり、検出する車両挙動情報に応じて搭載される。
測定装置10Cは、位置センサ10A及び挙動センサ10Bを制御して車両10の位置情報と車両挙動情報を検出させて、検出させた位置情報と車両挙動情報とを記録する装置である。すなわち、測定装置10Cは、車両10の位置情報と車両挙動情報とを記録するデータロガーとして機能する。測定装置10Cは、コンピュータであるとも言え、制御部10C1と、記憶部10C2と、通信部10C3とを含む。制御部10C1は、演算装置、すなわちCPU(Central Processing Unit)である。記憶部10C2は、制御部10C1の演算内容やプログラム、車両10の位置情報及び車両挙動情報などの各種情報を記憶するメモリであり、例えば、RAM(Random Access Memory)と、ROM(Read Only Memory)のような主記憶装置と、フラッシュメモリやHDD(Hard Disk Drive)などの不揮発性の記憶装置のうち、少なくとも1つ含む。なお、記憶部10C2が保存する制御部10C1用のプログラムは、測定装置10Cが読み取り可能な記録媒体に記憶されていてもよい。通信部10C3は、外部の装置と通信を行う通信モジュールであり、例えばアンテナなどである。
制御部10C1は、記憶部10C2に記憶されたプログラムを読み出して、位置センサ10A及び挙動センサ10Bの制御を実行する。制御部10C1は、車両10が道路を走行中に、第1所定時間ごとに、挙動センサ10Bに車両10の車両挙動情報を検出させる。また、制御部10C1は、車両10が道路を走行中に、第2所定時間ごとに、位置センサ10Aに車両10の位置情報を検出させる。第1所定時間及び第2所定時間の長さは任意に設定されてよいが、本実施形態では、第2所定時間よりも第1所定時間の方が短くなっている。言い換えれば、本実施形態では、単位時間当たりの車両挙動情報の検出回数が、単位時間当たりの位置情報の検出回数よりも多い。なお、位置情報が検出されるタイミングは、車両挙動情報が検出されるタイミングに重なっていることが好ましい。すなわち、あるタイミングで位置情報及び車両挙動情報が検出されたら、その後のタイミングでは車両挙動情報のみが検出され、その後のタイミングで、位置情報及び車両挙動情報が、再度検出される。
制御部10C1は、車両挙動情報と位置情報とを、通信部10C3を介して、測定データ取得装置12に送信する。測定データ取得装置12は、車両10から受信した車両挙動情報と位置情報とを、演算装置14に送信する。なお、測定データ取得装置12を設けない場合は、制御部10C1は、車両挙動情報と位置情報とを、演算装置14に直接送信してもよい。
(演算装置)
演算装置14は、車両挙動情報と位置情報とを取得する。演算装置14は、車両挙動情報に基づき、道路の路面状態を分析する。例えば、演算装置14は、車両の挙動と路面状態との対応関係を機械学習したAI(Artificial Intelligence)モデルを用いて、道路の路面状態の分析結果を取得してよい。
演算装置14は、車両挙動情報と位置情報とを取得する。演算装置14は、車両挙動情報に基づき、道路の路面状態を分析する。例えば、演算装置14は、車両の挙動と路面状態との対応関係を機械学習したAI(Artificial Intelligence)モデルを用いて、道路の路面状態の分析結果を取得してよい。
ここで、車両10が走行した位置における路面状態を分析する場合などにおいては、車両10が走行した位置を特定する必要がある。また、路面状態の分析の用途以外にも、車両10の位置の情報を用いる場合もある。車両10の位置は、位置センサ10Aによって検出されるが、例えば車両10がトンネル内を走行している場合などにおいては、位置センサ10Aによって車両10の位置情報を適切に取得できないことが想定される。そのため、本実施形態に係る演算装置14は、例えば位置センサ10Aによって車両10の位置情報を適切に取得できない場合などに、車両挙動情報に基づき、車両10の位置を推定する。以下、演算装置14について具体的に説明する。
図3は、演算装置の模式的なブロック図である。図3に示すように、演算装置14は、例えばコンピュータであり、通信部20と、記憶部22と、制御部24とを含む。通信部20は、外部の装置と通信を行う通信モジュールであり、例えばアンテナなどである。記憶部22は、制御部24の演算内容やプログラム、後述するAIモデルNなどの各種情報を記憶するメモリであり、例えば、RAMと、ROMのような主記憶装置と、フラッシュメモリやHDDなどの不揮発性の記憶装置のうち、少なくとも1つ含む。なお、記憶部22が保存する制御部24用のプログラムやAIモデルNは、演算装置14が読み取り可能な記録媒体に記憶されていてもよい。
制御部24は、演算装置であり、例えばCPU(Central Processing Unit)などの演算回路を含む。制御部24は、検出位置取得部30と、車両挙動取得部32と、推定位置取得部34と、補正位置取得部36とを含む。制御部24は、記憶部22からプログラム(ソフトウェア)を読み出して実行することで、検出位置取得部30と車両挙動取得部32と推定位置取得部34と補正位置取得部36とを実現して、それらの処理を実行する。なお、制御部24は、1つのCPUによってこれらの処理を実行してもよいし、複数のCPUを備えて、それらの複数のCPUで、処理を実行してもよい。また、検出位置取得部30と車両挙動取得部32と推定位置取得部34と補正位置取得部36との少なくとも一部を、ハードウェアで実現してもよい。
(検出位置取得部)
検出位置取得部30は、位置センサ10Aによって検出された車両10の位置情報を取得する。車両10の位置情報は、第2所定時間ごとに検出されるため、検出位置取得部30は、第2所定時間ごとの車両10の位置情報を取得するといえる。なお、検出位置取得部30は、通信部20を介して、測定データ取得装置12から、第2所定時間ごとの車両10の位置情報を取得するが、車両10から直接取得してもよい。
検出位置取得部30は、位置センサ10Aによって検出された車両10の位置情報を取得する。車両10の位置情報は、第2所定時間ごとに検出されるため、検出位置取得部30は、第2所定時間ごとの車両10の位置情報を取得するといえる。なお、検出位置取得部30は、通信部20を介して、測定データ取得装置12から、第2所定時間ごとの車両10の位置情報を取得するが、車両10から直接取得してもよい。
上述のように、位置センサ10Aが車両10の位置情報を適切に検出できない場合もある。検出位置取得部30は、車両10の位置情報を適切に検出できる期間における、位置センサ10Aが検出した車両10の位置情報を取得するものであり、車両10の位置情報を適切に検出できない期間における車両10の位置情報については、取得しなくてもよい。なお、車両10の位置情報を適切に検出できないとは、車両10の位置情報が検出されない状態や、位置情報が検出できても検出結果の精度が低下している状態などを指す。検出結果の精度が低下している状態とは、例えば、検出された位置情報が示す位置が、直近の位置情報が示す位置に対して、想定される所定距離以上離れている場合を指してよい。
以下、検出位置取得部30が取得した、位置センサ10Aによって検出された車両10の位置情報を、すなわち車両10の位置情報の検出値を、適宜、検出位置情報と記載する。
(車両挙動取得部)
車両挙動取得部32は、挙動センサ10Bによって検出された車両10の車両挙動情報を取得する。車両挙動取得部32は、例えば通信部20を介して、挙動センサ10Bによって検出された車両10の車両挙動情報を取得する。車両挙動情報は、第1所定時間ごとに検出されるため、車両挙動取得部32は、第1所定時間ごとの車両挙動情報を取得するといえる。なお、車両挙動取得部32は、通信部20を介して、測定データ取得装置12から、第1所定時間ごとの車両挙動情報を取得するが、車両10から直接取得してもよい。
車両挙動取得部32は、挙動センサ10Bによって検出された車両10の車両挙動情報を取得する。車両挙動取得部32は、例えば通信部20を介して、挙動センサ10Bによって検出された車両10の車両挙動情報を取得する。車両挙動情報は、第1所定時間ごとに検出されるため、車両挙動取得部32は、第1所定時間ごとの車両挙動情報を取得するといえる。なお、車両挙動取得部32は、通信部20を介して、測定データ取得装置12から、第1所定時間ごとの車両挙動情報を取得するが、車両10から直接取得してもよい。
(推定位置取得部)
推定位置取得部34は、車両挙動取得部32が取得した車両10の車両挙動情報に基づき、車両10の位置情報の推定値である推定位置情報を取得する。推定位置情報は、車両挙動情報から推定した車両10の位置(座標)といえる。
推定位置取得部34は、車両挙動取得部32が取得した車両10の車両挙動情報に基づき、車両10の位置情報の推定値である推定位置情報を取得する。推定位置情報は、車両挙動情報から推定した車両10の位置(座標)といえる。
推定位置情報取得部34は、位置センサ10Aが車両10の位置情報を適切に検出できない期間における、車両10の推定位置情報を算出する。図4は、推定位置情報の一例を説明する模式図である。図4は、各タイミングにおける車両10の検出位置情報の例を示している。図4のX方向、Y方向は、平面直角座標におけるX軸及びY軸に相当する。以降では、車両10が、区間AR1から区間AR2を経て区間AR3まで走行し、区間AR1、AR3においては、位置センサ10Aが車両10の位置情報を適切に検出でき、区間AR2においては、位置センサ10Aが車両10の位置情報を適切に検出できなかったことを例にして説明する。車両10の位置情報を適切に検出できなかった区間AR2は、例えばトンネル内の区間であるが、それに限られない。例えば、トンネルを出た直後の区間においても、車両10の位置情報を適切に検出できない場合もあるため、トンネルを出た直後の区間なども、区間AR2に含まれてよい。
ここで、位置センサ10Aが車両10の位置情報を適切に検出できない期間を、非検出期間とする。また、図4に示すように、非検出期間の直前に車両10の位置情報が検出されたタイミングを、第1タイミングTAとし、非検出期間の直後に車両10の位置情報が検出されたタイミングを、第2タイミングTBとする。すなわち、第1タイミングTAと、第1タイミングTAより後の第2タイミングTBとの間の期間が、非検出期間であるといえる。推定位置情報取得部34は、非検出期間内の、車両10の位置情報が検出されるはずたったタイミング(中間タイミング)における、車両10の推定位置情報を算出する。推定位置情報取得部34は、車両挙動情報と、第1タイミングTAにおける検出位置情報とに基づき、非検出期間中のタイミングにおける推定位置情報を算出する。図4の例では、第1タイミングTAの直後(第1タイミングTAから第2所定期間後)のタイミングT1、タイミングT1の直後のタイミングT2、タイミングT2の直後のタイミングT3、及びタイミングT3の直後のタイミングT4が、非検出期間内の、車両10の位置情報が検出されるはずたったタイミングである。従って、推定位置情報取得部34は、タイミングT1、T2、T3、T4における車両10の推定位置情報を算出する。また、推定位置情報取得部34は、後述する推定位置情報の補正に用いるために、第2タイミングTBにおける車両10の推定位置情報も算出する。図4の例では、位置PDA、PDBが、第1タイミングTA、第2タイミングTBにおいて位置センサ10Aが検出した車両10の位置を指す。また、位置PE1、PE2、PE3、PE4が、タイミングT1、T2、T3、T4における車両10の推定位置情報が示す位置(車両10の推定位置)を指す。また、位置PEBが、第2タイミングTBにおける車両10の推定位置情報が示す位置(車両10の推定位置)を指す。
本実施形態では、推定位置情報取得部34は、車両挙動情報と車両の位置に関する情報との対応関係を機械学習したAIモデルNに、車両10の車両挙動情報を入力することで、推定位置情報を取得する。車両の位置に関する情報とは、車両の位置を推定可能な情報といえ、本実施形態では、車両姿勢(方位角、ピッチ角、ロール角)及び速度を指す。演算装置14は、既知の車両挙動情報と、既知の車両の位置に関する情報とを、教師データとして学習前のAIモデルNに入力して、車両挙動情報と車両の位置に関する情報との対応関係を機械学習させる。教師データとして用いる車両挙動情報及び車両の位置に関する情報は、任意の方法で取得されたものであってよいが、例えば車両がテストコースを走行した際のデータを用いてよい。
推定位置情報取得部34は、機械学習済みのAIモデルNを記憶部22から読み出し、車両挙動取得部32が取得した車両10の車両挙動情報をAIモデルNに入力する。AIモデルNにおいては、車両10の車両挙動情報が入力データとして入力されて、車両10の位置に関する情報が、出力値として出力される。すなわち、AIモデルNは、車両挙動情報が入力されると車両の位置に関する情報が出力される学習済みのプログラムであるともいえる。推定位置情報取得部34は、AIモデルNが出力した車両10の位置に関する情報から、車両10の推定位置情報を取得する。例えば、推定位置情報取得部34は、あるタイミングにおける車両10の推定位置情報を取得する際には、AIモデルNが出力したそのタイミングにおける車両10の位置に関する情報と、そのタイミングの直前における車両10の位置情報とに基づき、そのタイミングにおける車両10の推定位置情報を算出する。すなわち、推定位置情報取得部34は、推定位置情報を算出したいタイミングから直前のタイミングまでの時間と、AIモデルNによって算出された車両10の位置に関する情報(ここでは車両の向き、ピッチ角、ロール角、及び速度)とに基づき、直前における車両10の位置に対する、推定位置情報を算出したいタイミングにおける車両10の相対位置(相対座標)を算出する。そして、推定位置取得部34は、直前における車両10の位置と、推定位置情報を算出したいタイミングにおける車両10の相対位置とに基づき、推定位置情報を算出したいタイミングにおける車両10の位置を、車両10の推定位置情報として算出する。
より詳しくは、推定位置情報取得部34は、推定位置情報を算出したいタイミングよりも所定時間だけ前(過去)のタイミングである過去タイミングから、推定位置情報を算出したいタイミングよりも所定時間だけ後(未来)のタイミングである未来タイミングまでの各タイミングで検出された車両挙動情報を、AIモデルNに入力して、車両10の推定位置情報を算出することが好ましい。過去タイミングは、任意に設定されてよいが、例えば、推定位置情報を算出したいタイミングよりも所定回数だけ前に車両挙動情報が検出されたタイミングとしてよい。同様に、未来タイミングは、任意に設定されてよいが、例えば、推定位置情報を算出したいタイミングよりも所定回数だけ後に車両挙動情報が検出されたタイミングとしてよい。
図4の例では、推定位置情報取得部34は、タイミングT1の過去タイミング(タイミングT1よりも所定時間前のタイミング)から、タイミングT1の未来タイミング(タイミングT1よりも所定時間後のタイミング)までの各タイミングで検出された車両挙動情報を、AIモデルNに入力して、タイミングT1における車両の位置に関する情報を取得する。推定位置情報取得部34は、タイミングT1の直前に車両10の位置情報が検出された第1タイミングTAにおける位置情報(検出位置情報)と、タイミングT1における車両の位置に関する情報とに基づき、タイミングT1における推定位置情報を算出する。また、推定位置情報取得部34は、タイミングT2の過去タイミングからタイミングT2の未来タイミングまでの各タイミングで検出された車両挙動情報を、AIモデルNに入力して、タイミングT2における車両の位置に関する情報を取得する。推定位置情報取得部34は、タイミングT2の直前のタイミングT1における位置情報(推定位置情報)と、タイミングT2における車両の位置に関する情報とに基づき、タイミングT2における推定位置情報を算出する。タイミングT3、T4、及び第2タイミングTBにおける推定位置情報も、タイミングT2の推定位置情報と同様の方法で算出されるため、説明を省略する。
なお、AIモデルNは、任意の種類のモデルであってよい。また、推定位置情報取得部34は、例えば、挙動センサ10Bによって検出された車両挙動情報をフィルタリングして車両挙動情報の数を減らし、残った車両挙動情報を、AIモデルNに入力する車両挙動情報として用いてもよいし、挙動センサ10Bによって検出された車両挙動情報の全てを、AIモデルNに入力する車両挙動情報として用いてもよい。
(補正位置取得部)
補正位置取得部36は、第2タイミングTBにおける検出位置情報と推定位置情報との差異に基づいて、非検出期間中のタイミング(中間タイミング)における推定位置情報を補正することで、非検出期間中のタイミングにおける補正位置情報を算出する。補正位置情報は、車両10の位置情報の補正値である。補正位置取得部36は、第2タイミングTBでの位置情報の検出値と推定値との誤差に基づいて、非検出期間中のタイミングにおける位置の推定値の誤差を低減するように補正して、補正位置情報を算出するといえる。以下、本実施形態における補正位置情報の算出方法を、具体的に説明する。
補正位置取得部36は、第2タイミングTBにおける検出位置情報と推定位置情報との差異に基づいて、非検出期間中のタイミング(中間タイミング)における推定位置情報を補正することで、非検出期間中のタイミングにおける補正位置情報を算出する。補正位置情報は、車両10の位置情報の補正値である。補正位置取得部36は、第2タイミングTBでの位置情報の検出値と推定値との誤差に基づいて、非検出期間中のタイミングにおける位置の推定値の誤差を低減するように補正して、補正位置情報を算出するといえる。以下、本実施形態における補正位置情報の算出方法を、具体的に説明する。
図5は、補正位置情報の一例を説明する模式図である。図5に示すように、補正位置取得部36は、第1タイミングTAにおける車両10の位置PDA(第1タイミングTAにおける検出位置情報が示す位置)を基準として、第2タイミングTBにおける車両10の位置PDB(第2タイミングTBにおける検出位置情報が示す位置)と、第2タイミングTBにおける車両10の位置PEB(第2タイミングTBにおける推定位置情報が示す位置)とのなす角度θを算出する。すなわち、補正位置取得部36は、位置PDAを基準とする極座標における、位置PDBと位置PEBとのなす角度θを算出するといえる。角度θは、位置PDAと位置PDBとを結ぶ直線と、位置PDAと位置PEBとを結ぶ直線とのなす角度ともいえる。角度θは、第2タイミングTBにおける検出位置と推定位置との角度ずれ量に相当する。
また、補正位置取得部36は、第2タイミングTBにおける検出位置と推定位置との距離のずれ量を示す距離ΔLを算出する。具体的には、補正位置取得部36は、位置PDAを基準として、位置PDBを、位置PEB側に近づく方向に角度θだけずらした位置を、位置PDB1として算出する。補正位置取得部36は、位置PDB1から位置PEBまでの距離を、距離ΔLとして算出する。すなわち、補正位置取得部36は、位置PDAを基準とする極座標における、位置PDB1と位置PEBとの距離ΔLを算出するといえる。
補正位置取得部36は、角度θと距離ΔLとに基づき、非検出期間中のタイミングにおける車両10の推定位置(推定位置情報)を補正して、非検出期間中のタイミングにおける車両10の補正推定位置(補正位置情報)を算出する。より具体的には、補正位置取得部36は、角度θを、補正位置情報を算出したいタイミングにおける角度ずれ量である補正角度θ’(補正角度ずれ量)に換算し、距離ΔLを、補正位置情報を算出したいタイミングにおける距離ずれ量である補正距離ΔL’(補正距離ずれ量)に換算する。補正位置取得部36は、補正角度θ’及び補正距離ΔL’を用いて、非検出期間中のタイミングの推定位置情報を補正して、非検出期間中のタイミングの補正位置情報を算出する。
本実施形態では、補正位置取得部36は、位置PDAを基準として、非検出期間中のタイミングにおける車両10の推定位置を、位置PEBから位置PDBに向かう方向側に補正角度θ’だけずらし、そのずらした位置を、位置PDAとずらした位置とを結ぶ線に沿って、位置PEBから位置PEB1に向かう方向側に補正距離ΔL’だけ更にずらした位置を、そのタイミングにおける補正位置(補正位置情報)として算出する。タイミングT3を例とすると、図5に示すように、位置PDAを基準として、タイミングT3における位置PE3(タイミングT3における推定位置情報が示す位置)を、位置PEBから位置PDBに向かう方向側に補正角度θ’だけずらした位置が位置PE3aとして示されている。そして、位置PE3aを、位置PDAと位置PE3aとを結ぶ線に沿って、位置PEBから位置PEB1に向かう方向側に補正距離ΔL’だけずらした位置PC3が、タイミングT3における補正位置情報が示す位置として算出される。すなわち、補正位置取得部36は、位置PDAを基準とした極座標を用いて、次の式(1)のように、補正位置情報が示す位置PC3を算出するといえる。
なお、式(1)における位置PDAの座標(ベクトル)は、位置PDAを基準としているためゼロとなる。式(1)におけるR3は、位置PDAから位置PE3aまでの距離であり、R(θ’)は、回転行列である。また、式(1)は、位置PC3が、位置PE3aよりも位置PDAから離れた位置である場合の例であり、例えば位置PC3が、位置PE3aよりも位置PDAに近い場合には、式(1)の{(R3-ΔL’)/R3}を、{(R3+ΔL’)/R3}としてよい。
補正角度θ’は、角度θに基づき任意の方法で算出されてよいが、本実施形態では、次のように算出してよい。すなわち、角度θは、第1タイミングTAから第2タイミングTBまで走行した際の、推定位置と検出位置との角度ずれ量を示すため、補正位置取得部36は、角度θを、第1タイミングTAから非検出期間におけるタイミングまで走行した際の角度ずれ量に換算することで、補正角度θ’を算出する。補正位置取得部36は、第1タイミングTAから第2タイミングTBまでの時間に対する、第1タイミングTAから非検出期間におけるタイミングまでの時間の比率で、角度θを補正することで、補正角度θ’を算出する。タイミングT3を例にすると、タイミングT3における補正角度θ’は、次の式(2)のように算出されるといえる。
θ’=θ・(T3-TA)/(TB-TA) ・・・(2)
ただし、補正角度θ’の算出方法は、上記に限られない。例えば、補正位置取得部36は、位置PDAから非検出期間における各推定位置を経て位置PDBまでを結ぶ線の長さ(位置PDAから位置PDBまでの推定走行距離)に対する、位置PDAから非検出期間における各推定位置を経て位置PE3までを結ぶ線の長さ(位置PDAから位置PE3までの推定走行距離)の比率で、角度θを補正することで、補正角度θ’を算出してもよい。タイミングT3を例にすると、位置PDAから位置PDBまでの推定走行距離を距離Waとし、位置PDAから位置PE3までの推定走行距離を距離Wbとした場合に、補正角度θ’は、次の式(3)のように算出されてもよい。
θ’=θ・Wb/Wa ・・・(3)
同様に、補正距離ΔL’は、距離ΔLに基づき任意の方法で算出されてよいが、本実施形態では、次のように算出してよい。すなわち、補正位置取得部36は、第1タイミングTAから第2タイミングTBまでの時間に対する、第1タイミングTAから非検出期間におけるタイミングまでの時間の比率で、距離ΔLを補正することで、補正距離ΔL’を算出する。タイミングT3を例にすると、タイミングT3における補正距離ΔL’は、次の式(4)のように算出されるといえる。
ΔL’=ΔL・(T3-TA)/(TB-TA) ・・・(4)
ただし、補正距離ΔL’の算出方法は、上記に限られない。例えば、補正位置取得部36は、位置PDAから非検出期間における各推定位置を経て位置PDBまでを結ぶ線の長さ(位置PDAから位置PDBまでの推定走行距離)に対する、位置PDAから非検出期間における各推定位置を経て位置PE3までを結ぶ線の長さ(位置PDAから位置PE3までの推定走行距離)の比率で、距離ΔLを補正することで、補正距離ΔL’を算出してもよい。タイミングT3を例にした場合に、補正距離ΔL’は、次の式(5)のように算出されてもよい。
ΔL’=ΔL・Wb/Wa・・・(5)
以上では、タイミングT3における補正位置情報の算出を例にして説明したが、非検出期間における他のタイミングにおける補正位置情報も、同様の方法で算出される。図5の例では、タイミングT1、T2、T4における補正位置情報が示す位置PC1、PC2、PC4も算出されている。
なお、補正位置情報の算出方法は上記に限られない。例えば、上記では、タイミングT3における推定位置情報を、補正角度θ’だけずらし、その後補正距離ΔLずらすことで、タイミングT3における補正位置情報を算出していたが、それに限られず、補正距離ΔLずらした後に補正角度θ’ずらすことで、タイミングT3における補正位置情報を算出してもよい。この場合例えば、補正位置取得部36は、位置PDAを基準として、非検出期間中のタイミングにおける車両10の推定位置を、位置PDAからその推定位置を結ぶ線に沿って位置PEBから位置PDBに向かう方向側に補正距離ΔL’だけずらし、そのずらした位置を、位置PEBから位置PDBに向かう方向側に補正角度θ’だけさらにずらした位置を、そのタイミングにおける補正位置(補正位置情報)として算出してよい。タイミングT3を例とすると、位置PDAを基準として、タイミングT3における位置PE3を、位置PDAと位置PE3とを結ぶ線に沿って、位置PEBから位置PEB1に向かう方向側に補正距離ΔL’だけずらし、そのずらした位置を、位置PEBから位置PDBに向かう方向側に補正角度θ’だけさらにずらした位置を、タイミングT3における補正位置情報が示す位置PC3としてもよい。
補正位置取得部36は、以上のように、非検出期間における補正位置情報を算出する。本実施形態においては、非検出期間以外の期間(すなわち位置情報を適切に検出できた期間)における車両10の検出位置情報と、非検出期間における車両10の補正位置情報とを、各タイミングにおける車両10の位置情報として取り扱う。演算装置14は、非検出期間以外の期間における車両10の検出位置情報と、非検出期間における車両10の補正位置情報と、それぞれのタイミングにおける車両挙動情報とに基づいて、道路の位置毎の路面状態を分析する。ただし、検出位置情報と補正位置情報との用途は、道路の路面状態の分析に限られない。演算装置14は、これらの検出位置情報及び補正位置情報を、外部の装置に出力してもよいし、自身が備える出力部(ディスプレイなど)に出力してもよい。
(処理フロー)
以上説明した演算装置の処理フローを説明する。図6は、演算装置の処理フローを説明するフローチャートである。図6に示すように、演算装置14は、検出位置取得部30及び車両挙動取得部32により、車両10の検出位置情報と車両挙動情報とを取得する(ステップS10)。演算装置14は、推定位置取得部34により、車両挙動情報をAIモデルNに入力して、車両10の推定位置情報を取得する(ステップS12)。推定位置取得部34は、非検出期間のタイミングにおける車両挙動情報をAIモデルNに入力して、非検出期間のタイミングにおける推定位置情報を算出する。また、推定位置取得部34は、第2タイミングTBにおける車両挙動情報をAIモデルNに入力して、第2タイミングTBにおける推定位置情報を算出する。演算装置14は、補正位置取得部36により、第2タイミングにおける角度θ(角度ずれ量)と距離ΔL(距離ずれ量)とを算出し(ステップS14)、非検出期間のタイミングにおける補正角度θ’(補正角度刷れ量)と補正距離ΔL’とを算出する(ステップS16)。演算装置14は、補正位置取得部36により、非検出期間のタイミングにおける推定位置情報を、補正角度θ’及び補正距離ΔL’により補正して、非検出期間のタイミングにおける補正位置情報を算出する(ステップS18)。
以上説明した演算装置の処理フローを説明する。図6は、演算装置の処理フローを説明するフローチャートである。図6に示すように、演算装置14は、検出位置取得部30及び車両挙動取得部32により、車両10の検出位置情報と車両挙動情報とを取得する(ステップS10)。演算装置14は、推定位置取得部34により、車両挙動情報をAIモデルNに入力して、車両10の推定位置情報を取得する(ステップS12)。推定位置取得部34は、非検出期間のタイミングにおける車両挙動情報をAIモデルNに入力して、非検出期間のタイミングにおける推定位置情報を算出する。また、推定位置取得部34は、第2タイミングTBにおける車両挙動情報をAIモデルNに入力して、第2タイミングTBにおける推定位置情報を算出する。演算装置14は、補正位置取得部36により、第2タイミングにおける角度θ(角度ずれ量)と距離ΔL(距離ずれ量)とを算出し(ステップS14)、非検出期間のタイミングにおける補正角度θ’(補正角度刷れ量)と補正距離ΔL’とを算出する(ステップS16)。演算装置14は、補正位置取得部36により、非検出期間のタイミングにおける推定位置情報を、補正角度θ’及び補正距離ΔL’により補正して、非検出期間のタイミングにおける補正位置情報を算出する(ステップS18)。
(効果)
以上説明したように、本実施形態に係る演算装置14は、検出位置取得部30と、車両挙動取得部32と、推定位置取得部34と、補正位置取得部36とを含む。検出位置取得部30は、第1タイミングTAにおける、車両10の位置情報の検出値である検出位置情報と、第1タイミングTAより後の第2タイミングTBにおける検出位置情報とを取得する。車両挙動取得部32は、車両10の挙動を示す車両挙動情報を取得する。推定位置取得部34は、車両挙動情報に基づき、第2タイミングTBにおける車両10の位置情報の推定値である推定位置情報を取得する。また、推定位置取得部34は、車両挙動情報、及び第1タイミングTAにおける検出位置情報に基づき、第1タイミングTAと第2タイミングTBとの間の中間タイミング(本実施形態では非検出期間中のタイミング)における推定位置情報を取得する。補正位置取得部36は、第2タイミングTBにおける検出位置情報と推定位置情報との差異に基づいて、中間タイミングにおける推定位置情報を補正することで、中間タイミングにおける車両10の位置情報の補正値である補正位置情報を算出する。
以上説明したように、本実施形態に係る演算装置14は、検出位置取得部30と、車両挙動取得部32と、推定位置取得部34と、補正位置取得部36とを含む。検出位置取得部30は、第1タイミングTAにおける、車両10の位置情報の検出値である検出位置情報と、第1タイミングTAより後の第2タイミングTBにおける検出位置情報とを取得する。車両挙動取得部32は、車両10の挙動を示す車両挙動情報を取得する。推定位置取得部34は、車両挙動情報に基づき、第2タイミングTBにおける車両10の位置情報の推定値である推定位置情報を取得する。また、推定位置取得部34は、車両挙動情報、及び第1タイミングTAにおける検出位置情報に基づき、第1タイミングTAと第2タイミングTBとの間の中間タイミング(本実施形態では非検出期間中のタイミング)における推定位置情報を取得する。補正位置取得部36は、第2タイミングTBにおける検出位置情報と推定位置情報との差異に基づいて、中間タイミングにおける推定位置情報を補正することで、中間タイミングにおける車両10の位置情報の補正値である補正位置情報を算出する。
車両の位置を推定する際には、車両位置の推定誤差を低減することが求められている。本実施形態に係る演算装置14によると、中間タイミングにおける車両10の位置を推定するに際して、車両挙動情報に基づいて算出した推定位置情報を、中間タイミングよりも未来の第2タイミングTBにおける検出位置情報と推定位置情報との差異に基づき、補正する。このように、本実施形態に係る演算装置14は、未来のデータを使用して推定位置を補正するため、車両位置の推定誤差を低減することができる。すなわち、本実施形態の演算装置14は、位置推定を行いたいタイミングの直前のデータを用いてリアルタイムに車両10の位置推定を行うものではなく、一連の車両挙動情報を取り込んでから、位置推定を行いたいタイミングに対して未来のタイミングで取得されたデータも使用して演算を実行することで、車両位置の推定誤差を好適に低減することができる。特に、トンネルやトンネルを出た直後の区間AR2においては、位置センサ10Aによる車両10の位置検出が適切に実施できない場合がある。それに対して、位置検出が適切に実施できない期間においては、その期間よりも未来の位置検出が適切に実施できた第2タイミングにおける推定誤差を用いて、車両挙動情報に基づいて推定した車両10の位置を補正するため、位置検出が適切に実施できない期間における車両10の位置を適切に推定できる。
補正位置取得部36は、第1タイミングTAにおける検出位置情報が示す車両10の位置PDAを基準として、第2タイミングTBにおける検出位置情報が示す車両10の位置PDBと第2タイミングTBにおける推定位置情報が示す車両10の位置PEBとのなす角度θ(角度ずれ量)を算出する。補正位置取得部36は、車両10の位置PEBを角度θだけずらした際の車両10の位置PEB1と、位置PEBとの距離ΔL(距離ずれ量)を算出する。補正位置取得部36は、角度θを、中間タイミングにおける角度ずれを示す補正角度θ’(補正角度ずれ量)に換算し、距離ΔLを、中間タイミングにおける距離ずれを示す補正距離ΔL’(補正距離ずれ量)に換算する。補正位置取得部36は、位置PDAを基準として、中間タイミングにおける推定位置情報が示す車両10の位置(例えば位置PE3)を、補正角度θ’及び補正距離ΔL’に基づきずらすことで、中間タイミングにおける補正位置情報(例えば位置PC3)を算出する。演算装置14によると、このようにして推定位置を補正することで、推定位置の誤差をより適切に低減できる。
以上、本発明の実施形態及び実施例を説明したが、これら実施形態等の内容により実施形態が限定されるものではない。また、前述した構成要素には、当業者が容易に想定できるもの、実質的に同一のもの、いわゆる均等の範囲のものが含まれる。さらに、前述した構成要素は適宜組み合わせることが可能である。さらに、前述した実施形態等の要旨を逸脱しない範囲で構成要素の種々の省略、置換又は変更を行うことができる。
1 検出システム
10 車両
10A 位置センサ
12 測定データ取得装置
14 演算装置
30 検出位置取得部
32 車両挙動取得部
34 推定位置取得部
36 補正位置取得部
T1 第1タイミング
T2 第2タイミング
10 車両
10A 位置センサ
12 測定データ取得装置
14 演算装置
30 検出位置取得部
32 車両挙動取得部
34 推定位置取得部
36 補正位置取得部
T1 第1タイミング
T2 第2タイミング
Claims (3)
- 第1タイミングにおける、車両の位置情報の検出値である検出位置情報と、前記第1タイミングより後の第2タイミングにおける検出位置情報とを取得する検出位置取得部と、
前記車両の挙動を示す車両挙動情報を取得する車両挙動取得部と、
前記車両挙動情報に基づき、前記第2タイミングにおける前記車両の位置情報の推定値である推定位置情報を取得し、前記車両挙動情報、及び前記第1タイミングにおける検出位置情報に基づき、前記第1タイミングと前記第2タイミングとの間の中間タイミングにおける推定位置情報を取得する推定位置取得部と、
前記第2タイミングにおける検出位置情報と推定位置情報との差異に基づいて、前記中間タイミングにおける推定位置情報を補正することで、前記中間タイミングにおける前記車両の位置情報の補正値である補正位置情報を算出する補正位置取得部と、
を含む、
演算装置。 - 前記推定位置取得部は、車両の挙動と車両の位置に関する情報との対応関係を機械学習したAIモデルに、前記中間タイミングより前のタイミングから前記中間タイミングよりも後のタイミングまでの前記車両挙動情報を入力することで、前記中間タイミングにおける推定位置情報を取得する、請求項1に記載の演算装置。
- 前記補正位置取得部は、
前記第1タイミングにおける検出位置情報が示す前記車両の位置を基準として、前記第2タイミングにおける検出位置情報が示す前記車両の位置と前記第2タイミングにおける推定位置情報が示す前記車両の位置とのなす角度である角度ずれ量を算出し、
前記第2タイミングにおける推定位置情報が示す前記車両の位置を前記角度ずれ量だけずらした際の前記車両の位置と、前記第2タイミングにおける検出位置情報が示す前記車両の位置との距離である距離ずれ量を算出し、
前記角度ずれ量を、前記中間タイミングにおける角度ずれを示す補正角度ずれ量に換算し、前記距離ずれ量を、前記中間タイミングにおける距離ずれを示す補正距離ずれ量に換算し、
前記第1タイミングにおける検出位置情報が示す前記車両の位置を基準として、前記中間タイミングにおける推定位置情報が示す前記車両の位置を、前記補正角度ずれ量及び前記補正距離ずれ量に基づきずらすことで、前記中間タイミングにおける補正位置情報を算出する、請求項1又は請求項2に記載の演算装置。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021118196A JP7228629B2 (ja) | 2021-07-16 | 2021-07-16 | 演算装置 |
JP2021-118196 | 2021-07-16 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023286865A1 true WO2023286865A1 (ja) | 2023-01-19 |
Family
ID=84920347
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/027914 WO2023286865A1 (ja) | 2021-07-16 | 2022-07-15 | 演算装置 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7228629B2 (ja) |
WO (1) | WO2023286865A1 (ja) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018212294A1 (ja) * | 2017-05-19 | 2018-11-22 | パイオニア株式会社 | 自己位置推定装置、制御方法、プログラム及び記憶媒体 |
JP2021092508A (ja) * | 2019-12-12 | 2021-06-17 | 日産自動車株式会社 | 走行軌跡推定方法及び走行軌跡推定装置 |
-
2021
- 2021-07-16 JP JP2021118196A patent/JP7228629B2/ja active Active
-
2022
- 2022-07-15 WO PCT/JP2022/027914 patent/WO2023286865A1/ja active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018212294A1 (ja) * | 2017-05-19 | 2018-11-22 | パイオニア株式会社 | 自己位置推定装置、制御方法、プログラム及び記憶媒体 |
JP2021092508A (ja) * | 2019-12-12 | 2021-06-17 | 日産自動車株式会社 | 走行軌跡推定方法及び走行軌跡推定装置 |
Also Published As
Publication number | Publication date |
---|---|
JP2023013782A (ja) | 2023-01-26 |
JP7228629B2 (ja) | 2023-02-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2519803B1 (en) | Technique for calibrating dead reckoning positioning data | |
US9921065B2 (en) | Unit and method for improving positioning accuracy | |
US9753144B1 (en) | Bias and misalignment compensation for 6-DOF IMU using GNSS/INS data | |
US9183463B2 (en) | Orientation model for a sensor system | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航***的轨迹修正方法 | |
CN112798021B (zh) | 基于激光多普勒测速仪的惯导***行进间初始对准方法 | |
WO2022007602A1 (zh) | 确定车辆位置的方法和装置 | |
JP7113134B2 (ja) | 車両制御装置 | |
CN107076559B (zh) | 用于匹配导航***的方法和*** | |
JP5164645B2 (ja) | カルマンフィルタ処理における繰り返し演算制御方法及び装置 | |
CN108955671B (zh) | 一种基于磁偏角、磁倾角的卡尔曼滤波导航方法 | |
CN115060257A (zh) | 一种基于民用级惯性测量单元的车辆变道检测方法 | |
CN113074757B (zh) | 车载惯导安装误差角的标定方法 | |
CN107462242A (zh) | 车辆测速方法及其装置 | |
TWI405952B (zh) | 導航方法及具導航功能的電子裝置 | |
JP7028223B2 (ja) | 自己位置推定装置 | |
WO2023286865A1 (ja) | 演算装置 | |
CN115790613B (zh) | 一种视觉信息辅助的惯性/里程计组合导航方法及装置 | |
JP7206883B2 (ja) | ヨーレート補正装置 | |
CN116594000A (zh) | 基于位置观测的激光多普勒测速仪在线标定方法和装置 | |
CN112577513A (zh) | 一种状态量误差确定方法及车载终端 | |
US11543257B2 (en) | Navigation apparatus and operation method of navigation apparatus | |
CN113048987A (zh) | 一种车载导航***定位方法 | |
JP7503479B2 (ja) | 演算装置及びプログラム | |
CN112394190B (zh) | 角速度的确定方法及装置、存储介质、电子装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22842206 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 22842206 Country of ref document: EP Kind code of ref document: A1 |