Vehicle position estimation device and vehicle position estimation method
The vehicle position estimation device uses internal sensors and wireless communication with radio beacons to correct parameters for precise vehicle positioning, addressing inaccuracies in existing technologies and enhancing accuracy in estimating vehicle position and turning directions.
Patent Information
- Application Number
- JP2021090617
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-05-28
- Publication Date
- 2024-11-28
- Estimated Expiration
- 2041-05-28
AI Technical Summary
Existing vehicle position estimation technologies, such as dead reckoning and satellite positioning, face challenges in achieving high precision due to variations in vehicle specifications and the inability to accurately account for turning directions, leading to inaccuracies in estimating vehicle position on a map.
A vehicle position estimation device that utilizes internal sensors to calculate vehicle position and turning angles, combined with wireless communication to a radio beacon for precise position correction, adjusting parameters based on relative movement calculations to enhance accuracy.
Enables high-precision estimation of vehicle position, including two-dimensional turning directions, even in environments where external sensors are unavailable, ensuring accurate vehicle positioning for autonomous driving and driving assistance.
Smart Images

Figure 0007591463000001 
Figure 0007591463000002 
Figure 0007591463000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a vehicle position estimation device and a vehicle position estimation method for estimating the position of a moving object such as a vehicle from sensor information and the like. [Background technology]
[0002] Various technologies have been proposed to estimate the vehicle's position for a moving object such as a vehicle, including dead reckoning, which estimates the vehicle's position using internal sensors such as wheel speed, steering angle, and yaw rate, visual odometry, which uses video signals from cameras, etc., satellite positioning, which uses positioning satellites such as GPS, and technologies that estimate the vehicle's position by combining these technologies. Furthermore, technologies that use these technologies to control moving objects and assist the driver's driving operations, as well as autonomous driving technologies that drive moving objects automatically to their destinations, have been developed.
[0003] To realize such autonomous driving technology, it is necessary to estimate the vehicle's position with high accuracy on a map or a specific map, and if the accuracy is insufficient, autonomous driving or driving assistance cannot be performed. For example, dead reckoning is a technology that estimates the vehicle's position by accumulating the relative amount of movement using information from internal sensors such as wheel speed, steering angle, and yaw rate, but since this calculation uses vehicle specifications such as tire radius, tread length, and steering angle / curvature table, the vehicle specifications may differ from the actual values due to the tire condition (degree of wear, air pressure, etc.) and manufacturing variations, resulting in errors in the calculation of the vehicle's position.
[0004] The following prior art techniques are available as techniques for solving such dead reckoning problems: Patent Document 1 describes a vehicle travel distance calculation device that calculates a travel distance of a vehicle based on an output from a vehicle speed sensor that detects the speed of the vehicle and a distance coefficient, the vehicle travel distance calculation device comprising: a beacon transmitter that irradiates a signal to a predetermined area on the vehicle's travel path, and distance coefficient correction means that corrects the distance coefficient based on an estimated distance corresponding to the predetermined area obtained by a beacon receiver mounted on the vehicle passing through the predetermined area and an actual distance corresponding to the predetermined area (see claim 1). [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2003-28665 A Summary of the Invention [Problem to be solved by the invention]
[0006] The technology disclosed in Patent Document 1 makes it possible to calculate the travel distance by comparing the accurate distance between two beacons with the estimated distance. This makes it possible to improve the accuracy of the travel distance. However, since the amount of movement in the turning direction is not taken into account, it is difficult to estimate the vehicle's position on a plane such as a map with high accuracy.
[0007] The present invention has been made in consideration of the above-mentioned circumstances, and aims to provide a vehicle position estimation device and a vehicle position estimation method that can estimate the vehicle position with high accuracy, including not only the one-dimensional movement distance but also the two-dimensional turning direction. [Means for solving the problem]
[0008] A representative example of the invention disclosed in the present application is as follows: That is, a vehicle position estimation device having a vehicle position estimation unit that calculates a position of the vehicle based on an output of a sensor that detects a behavior of the vehicle, further comprising: a radio position estimation unit that communicates with a radio set installed at an arbitrary position to calculate a relative position between the vehicle and the radio set; and a position estimation parameter correction unit that corrects parameters used in the calculation of at least the position and turning angle information of the vehicle by the vehicle position estimation unit, wherein the position estimation parameter correction unit corrects the parameters by comparing an amount of movement of the vehicle calculated by the radio position estimation unit with an amount of movement of the vehicle calculated by the vehicle position estimation unit. Effect of the Invention
[0009] According to one aspect of the present invention, it is possible to perform highly accurate calculations of vehicle position and turning angle information, and therefore it is possible to estimate the vehicle position including the two-dimensional turning direction with high accuracy using only internal sensors. It is also possible to ensure the accuracy of vehicle position estimation even in situations where external sensors such as cameras and positioning satellites cannot be used.
[0010] Other objects, configurations and advantages than those mentioned above will become apparent from the following description of the embodiments. [Brief description of the drawings]
[0011] [Figure 1] 1 is a schematic configuration diagram of a vehicle position estimation device according to an embodiment of the present invention; [Diagram 2] 1 is a schematic configuration diagram of a vehicle control device according to an embodiment of the present invention; [Diagram 3] 1A and 1B are diagrams showing an example of a relative position calculation method using a wireless device, in which (a) is a diagram showing a case where there is one wireless device on the vehicle side, and (b) is a diagram showing a case where there are two wireless devices on the vehicle side. [Figure 4] FIG. 2 is a diagram showing an example of a structure of a wireless beacon in an embodiment of the present invention. [Diagram 5] 4 is a flowchart of an example of a vehicle position estimation process according to an embodiment of the present invention. [Figure 6] 10 is a flowchart of another example of the vehicle position estimation process in the embodiment of the present invention. [Figure 7] 4 is a flowchart illustrating an example of a driving assistance process according to an embodiment of the present invention. [Figure 8] 1A and 1B are diagrams showing an example of a method for calculating the direction of a vehicle using a wireless device, in which (a) is a diagram showing a case where the vehicle is traveling straight, and (b) is a diagram showing a case where the vehicle is turning. [Figure 9] 10A and 10B show another example of a method for calculating the direction of a vehicle using a wireless device, in which FIG. 10A shows a case where the vehicle is traveling straight, and FIG. 10B shows a case where the vehicle is turning. [Figure 10] FIG. 1 is a diagram showing an example of an application example of the present invention. [Figure 11] FIG. 13 is a diagram showing another example of an application of the present invention. [Figure 12] FIG. 1 illustrates an example of a method using multiple wireless beacons. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] Hereinafter, an embodiment of the present invention will be described with reference to the drawings.
[0013] 1 and 2 are schematic diagrams of a vehicle position estimation device according to an embodiment of the present invention and a vehicle control device equipped with a vehicle position estimation function by the vehicle position estimation device. The vehicle position estimation device (hereinafter, may be referred to as an estimation device) 100a and the vehicle control device (hereinafter, may be referred to as a control device) 200a illustrated in FIG. 1 and FIG. 2 are, for example, computers mounted on a vehicle (the vehicle itself) and estimating and controlling the position of the vehicle itself, and function as a radio position estimation unit 1, a vehicle position estimation unit 2, a position estimation parameter correction unit 3, a surrounding environment recognition unit 4, a vehicle position estimation unit 5, a map information storage unit 6, a user setting input unit 9, an HMI control unit 10, a traveling trajectory generation unit 7, and a vehicle control unit 8 by executing a program stored in a storage medium (not shown). Note that the radio position estimation unit 1, the vehicle position estimation unit 2, and the position estimation parameter correction unit 3 described in both FIG. 1 and FIG. 2 have equivalent functions.
[0014] The estimation device 100a is connected to a vehicle-side wireless device 102 provided in the vehicle itself, and the vehicle-side wireless device 102 is capable of transmitting and receiving information via wireless communication with a wireless device 101 installed outside the vehicle itself. The estimation device 100a is also connected to a transmission path such as a CAN (not shown) of the vehicle itself or a dedicated line, and receives vehicle information such as the vehicle speed, wheel speed, steering angle, and yaw rate of the vehicle itself via these transmission paths, and outputs calculated vehicle position information.
[0015] The control device 200a is connected to the steering device 111, driving device 112, braking device 113, and transmission device 114 of the host vehicle, as well as to the external environment recognition device 103, absolute position measurement device 104, sound generation device 115, and display device 116 provided in the host vehicle. The control device 200a is also connected to transmission paths such as the host vehicle's CAN (not shown) and dedicated lines, and vehicle information such as the host vehicle's speed, wheel speed, steering angle, yaw rate, and shift position, as well as user operation information such as switch input and touch panel input, are input via these transmission paths.
[0016] The wireless device 101 is a device installed at an arbitrary position outside the vehicle and capable of transmitting and receiving information wirelessly, such as a Bluetooth (registered trademark) beacon, an optical beacon, a radio wave beacon, etc. Each beacon and the vehicle-side wireless device 102 of the vehicle can transmit and receive information wirelessly, and exchange information related to the position and surrounding environment information, etc.
[0017] The vehicle-side wireless device 102 is a device capable of transmitting and receiving information via wireless communication with the wireless device 101 installed outside the vehicle, and is installed in the vehicle in accordance with the communication standard of the wireless device 101. Information acquired by the vehicle-side wireless device 102 is output to the estimation device 100a (control device 200a) via a transmission path such as a dedicated line.
[0018] When the Bluetooth® standard is used for wireless communication (wireless method) between the wireless device 101 and the vehicle-side wireless device 102, highly accurate position estimation is possible by utilizing the direction detection function: Angle of Arrival (AoA) / Angle of Departure (AoD) added to the Bluetooth® Core Specification Version 5.1.
[0019] The external environment recognition device 103 is a device that acquires information about the surrounding environment of the vehicle, and is, for example, four vehicle-mounted cameras that capture the surrounding environment in front, behind, to the right, and to the left of the vehicle. Images captured by the vehicle-mounted cameras are output to the control device 200a via a transmission path such as a dedicated line, either as analog data or after A / D conversion. In addition, a stereo camera can be used as another vehicle-mounted camera, and a radar that measures the distance to an object using millimeter waves or laser light, a sonar that measures the distance to an object using ultrasonic waves, etc. can also be used. These devices such as the vehicle-mounted camera output information such as the distance to the detected object and its direction (orientation) to the control device 200a via a transmission path such as a dedicated line.
[0020] The absolute position measuring device 104 is a device that acquires absolute position information of the vehicle on a map, and is, for example, a GNSS (Global Navigation Satellite System) such as GPS or GLONASS. The position information acquired by the GNSS is output to the control device 200a via a transmission path such as a CAN or a dedicated line. Furthermore, the position information of the vehicle may be acquired by using road-to-vehicle communication or the like other than the GNSS.
[0021] The steering device 111 is composed of an electric power steering, a hydraulic power steering, or the like that can control the steering angle by an electric or hydraulic actuator in response to an external drive command.
[0022] The drive device 112 is composed of an engine system capable of controlling engine torque with an electric throttle or the like in response to an external drive command, an electric powertrain system capable of controlling the driving force of a motor or the like in response to an external drive command, or the like.
[0023] The braking device 113 is composed of an electric brake, a hydraulic brake, or the like that can control the braking force by an electric or hydraulic actuator in response to an external braking command.
[0024] The speed change device 114 is composed of a transmission or the like that can switch between forward and reverse using an electric or hydraulic actuator or the like in response to an external speed change command.
[0025] The sound generating device 115 is composed of a speaker or the like, and functions as an information notification unit that outputs an alarm, audio guidance, and the like to the driver.
[0026] The display device 116 is composed of a display of a navigation device or the like, a meter panel, a warning light, etc. The display device 116 functions as an information notification unit that notifies the driver of information such as an operation screen of the control device 200a and a warning screen that visually notifies the driver of the risk of the vehicle colliding with an obstacle.
[0027] <Functional Description of the Control Device 200a (Estimation Device 100a)> The radio position estimation unit 1 calculates the amount of movement of the vehicle (movement distance, driving route, etc.) based on the relative positional relationship (direction, distance, etc.) between the radio set 101 and the vehicle-side radio set 102 input from the vehicle-side radio set 102.
[0028] The vehicle position estimation unit 2 calculates the vehicle position by a vehicle position estimation method called odometry, dead reckoning, etc., using information from sensors that detect the vehicle's behavior, such as the vehicle speed, wheel speed, steering angle, and yaw rate. The vehicle position estimation method used here calculates the vehicle's movement amount and angle change over a short period of time, and calculates the vehicle position based on an arbitrary point by integrating these, thereby calculating the vehicle's movement amount (movement distance, driving route, etc.).
[0029] The position estimation parameter correction unit 3 compares the amount of movement calculated by the radio position estimation unit 1 with the amount of movement calculated by the vehicle position estimation unit 2, and corrects the parameters used for calculation in the vehicle position estimation unit 2 so that the difference between the two becomes smaller. The parameters here are parameters used in the calculation of the vehicle position and turning angle information in the vehicle position estimation unit 2, and include, for example, a distance coefficient for correcting the travel distance, a turning coefficient for correcting the amount of turning, a one-pulse distance coefficient for correcting the distance per pulse of the wheel speed pulse, a tire diameter coefficient for correcting the tire radius or tire diameter, a tread length coefficient for correcting the tread length, and a turning curvature coefficient for correcting the turning curvature relative to the steering angle. It is also possible to treat the one-pulse distance of the wheel speed pulse, which is the vehicle specification itself, the tire radius, the tire diameter, the tread length, and the turning curvature relative to the steering angle, as parameters.
[0030] The surrounding environment recognition unit 4 detects the shapes and positions of objects such as stationary three-dimensional objects, moving objects, road surface paint such as lane boundary lines (dividing lines), and signs around the vehicle using image data and distance measurement information input from the external environment recognition device 103, and further has a determination function of detecting unevenness of the road surface and determining whether the road surface is suitable for the vehicle to travel on. Stationary three-dimensional objects are, for example, structures such as guardrails, walls, poles, pylons, curbs, and car stops, and stopped vehicles. Moving objects are, for example, pedestrians, bicycles, motorcycles, and vehicles. Hereinafter, stationary three-dimensional objects and moving objects are collectively referred to as obstacles. The shapes and positions of objects may be detected by known pattern matching, but may also be detected using other techniques.
[0031] Furthermore, the surrounding environment recognition unit 4 detects, for example, drivable lane positions and turning spaces at intersections when traveling on a general road, based on information on the shape and position of the detected object and the result of determining whether the road surface is drivable on the basis of ...
[0032] The vehicle position estimation unit 5 estimates the vehicle position on the map stored in the map information storage unit 6 using information on the absolute position input from the absolute position measurement device 104 and the amount of movement of the vehicle input by the vehicle position estimation unit 2. The method for estimating the vehicle position on the map differs depending on the map available. If the map is not a high-precision map such as a map of a conventional navigation device, the vehicle position is estimated using, for example, a map matching method, which is a known technique. In the case of a high-precision map, the vehicle position on the high-precision map is estimated based on road paint such as lane boundaries and signs detected by the surrounding environment recognition unit 4, as well as information on obstacles and landmarks stored on the high-precision map.
[0033] The map information storage unit 6 stores map data for various applications. For example, in the case of a conventional navigation device, road information required for route search and route guidance, information on convenience stores, gas stations, various facilities, etc. are stored. In the case of an autonomous driving application, shape data close to the actual road shape expressed by polygons, polylines, etc., and detailed information such as traffic regulation information (speed limit, types of vehicles allowed to pass, etc.), lane divisions (main line, passing lane, climbing lane, straight lane, left turn lane, right turn lane, etc.), and the presence or absence of traffic lights, signs, etc. (if present, their location information) are stored.
[0034] A user setting input unit 9 inputs user operation information such as switch input or touch panel input, and accepts destination settings, route settings, and the like.
[0035] The HMI control unit 10 generates information to notify the user appropriately according to the situation, and outputs it to the sound generating device 115 and the display device 116. Furthermore, when a route search instruction is given by the user, the HMI control unit 10 calculates (searches) a route to the set destination that meets the route search conditions, and notifies the user. A known method can be used as the specific method of the route search here.
[0036] The travel trajectory generating unit 7 generates a trajectory for moving the vehicle from the current vehicle position to a target position. Furthermore, the target speed for traveling on the generated trajectory is calculated using information such as the speed limit and trajectory curvature in the map information, traffic lights, stop positions, and the speed of the preceding vehicle. For example, when traveling on a general road, a destination is set using a navigation device or the like, and a trajectory is generated from information such as the positional relationship between the vehicle and obstacles and the lane position when traveling toward the destination. In addition, in the case of a station, a target stop position for stopping the vehicle is set within a stoppable space based on the positional relationship between the vehicle and obstacles, and a trajectory to that point is generated.
[0037] The vehicle control unit 8 controls the running of the host vehicle along the target trajectory generated by the running trajectory generation unit 7. The vehicle control unit 8 calculates a target steering angle and a target speed based on the target trajectory. When a collision between the host vehicle and an obstacle is predicted, the vehicle control unit 8 calculates a target steering angle and a target speed so that the host vehicle does not collide with the obstacle. Then, the vehicle control unit 8 outputs a target steering torque for realizing the target steering angle to the steering device 111. The vehicle control unit 8 also outputs a target engine torque and a target brake pressure for realizing the target speed to the drive device 112 and the braking device 113. Furthermore, when it is necessary to change the traveling direction of the host vehicle, the vehicle control unit 8 outputs a gear shift command to the gear shift device 114.
[0038] Next, a method for calculating the relative position of the wireless device outside the vehicle will be described with reference to FIGS.
[0039] 3(a) shows a case where there is one vehicle-side wireless device, which is communicating with a wireless device outside the vehicle (hereinafter referred to as a wireless beacon). A vehicle-side wireless device 32 mounted on the vehicle 30 communicates with a wireless beacon 31. In this case, if the wireless standard used is Bluetooth (registered trademark), the direction 33 of the wireless beacon 31 as seen from the vehicle-side wireless device 32 can be detected by utilizing the direction detection function of Bluetooth (registered trademark) described above. In addition, since the distance can be estimated by using radio wave intensity information that has been conventionally used in Bluetooth (registered trademark), the relative position of the wireless beacon 31 from the vehicle 30 can be obtained.
[0040] FIG. 3(b) shows a case where there are two vehicle-side wireless devices, and the vehicle 30 is communicating with a wireless beacon. The vehicle-side wireless devices 34 and 35 mounted on the vehicle 30 are mounted at positions separated from each other, and each communicates with a wireless beacon 31. As in FIG. 3(a), when the wireless standard used is Bluetooth (registered trademark), the direction 36 of the wireless beacon 31 as seen from the vehicle-side wireless device 34 and the direction 37 of the wireless beacon 31 as seen from the vehicle-side wireless device 35 can be detected. When the installation positions of the vehicle-side wireless devices 34 and 35 are known and the directions 36 and 37 are detected, the relative position of the wireless beacon 31 from the vehicle 30 can be obtained using trigonometry.
[0041] In addition, in Figures 3(a) and (b), the direction of the radio units 32, 34, and 35 of the vehicle 30 as seen from the wireless beacon 31 can also be detected, and by transmitting this direction information from the wireless beacon 31 to each of the vehicle-side radio units 32, 34, and 35 of the vehicle 30, it is also possible to calculate the change in orientation of the vehicle 30.
[0042] Next, the structure of the wireless beacon will be described with reference to FIG.
[0043] 4 shows an example of a wireless beacon, in which a wireless module 40 is molded with resin 41 and has a lid made of resin 42. The wireless module 40 can be driven by a power source such as a built-in battery, and it is also possible to install a photocell module on the lid of resin 42 so that it can be driven without an external power supply, or to draw out a power line so that it can be supplied with power from the outside.
[0044] <Explanation of Processing Contents of Estimation Device 100a> Next, the processing procedure of the estimation device 100a will be described with reference to a flowchart.
[0045] 5 and 6 are flowcharts showing an example of a processing procedure (vehicle position estimation processing) of the estimation device 100a, and two methods will be described here.
[0046] In step S501 in FIG. 5, vehicle information such as the vehicle speed, wheel speed, steering angle, yaw rate, etc. of the host vehicle is input, and in step S502, the vehicle position estimating unit 2 calculates the vehicle position and amount of movement using this vehicle information.
[0047] In process S503, it is determined whether or not wireless communication with a wireless beacon has been received. If wireless communication has been received, the process proceeds to process S504, and if not, the series of processes ends.
[0048] In process S504, the radio position estimation unit 1 calculates the amount of movement of the vehicle using information on the relative positions of the vehicle and the radio beacon received and calculated by the vehicle-side radio device 102, and the process proceeds to process S505.
[0049] In process S505, the position estimation parameter correction unit 3 compares the amount of movement of the host vehicle calculated in process S502 with the amount of movement of the host vehicle calculated in process S504, corrects the parameters used in the vehicle position estimation unit 2, and then ends the series of processes.
[0050] The parameter correction method here includes, for example, the following method: The parameters here are parameters used in the vehicle position estimation unit 2 to calculate at least the vehicle position and turning angle information.
[0051] ■ Distance coefficient to correct driving distance If the travel distance calculated in step S502 when the vehicle is traveling straight is X1 and the travel distance calculated in step S504 is X2, the distance coefficient Kx is calculated by multiplying the travel distance calculated in step S502 by Kx, i.e., Kx=X2 / X1.
[0052] ■ Turning coefficient that corrects the amount of turning If the turning angle calculated in step S502 when the host vehicle is turning is C1 and the turning angle calculated in step S504 is C2, the turning coefficient Kc is calculated by multiplying the turning angle calculated in step S502 by Kc, i.e., Kc=C2 / C1.
[0053] ■ 1-pulse distance coefficient that corrects the distance per wheel speed pulse If the travel distances of each wheel (4 wheels) calculated in process S502 when the vehicle is traveling straight are X11, X12, X13, and X14, and the travel distance calculated in process S504 is X2, the one-pulse distance coefficients of each wheel are Kx1=X2 / X11, Kx2=X2 / X12, Kx3=X2 / X13, and Kx4=X2 / X14, and are calculated by multiplying the travel distances of each wheel calculated in process S502 by Kx1, Kx2, Kx3, and Kx4, respectively.
[0054] ■ Tire radius or tire diameter correction coefficient If the travel distances of each wheel (4 wheels) calculated in process S502 when the vehicle is traveling straight are X11, X12, X13, and X14, and the travel distance calculated in process S504 is X2, the tire diameter coefficients of each wheel are Kd1=X2 / X11, Kd2=X2 / X12, Kd3=X2 / X13, and Kd4=X2 / X14, and are calculated by multiplying the tire radius or tire diameter of each wheel used in process S502 by Kd1, Kd2, Kd3, and Kd4, respectively.
[0055] ■ Tread length coefficient to correct tread length If the turning angle calculated in step S502 when the vehicle is turning is C1 and the turning angle calculated in step S504 is C2, the tread length coefficient Kt is calculated by multiplying the tread length used in step S502 by Kt, i.e., Kt=C1 / C2.
[0056] ■ Turning curvature coefficient that corrects turning curvature relative to steering angle If the turning angle calculated in process S502 when the vehicle is turning is C1 and the turning angle calculated in process S504 is C2, the turning curvature coefficient Kr=C2 / C1 is calculated by multiplying the turning curvature for the steering angle used in process S502 by Kr.
[0057] ■ Wheel speed pulse distance If the number of pulses for each wheel (4 wheels) calculated in process S502 when the vehicle is traveling straight is P1, P2, P3, P4, and the distance traveled calculated in process S504 is X2, the one-pulse distance for each wheel is used in process S502 as X2 / P1, X2 / P2, X2 / P3, X2 / P4, respectively.
[0058] ■Tire radius If the number of pulses for each wheel (4 wheels) calculated in process S502 when the vehicle is traveling straight is P1, P2, P3, P4 and the distance traveled calculated in process S504 is X2, then if the number of pulses per tire rotation is PI, the tire radii of each wheel are used in process S502 as PI×X2 / 2 / π / P1, PI×X2 / 2 / π / P2, PI×X2 / 2 / π / P3, PI×X2 / 2 / π / P4, respectively.
[0059] In addition, the turning curvature with respect to the tread length and steering angle can also be calculated using the vehicle motion equation and the like from the information on the turning angle calculated in step S504.
[0060] The parameter correction method described above is based on the basic idea of correcting each parameter so as to reduce the difference between the amount of movement of the host vehicle calculated by the radio position estimation unit 1 and the amount of movement of the host vehicle calculated by the vehicle position estimation unit 2. However, in the case of the above-mentioned method, since there is a possibility that the parameters may suddenly change, it is possible to prevent sudden changes by correcting the parameters before correction with a predetermined weight (e.g., 20%), and also to reduce the influence even when the parameters are erroneously calculated due to sensor error or the like.
[0061] A vehicle speed condition may also be added to the correction conditions. Specifically, the parameters are corrected under the condition that the vehicle speed of the host vehicle is equal to or lower than a predetermined vehicle speed (for example, equal to or lower than 100 km / h). Furthermore, the lower the vehicle speed of the host vehicle, the smaller the travel distance per unit time becomes, and the smaller the distance resolution when calculating the movement amount of the host vehicle becomes. Therefore, the lower the vehicle speed of the host vehicle, the heavier the weighting applied to the parameters before correction can be applied to enable efficient correction. It is also important to make the vehicle speed condition flexibly changeable depending on the communication standard of the wireless device used and the actual measurement accuracy.
[0062] A movement amount condition may also be added to the correction conditions. Specifically, the parameters are corrected under the condition that the movement amount of the vehicle calculated by the wireless position estimation unit 1 is within a predetermined range (for example, 5 m or more and less than 100 m). Furthermore, since the longer the movement amount of the vehicle, the more effective the correction is, the heavier the weight is given to the parameters before correction as the movement amount of the vehicle is longer, thereby enabling efficient correction. It is also important to make the movement amount condition flexibly changeable depending on the communication standard of the wireless device used and the actual measurement accuracy.
[0063] Also, when comparing the parameters before and after correction, if the amount of change (difference) is large (for example, if the amount of change is 50% or more), correction may not be performed. In this case, some abnormality may have occurred in the wireless communication or on the vehicle side, or a sensor may have detected something erroneously, and it is necessary to notify the driver (passenger) of the vehicle of this information (that correction will not be performed).
[0064] Next, the flow chart of FIG. 6 will be described.
[0065] The flowchart in FIG. 6 executes the same processes as those in the flowchart in FIG. 5 up to step S504.
[0066] In process S605, correction values (correction data) of each parameter calculated from the amount of movement of the vehicle calculated by the radio position estimation unit 1 and the amount of movement of the vehicle calculated by the vehicle position estimation unit 2 are stored, and the process proceeds to process S606, where it is determined whether the stored correction data is equal to or greater than a predetermined amount (in other words, whether the number of times the correction data has been stored has exceeded a predetermined number of times), and if it is equal to or greater than the predetermined amount, the process proceeds to process S607, and if it is less than the predetermined amount, the series of processes is terminated.
[0067] In process S607, statistical processing is performed on the stored correction data to perform parameter correction processing similar to process S505 in Fig. 5, and the series of processes is terminated. The statistical processing here includes, for example, simple averaging, outlier removal, and a method using standard deviation and variance, and by performing these, it becomes possible to obtain stable correction results.
[0068] Here, the correction values of each parameter are used as the objects to be stored, but it is also possible to store the difference between the amount of movement of the vehicle calculated by the radio position estimation unit 1 and the amount of movement of the vehicle calculated by the vehicle position estimation unit 2, which is used to calculate the correction values of each parameter, and when the number of times that difference has been stored exceeds a predetermined number of times, to perform parameter correction processing by performing statistical processing or the like on the stored difference for the predetermined number of times.
[0069] <Explanation of the processing contents of the control device 200a> Next, an example of a processing procedure (driving support processing) of the control device 200a will be described with reference to the flowchart of FIG.
[0070] In process S701 of FIG. 7, the control device 200a acquires the recognition result of the external environment from the external environment recognition device 103.
[0071] In process S702, the control device 200a acquires the measurement result of the absolute position from the absolute position measurement device 104.
[0072] In process S703, the surrounding environment recognition unit 4 detects road paint such as lane boundaries, signs, obstacles, landmarks, and the like around the host vehicle based on the external environment recognition result acquired in process S701.
[0073] In process S704, the vehicle position estimation unit 5 estimates the vehicle position based on the absolute position measurement result acquired in process S702, using the detection result from the surrounding environment recognition unit 4, the map information in the map information storage unit 6, and the vehicle position information from the vehicle position estimation unit 2.
[0074] In process S705, the travel trajectory generating unit 7 generates a trajectory for moving the host vehicle from the current host vehicle position to the target position.
[0075] In process S706, the vehicle control unit 8 calculates a target steering angle, a target speed, and an appropriate shift position for traveling along the target trajectory (travel trajectory) generated in process S705.
[0076] In process S707, the vehicle control unit 8 calculates control parameters for outputting the target steering angle, target speed, and appropriate shift position calculated in process S706 to the steering device 111, the drive device 112, the braking device 113, and the transmission 114, respectively. For example, the control parameters output to the steering device 111 include a target steering torque for realizing the target steering angle, but the target steering angle may be directly output depending on the configuration of the steering device 111. In addition, the control parameters output to the drive device 112 and the braking device 113 include a target engine torque and a target brake pressure for realizing the target speed, but the target speed may be directly output depending on the configuration of the drive device 112 and the braking device 113.
[0077] In process S708, the vehicle control unit 8 outputs the control parameters calculated in process S707 to the steering device 111, the driving device 112, the braking device 113, and the transmission device 114 as vehicle control signals.
[0078] In process S709, the control device 200a determines whether or not the target position has been reached.
[0079] In process S710, if the target position is reached in process S709, the HMI control unit 10 uses the sound generating device 115 or the display device 116 to notify the user that driving assistance is ending, and if the target position is not reached, the HMI control unit 10 uses the sound generating device 115 or the display device 116 to notify the user that driving assistance is continuing, and then the process ends.
[0080] As described above, by incorporating the basic functions of the vehicle position estimation device 100a into the vehicle control device 200a, it becomes possible to realize a driving assistance function. Specifically, since the accuracy of the vehicle position estimation unit 2 can be guaranteed for a long period of time in an indoor environment where the signal from the absolute position measurement device 104 is interrupted, it becomes possible to continue driving assistance even in such an environment.
[0081] Next, a specific method for calculating the turning angle of the vehicle by communicating with a wireless beacon will be described with reference to FIGS. 8(a) and 8(b) and FIGS. 9(a) and 9(b).
[0082] 8(a) and (b) assume that the vehicle itself communicates (at each point) with one wireless beacon.
[0083] FIG. 8(a) shows a situation where the vehicle 80 travels straight from point A to point B, passing by the wireless beacon 82. At point A, the vehicle-side wireless device 81 mounted on the vehicle 80 and the wireless beacon 82 communicate bidirectionally, so that the direction A1 of the wireless beacon 82 as seen from the vehicle-side wireless device 81 and the direction A2 of the vehicle-side wireless device 81 as seen from the wireless beacon 82 can be detected. In addition, as described in FIG. 3(a) and (b), the distance between the vehicle-side wireless device 81 and the wireless beacon 82 can also be detected. Thereafter, the directions B1 and B2 and the distance can be detected in the same manner at point B. Here, when the direction of the vehicle 80 at point A is used as a reference, the direction of the vehicle 80 at point B can be expressed as (A1+B1)-(A2+B2), and when the vehicle 80 travels straight, the value is close to zero.
[0084] FIG. 8(b) shows a situation where the vehicle 80 turns from point C to point D beside the wireless beacon 82. At point C, the vehicle-side wireless device 81 mounted on the vehicle 80 and the wireless beacon 82 perform two-way communication, so that the direction C1 of the wireless beacon 82 as seen from the vehicle-side wireless device 81 and the direction C2 of the vehicle-side wireless device 81 as seen from the wireless beacon 82 can be detected. In addition, as described in FIG. 3(a) and (b), the distance between the vehicle-side wireless device 81 and the wireless beacon 82 can also be detected. Thereafter, the directions D1, D2 and the distance can be detected in the same manner at point D. Here, when the direction of the vehicle 80 at point C is used as a reference, the direction of the vehicle 80 at point D can be expressed as (C1+D1)-(C2+D2), and when the vehicle 80 turns as shown in FIG. 8(b), the value is about 90 degrees.
[0085] As a result, when the vehicle (its radio position estimation unit 1) is communicating with one radio beacon (at a specified location at a specified time), the radio beacon 82 estimates the direction of the vehicle 80, and the radio position estimation unit 1 receives that direction information and can calculate the amount of movement of the vehicle 80.
[0086] 9(a) and (b) assume that the vehicle communicates (at each point) with two wireless beacons.
[0087] FIG. 9(a) shows a situation where the vehicle 90 travels straight from point A to point B, passing by the wireless beacons 92 and 93. When the vehicle-side wireless device 91 mounted on the vehicle 90 receives one-way communication from the wireless beacons 92 and 93 at point A, the relative positions of the wireless beacons 92 and 93 as seen from the vehicle-side wireless device 91 can be calculated (direction A1 of the wireless beacon 92 as seen from the vehicle-side wireless device 91) as explained in FIG. 3(a) and (b), and the direction A2 of the vehicle-side wireless device 91 as seen from the wireless beacon 92 can be calculated using the straight line connecting the two wireless beacons as the reference direction. Thereafter, the directions B1 and B2 and the distance can be detected in the same manner at point B. Here, when the direction of the vehicle 90 at point A is used as the reference, the direction of the vehicle 90 at point B can be expressed as (A1+B1)-(A2+B2), and when the vehicle 90 travels straight, the value is close to zero.
[0088] FIG. 9B shows a situation where the vehicle 90 turns from point C to point D beside the wireless beacons 92 and 93. When the vehicle-side wireless device 91 mounted on the vehicle 90 receives one-way communication from the wireless beacons 92 and 93 at point C, the relative positions of the wireless beacons 92 and 93 as seen from the vehicle-side wireless device 91 can be calculated (direction C1 of the wireless beacon 92 as seen from the vehicle-side wireless device 91) as explained in FIG. 3A and FIG. 3B, and the direction C2 of the vehicle-side wireless device 91 as seen from the wireless beacon 92 can be calculated using the straight line connecting the two wireless beacons as the reference direction. Thereafter, the directions D1 and D2 and the distance can be detected in the same manner at point D. Here, when the direction of the vehicle 90 at point C is used as the reference, the direction of the vehicle 90 at point D can be expressed as (C1+D1)-(C2+D2), and when the vehicle 90 turns as shown in FIG. 9B, the value is about 90 degrees.
[0089] 9(a) and 9(b), the direction of the vehicle 90 is calculated by calculating the direction to the wireless beacon 92, but it may be calculated from the direction to the wireless beacon 93, or a method using the directions of both may be used. Furthermore, it goes without saying that a method of communicating with three or more wireless beacons may be used.
[0090] As a result, when the vehicle (its radio position estimation unit 1) is communicating with two or more radio beacons (at a specific location at a specific time), the radio position estimation unit 1 can calculate the relative position of each of the radio beacons 92 and 93, and use the relative positional relationship between the radio beacons 92 and 93 to calculate the amount of movement of the vehicle 90 (here, the straight line connecting the two radio beacons is used as the reference direction).
[0091] As described above, by changing the communication method (two-way or one-way) based on the installation method of the wireless beacon (one or two or more), it is possible to calculate the relative position between the vehicle and the wireless beacon in various scenes, and to calculate the amount of movement of the vehicle.
[0092] <Application example explanation> Next, an example of application of the present invention in an actual scene will be shown with reference to FIGS.
[0093] FIG. 10 illustrates a scene in which the vehicle 100 is returning to the home 151, with 152 indicating the parking space at the home 151, 153 and 154 indicating wireless beacons, and 155 indicating a neighboring house.
[0094] 10, when the host vehicle 100 reaches point A, a vehicle-side wireless device (not shown) mounted on the host vehicle 100 starts communication with the wireless beacons 153 and 154, and the parameters of the vehicle position estimation unit 2 are corrected before the host vehicle 100 reaches point B. Thereafter, when the host vehicle 100 is stopped in the stopping space 152 by automatic control using the control device 200a, the accuracy of the host vehicle position estimation unit 5 increases, and therefore the stopping accuracy after the vehicle has been stopped can also be improved.
[0095] FIG. 11 illustrates a scene in which the vehicle 100 enters a bus stop 161 to use a facility 160, and 162, 163, 164, and 165 are wireless beacons.
[0096] In FIG. 11, when the vehicle 100 reaches point A, the vehicle-side wireless device (not shown) mounted on the vehicle 100 starts communication with the wireless beacons 162 and 163, and the parameters of the vehicle position estimation unit 2 are corrected by the time the vehicle 100 reaches point C. Here, since the straight section from point A to point B and the turning section from point B to point C are included, the parameters can be corrected efficiently. After that, when the vehicle 100 is automatically driven in the station 161 using the control device 200a and the vehicle 100 is stopped in a desired stopping space by automatic control, the accuracy of the vehicle position estimation unit 5 increases, so that the accuracy during driving and the stopping accuracy after stopping can also be improved. It goes without saying that the same operation can be expected even when the approach route of the vehicle 100 passes between the wireless beacons 164 and 165. In addition, when the vehicle 100 leaves the station 161, it is also possible to correct the parameters of the vehicle position estimation unit 2 by communicating with each wireless beacon.
[0097] In addition, although the above describes a scene in which a wireless beacon installed at a specific location is used, a wireless beacon installed at any location, for example, a neighboring house 155 in Fig. 10, may also be used. In particular, when implementing one-way communication from a wireless beacon, it can be considered that there are almost no constraints on its use.
[0098] In addition, while the above explanation focused on a scene at a bus stop, it is also possible to expand the operating area of autonomous driving and advanced driving assistance by, for example, installing wireless beacons at key points on public roads and expressways so that the accuracy of vehicle position estimation can be ensured as appropriate.
[0099] The vehicles described above also include moving objects that need to estimate their own positions, such as construction machinery, forklifts in factories, and robots.
[0100] Next, a method for effectively utilizing a plurality of wireless beacons will be described with reference to FIG.
[0101] FIG. 12 illustrates a scene in which the vehicle 100 passes beside wireless beacons 170, 171, and 172.
[0102] 12, the vehicle 100 starts communicating with the wireless beacon 170 near point A, and at this time acquires the positional relationship (distance, direction, etc.) with the wireless beacon 171 from the wireless beacon 120. When the vehicle 100 reaches the vicinity of point C from point B, the parameters of the vehicle position estimation unit 2 can be corrected using information on the distance between the wireless beacons 170 and 171. Similarly, if the positional relationship (distance, direction, etc.) with the wireless beacon 172 can be acquired from the wireless beacon 171 that has started communication, the same process can be performed at point D where the wireless beacon 172 is reached.
[0103] In other words, when a wireless beacon is made up of multiple wireless beacons, each of which transmits information on its relative positional relationship with the other wireless beacons, the vehicle 100 (its position estimation parameter correction unit 3) can correct the parameters of the vehicle position estimation unit 2 by calculating the amount of movement of the vehicle 100 using the information received by the wireless position estimation unit 1 from each wireless beacon.
[0104] <Explanation of action and effect> As described above, the vehicle position estimation device 100a of this embodiment has a vehicle position estimation unit 2 that calculates the position of the vehicle based on the output of a sensor that detects the behavior of the vehicle, and further includes a wireless position estimation unit 1 that communicates with a wireless device 101 installed at an arbitrary position to calculate the relative position of the vehicle and the wireless device 101, and a position estimation parameter correction unit 3 that corrects parameters used in the calculation of at least the position and turning angle information of the vehicle by the vehicle position estimation unit 2, and the position estimation parameter correction unit 3 corrects the parameters by comparing the amount of movement of the vehicle calculated by the wireless position estimation unit 1 with the amount of movement of the vehicle calculated by the vehicle position estimation unit 2.
[0105] Moreover, the vehicle position estimation method of this embodiment is a vehicle position estimation method executed by a vehicle position estimation device 100a mounted on a vehicle, and includes a vehicle position estimation procedure for calculating the position of the vehicle based on the output of a sensor that detects the behavior of the vehicle, a wireless position estimation procedure for communicating with a wireless device 101 installed at an arbitrary position and calculating the relative position of the vehicle and the wireless device 101, and a position estimation parameter correction procedure for correcting parameters used in calculating at least the position and turning angle information of the vehicle in the vehicle position estimation procedure, and the position estimation parameter correction procedure corrects the parameters by comparing the amount of movement of the vehicle calculated by the wireless position estimation procedure with the amount of movement of the vehicle calculated by the vehicle position estimation procedure.
[0106] In detail, the system communicates with a wireless beacon at any position, calculates the relative movement amount of the vehicle, and corrects the dead reckoning parameters.
[0107] According to this embodiment, since the vehicle position and turning angle information can be calculated with high accuracy, it becomes possible to estimate the vehicle position including the two-dimensional turning direction with high accuracy using only internal sensors. Also, it becomes possible to ensure the vehicle position estimation accuracy even in a scene where external sensors such as cameras and positioning satellites cannot be used.
[0108] Although the present embodiment has been described using several patterns as examples, the present invention is also applicable to other patterns. Furthermore, the present invention can be embodied in various forms without departing from the spirit of the present invention.
[0109] Furthermore, the present invention is not limited to the above-described embodiments, and includes various modified examples and equivalent configurations within the spirit of the appended claims. For example, the above-described embodiments have been described in detail to clearly explain the present invention, and the present invention is not necessarily limited to having all of the configurations described. Furthermore, a part of the configuration of one embodiment may be replaced with the configuration of another embodiment. Furthermore, the configuration of another embodiment may be added to the configuration of one embodiment. Furthermore, a part of the configuration of each embodiment may be added, deleted, or replaced with another configuration.
[0110] Furthermore, each of the aforementioned configurations, functions, processing units, processing means, etc. may be realized in hardware, for example by designing some or all of them as an integrated circuit, or may be realized in software by a processor interpreting and executing a program that realizes each function.
[0111] Information such as programs, tables, and files that realize each function can be stored in a storage device such as a memory, a hard disk, or an SSD (Solid State Drive), or in a recording medium such as an IC card, an SD card, or a DVD.
[0112] In addition, the control lines and information lines shown are those considered necessary for the explanation, and do not necessarily show all the control lines and information lines necessary for implementation. In reality, it can be considered that almost all components are connected to each other. [Explanation of symbols]
[0113] 1 Radio position estimation section 2. Vehicle position estimation unit 3. Position estimation parameter correction section 4 Surrounding Environment Awareness Department 5 Vehicle position estimation unit 6 Map information storage section 7. Trajectory generation unit 8 Vehicle control unit 9 User setting input section 10 HMI control unit 101 Radio (radio beacon) 102 Vehicle side radio 103 External environment recognition device 104 Absolute Position Measurement Device 111 Steering Gear 112 Drive unit 113 Braking device 114 Gearbox 115 Sound Generator 116 Display device 100a Vehicle position estimation device 200a Vehicle control device 30,80,90,100 Vehicle
Claims
1. A vehicle position estimation device having a vehicle position estimation unit that calculates a position of a vehicle based on an output of a sensor that detects a behavior of the vehicle, a wireless position estimating unit that communicates with a wireless device installed at an arbitrary position to calculate a relative position between the vehicle and the wireless device, and a position estimation parameter correcting unit that corrects parameters used in the vehicle position estimating unit to calculate at least the position and turning angle information of the vehicle, the position estimation parameter correction unit corrects the parameters by comparing the amount of movement of the vehicle calculated by the radio position estimation unit with the amount of movement of the vehicle calculated by the vehicle position estimation unit; The vehicle position estimation device is characterized in that the wireless position estimation unit calculates the relative position of the vehicle and the wireless device based on direction information from a plurality of vehicle-side wireless devices installed in the vehicle and capable of communicating with the wireless device.
2. A vehicle position estimation device having a vehicle position estimation unit that calculates a position of a vehicle based on an output of a sensor that detects a behavior of the vehicle, a wireless position estimating unit that communicates with a wireless device installed at an arbitrary position to calculate a relative position between the vehicle and the wireless device, and a position estimation parameter correcting unit that corrects parameters used in the vehicle position estimating unit to calculate at least the position and turning angle information of the vehicle, the position estimation parameter correction unit corrects the parameters by comparing the amount of movement of the vehicle calculated by the radio position estimation unit with the amount of movement of the vehicle calculated by the vehicle position estimation unit; A vehicle position estimation device characterized in that, when the radio position estimation unit is communicating with one radio device, the radio device estimates the direction of the vehicle, and the radio position estimation unit receives information on the direction and calculates the amount of movement of the vehicle.
3. A vehicle position estimation device having a vehicle position estimation unit that calculates a position of a vehicle based on an output of a sensor that detects a behavior of the vehicle, a wireless position estimating unit that communicates with a wireless device installed at an arbitrary position to calculate a relative position between the vehicle and the wireless device, and a position estimation parameter correcting unit that corrects parameters used in the vehicle position estimating unit to calculate at least the position and turning angle information of the vehicle, the position estimation parameter correction unit corrects the parameters by comparing the amount of movement of the vehicle calculated by the radio position estimation unit with the amount of movement of the vehicle calculated by the vehicle position estimation unit; A vehicle position estimation device characterized in that, when there are two or more wireless devices with which the wireless position estimation unit is communicating, the wireless position estimation unit calculates the relative position of each of the wireless devices, and calculates the amount of movement of the vehicle using the relative positional relationship between the wireless devices.
4. A vehicle position estimation device having a vehicle position estimation unit that calculates a position of a vehicle based on an output of a sensor that detects a behavior of the vehicle, a wireless position estimating unit that communicates with a wireless device installed at an arbitrary position to calculate a relative position between the vehicle and the wireless device, and a position estimation parameter correcting unit that corrects parameters used in the vehicle position estimating unit to calculate at least the position and turning angle information of the vehicle, the position estimation parameter correction unit corrects the parameters by comparing the amount of movement of the vehicle calculated by the radio position estimation unit with the amount of movement of the vehicle calculated by the vehicle position estimation unit; The vehicle position estimation device is characterized in that the wireless device is composed of a plurality of wireless devices, each of which transmits information on a relative positional relationship with the other wireless devices, and the position estimation parameter correction unit corrects the parameters by calculating the amount of movement of the vehicle using the information received by the wireless position estimation unit from each of the wireless devices.
5. 5. The vehicle position estimation device according to claim 2, wherein the wireless position estimation unit calculates a relative position between the vehicle and the wireless device based on direction information from a plurality of vehicle-side wireless devices that are installed in the vehicle and capable of communicating with the wireless device.
6. 5. The vehicle position estimation device according to claim 1, wherein the parameters are at least one of a distance coefficient for correcting a travel distance calculated by the vehicle position estimation unit, a turning coefficient for correcting a turning amount, a one-pulse distance coefficient for correcting a wheel speed pulse of the vehicle, a tire radius coefficient for correcting a tire diameter or a tire of the vehicle, a tread length coefficient for correcting a tread length of the vehicle, a turning curvature coefficient for correcting a turning curvature with respect to a steering angle of the vehicle, a one-pulse distance of a wheel speed pulse of the vehicle, a tire radius or a tire diameter of the vehicle, a tread length of the vehicle, and a turning curvature with respect to a steering angle of the vehicle.
7. 5. The vehicle position estimation device according to claim 1, wherein the position estimation parameter correction unit calculates a difference between the amount of movement of the vehicle calculated by the radio position estimation unit and the amount of movement of the vehicle calculated by the vehicle position estimation unit, and corrects the parameters so that the difference becomes smaller.
8. 5. The vehicle position estimation device according to claim 1, wherein the position estimation parameter correction unit corrects the parameters by applying a predetermined weight to the parameters before correction.
9. 5. The vehicle position estimation device according to claim 1, wherein the position estimation parameter correction unit corrects the parameters when the vehicle speed is equal to or lower than a predetermined vehicle speed.
10. 10. The vehicle position estimation device according to claim 9, wherein the position estimation parameter correction unit corrects the parameters by weighting the parameters before correction heavier as the vehicle speed of the vehicle decreases.
11. 5. The vehicle position estimation device according to claim 1, wherein the position estimation parameter correction unit corrects the parameter based on the amount of movement of the vehicle calculated by the wireless position estimation unit within a predetermined range.
12. The vehicle position estimation device according to claim 11, characterized in that the position estimation parameter correction unit corrects the parameters by increasing the weighting applied to the parameters before correction as the movement amount of the vehicle calculated by the wireless position estimation unit increases.
13. 5. The vehicle position estimation device according to claim 1 , wherein the position estimation parameter correction unit stores a difference between the amount of movement of the vehicle calculated by the radio position estimation unit and the amount of movement of the vehicle calculated by the vehicle position estimation unit and / or a correction amount of the parameter, and when the number of times that the difference and / or the correction amount of the parameter have been stored exceeds a predetermined number, corrects the parameter based on the difference and / or the correction amount of the parameter for a predetermined number of times.
14. the position estimation parameter correction unit does not correct the parameter when a difference between a parameter before correction and a parameter after correction is equal to or greater than a predetermined value; 5. The vehicle position estimation device according to claim 1, wherein the position estimation parameter correction unit notifies an occupant of the vehicle of information that the parameter will not be corrected when a difference between a parameter before correction and a parameter after correction is equal to or greater than a predetermined value and the parameter is not corrected.
15. A vehicle position estimation method executed by a vehicle position estimation device mounted on a vehicle, comprising: a vehicle position estimation procedure for calculating a position of the vehicle based on an output of a sensor that detects a behavior of the vehicle; a wireless position estimation procedure for communicating with a wireless device installed at an arbitrary position and calculating a relative position between the vehicle and the wireless device; and a position estimation parameter correction procedure for correcting parameters used in the vehicle position estimation procedure for calculating at least the position and turning angle information of the vehicle, the position estimation parameter correction step corrects the parameters by comparing a movement amount of the vehicle calculated by the radio position estimation step with a movement amount of the vehicle calculated by the vehicle position estimation step; The vehicle position estimation method is characterized in that the radio position estimation procedure calculates the relative positions of the vehicle and the radio from direction information from a plurality of vehicle-side radios that are installed in the vehicle and capable of communicating with the radio.
16. A vehicle position estimation method executed by a vehicle position estimation device mounted on a vehicle, comprising: a vehicle position estimation procedure for calculating a position of the vehicle based on an output of a sensor that detects a behavior of the vehicle; a wireless position estimation procedure for communicating with a wireless device installed at an arbitrary position and calculating a relative position between the vehicle and the wireless device; and a position estimation parameter correction procedure for correcting parameters used in the vehicle position estimation procedure for calculating at least the position and turning angle information of the vehicle, the position estimation parameter correction step corrects the parameters by comparing a movement amount of the vehicle calculated by the radio position estimation step with a movement amount of the vehicle calculated by the vehicle position estimation step; A vehicle position estimation method, characterized in that when there is one target radio communicating in the radio position estimation procedure, the radio estimates a direction of the vehicle, and the radio position estimation procedure receives information on the direction and calculates the amount of movement of the vehicle.
17. A vehicle position estimation method executed by a vehicle position estimation device mounted on a vehicle, comprising: a vehicle position estimation procedure for calculating a position of the vehicle based on an output of a sensor that detects a behavior of the vehicle; a wireless position estimation procedure for communicating with a wireless device installed at an arbitrary position and calculating a relative position between the vehicle and the wireless device; and a position estimation parameter correction procedure for correcting parameters used in the vehicle position estimation procedure for calculating at least the position and turning angle information of the vehicle, the position estimation parameter correction step corrects the parameters by comparing a movement amount of the vehicle calculated by the radio position estimation step with a movement amount of the vehicle calculated by the vehicle position estimation step; A vehicle position estimation method, characterized in that when there are two or more target wireless devices communicating in the wireless position estimation procedure, the wireless position estimation procedure calculates the relative position of each of the wireless devices, and calculates the amount of movement of the vehicle using the relative positional relationship between the wireless devices.
18. A vehicle position estimation method executed by a vehicle position estimation device mounted on a vehicle, comprising: a vehicle position estimation procedure for calculating a position of the vehicle based on an output of a sensor that detects a behavior of the vehicle; a wireless position estimation procedure for communicating with a wireless device installed at an arbitrary position and calculating a relative position between the vehicle and the wireless device; and a position estimation parameter correction procedure for correcting parameters used in the vehicle position estimation procedure for calculating at least the position and turning angle information of the vehicle, the position estimation parameter correction step corrects the parameters by comparing a movement amount of the vehicle calculated by the radio position estimation step with a movement amount of the vehicle calculated by the vehicle position estimation step; a position estimation parameter correction step of correcting the parameters by calculating the amount of movement of the vehicle using the information received from each of the wireless devices in the wireless position estimation step, the position estimation parameter correction step being characterized in that the wireless device is configured to be composed of a plurality of wireless devices, each of which transmits information on a relative position relationship with the other wireless devices, and the position estimation parameter correction step corrects the parameters by calculating the amount of movement of the vehicle using the information received from each of the wireless devices in the wireless position estimation step.
Citation Information
Patent Citations
Position detecting apparatus
JP1992369425A
Device and method for setting azimuth of vehicle
JP1996005390A
Sensor neutral position learning device and recording medium
JP2000214180A
Device and method for calculating vehicle movement distance
JP2003028665A
Distance measuring device, distance correction method, distance correction program, and recording medium
JP2013250167A
Cited By
Positioning device, positioning method, and positioning program
JP2026143146A
Positioning device, positioning method, and positioning program
JP2026143153A
