Vehicle travel trajectory transmission system
The vehicle travel trajectory transmission system addresses high communication and processing loads by transmitting vehicle position data only when significant changes occur, optimizing data transmission and reducing storage needs.
Patent Information
- Application Number
- JP2020198432
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-11-30
- Publication Date
- 2024-12-04
- Estimated Expiration
- 2040-11-30
AI Technical Summary
The existing methods for vehicle position localization and communication in automatic driving systems result in high communication load, data processing load, and storage capacity due to frequent transmission of position information from vehicles to a server device.
A vehicle travel trajectory transmission system that uses a GNSS receiver, wheel speed sensor, gyro sensor, and acceleration sensor to determine vehicle position and transmit only specific trajectory data based on predetermined thresholds, reducing unnecessary data transmission.
This system reduces communication load, data processing load, and storage capacity by transmitting vehicle position information only when significant changes in trajectory occur, thereby optimizing data transmission and processing.
Smart Images

Figure 0007594418000001 
Figure 0007594418000002 
Figure 0007594418000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a vehicle that transmits the driving state of the vehicle to a server device for map matching. of Running track trace Communication System To Regarding. [Background technology]
[0002] In recent years, various autonomous driving technologies have been proposed for vehicles to reduce the burden on drivers and enable comfortable driving, and some of them have already been put into practical use. A technology is known for vehicles to perform localization (vehicle position estimation) by locating their own vehicle position based on positioning signals from GNSS (Global Navigation Satellite System) positioning satellites and reflecting the position on road map information.
[0003] For example, Patent Document 1 discloses a technology in which a driving trajectory is compared with a driving trajectory calculated from a map curvature based on the vehicle's position map-matched on road map information, a section error, which is the deviation in the longitudinal direction, is calculated, and the longitudinal direction of the vehicle's position map-matched on road map information is corrected using this section error.
[0004] There is also a traffic control system in which a server device of an external control device that stores map information and multiple vehicles equipped with GNSS antennas communicate with each other to distribute information to the vehicles and provide automatic driving control instructions.
[0005] For example, Patent Document 2 discloses a traffic control system that can create a traffic flow that prevents congestion before it occurs, even in a traffic environment where various vehicles are mixed traveling in a given section. [Prior art documents] [Patent documents]
[0006] [Patent Document 1] JP 2019-66193 A [Patent Document 2] JP 2020-160939 A Summary of the Invention [Problem to be solved by the invention]
[0007] In the server device of the control device, the vehicle position information transmitted from each vehicle at a fixed interval is matched with road map information in order to identify the lane in which each vehicle is traveling. blood A method of processing the data using filtering can be considered.
[0008] However, with this method, location information (longitude / latitude information) is transmitted from multiple vehicles to an external control device at regular intervals, resulting in a huge amount of communication data. In addition, processing the location information data of multiple vehicles increases the communication and processing load, resulting in a huge amount of data to be stored on the control device.
[0009] Therefore, the present invention has been made in consideration of the above problems, and provides a vehicle travel locus transmission system that reduces the communication load between a server device and each vehicle, the data processing load of the server device, and the data storage capacity. M It is intended to provide. [Means for solving the problem]
[0010] A vehicle travel trajectory transmission system according to one embodiment of the present invention includes a GNSS receiver for receiving a positioning signal, Server device a vehicle-side transceiver for transmitting and receiving information, a wheel speed sensor for detecting the rotation speed of the wheels, a gyro sensor for detecting the angular velocity or the angular acceleration, and an acceleration sensor for detecting the acceleration. Installed in a vehicle A vehicle travel trajectory transmission system, the driving trajectory transmission system includes a locator calculation device that acquires position coordinates of the vehicle at predetermined intervals based on the positioning signal received by the GNSS receiver or detection signals of the wheel speed sensor, the gyro sensor, and the acceleration sensor; The locator calculation unit is When detecting the start of the engine of the vehicle, first information having last acquired position coordinate information and identification information of the vehicle is transmitted from the vehicle-side transceiver to the server device, and after transmitting the first information, The parameters of a linear function connecting the latest first position coordinate and the second position coordinate one cycle before are The second Generate the linear coordinate of 1, In response to generating the first linear coordinates, The angle between the first linear coordinate and the extension of the second linear coordinate generated one cycle ago. In response to the calculation of the angle, the angle isExceeding a certain threshold and, depending on whether the formed angle exceeds the predetermined threshold value, transmitting second information having the latest information of the first linear coordinate, information on the speed of the vehicle calculated based on the detection signal of the wheel speed sensor, and the identification information from the vehicle-side transceiver to the server device, depending on whether the formed angle does not exceed the predetermined threshold value, determining whether an accumulated angle obtained by accumulating all of the formed angles calculated after the time when the second information was last transmitted exceeds the predetermined threshold value, and transmitting the second information from the vehicle-side transceiver to the server device depending on whether the accumulated angle exceeds the predetermined threshold value, and transmitting third information having only the information on the vehicle speed and the identification information from the vehicle-side transceiver to the server device depending on whether the accumulated angle does not exceed the predetermined threshold value. . Effect of the Invention
[0012] According to the present invention, a vehicle travel locus transmission system that reduces the communication load between a server device and each vehicle, the data processing load of the server device, and the data storage capacity is provided. M can be provided. [Brief description of the drawings]
[0013] [Figure 1] Overall configuration diagram showing a vehicle driving control system [Diagram 2] An explanatory diagram showing road-to-vehicle communication and vehicle-to-vehicle communication. [Diagram 3] A diagram showing the path of a vehicle traveling on a curved road [Figure 4] A diagram showing the travel trajectory of a vehicle that changed lanes [Diagram 5] Flowchart showing a control example of a vehicle travel locus transmission system [Figure 6] A diagram showing the travel path of a vehicle traveling straight ahead [Figure 7] FIG. 7 is a diagram showing vehicle position coordinates and linear coordinates corresponding to FIG. 6. [Figure 8] FIG. 1 shows the travel path of a vehicle traveling around a curve [Figure 9] FIG. 9 is a diagram showing vehicle position coordinates and linear coordinates corresponding to FIG. 8. [Figure 10] A diagram showing the travel trajectory of a vehicle that changed lanes [Figure 11] FIG. 11 is a diagram showing vehicle position coordinates and linear coordinates corresponding to FIG. 10. [Figure 12] A flow chart showing an example of control when a vehicle traffic control system receives the position coordinates of a new vehicle. [Figure 13] 1 is a flowchart showing an example of control when a vehicle traffic control system performs map matching of a vehicle's travel trajectory. [Figure 14] An explanatory diagram when the control device performs map matching on the travel trajectory of a vehicle traveling along a curve, including straight lines. [Figure 15]An explanatory diagram of how the control device performs map matching on the travel trajectory of a vehicle that changes lanes, including travelling in a straight line. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0014] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS The present invention will be described below with reference to the accompanying drawings, in which: FIG 1 is a diagram showing the overall configuration of a cruise control system according to an embodiment of the present invention;
[0015] 1 and 2, the cruise control system 1 in this embodiment includes cruise control devices 10 mounted on a plurality of vehicles, and a plurality of control devices 100 provided in a network environment NW to which the plurality of cruise control devices 10 are connected via wireless communication. The control device 100 is provided as a server device in a network environment based on cloud computing or edge computing, or a network environment based on a roadside facility network, for example.
[0016] The control device 100 sequentially integrates and updates the road map information transmitted from the cruise control device 10 of each vehicle, and transmits the updated road map information to each vehicle. For this reason, the control device 100 is configured to include a road map information integration_ECU 101, which is an internal server, and a transceiver 102.
[0017] The road map information integration_ECU 101 integrates road map information collected from multiple vehicles through the transceiver 102, and sequentially updates road map information surrounding a vehicle on a road. The road map information is, for example, a dynamic map, and has four layers of information: static information and quasi-static information that mainly constitute road information, and quasi-dynamic information and dynamic information that mainly constitute traffic information.
[0018] Static information consists of information that needs to be updated within one month, such as roads and road structures, lane information, road surface information, permanent traffic regulation information, etc. Semi-static information consists of information that needs to be updated within one hour, such as traffic regulation information due to road construction or events, wide-area weather information, and traffic congestion forecasts.
[0019] Semi-dynamic information consists of information that requires updating, for example, within one minute, such as the actual traffic congestion situation and driving restrictions at the time of observation, primary driving obstacle situations such as fallen objects and obstacles, actual accident conditions, and narrow-area weather information.
[0020] Dynamic information consists of information that must be updated within one second, such as information transmitted and exchanged between moving objects, information on currently displayed traffic signals, information on pedestrians / motorcycles within an intersection, and information on vehicles traveling straight through an intersection.
[0021] Such road map information is maintained / updated periodically until the next information is received from each vehicle, and the updated road map information is appropriately transmitted to each vehicle via the transceiver 102.
[0022] The vehicle driving control device 10 has a locator unit 12 as a unit for recognizing the driving environment outside the vehicle. The driving control device 10 also includes a driving control unit (hereinafter referred to as "driving_ECU") 22, an engine control unit (hereinafter referred to as "E / G_ECU") 23, a power steering control unit (hereinafter referred to as "PS_ECU") 24 which is a steering control unit, and a brake control unit (hereinafter referred to as "BK_ECU") 25. These control units 22 to 25 are connected to the driving environment recognition unit 11 and the locator unit 12 via an in-vehicle communication line such as a CAN (Controller Area Network).
[0023] Locator unit 12 estimates the vehicle's position on a road map, and has locator calculation section 13, which is a locator calculation device that estimates the vehicle's position. Sensors required for estimating the position of vehicle M (vehicle position) are connected to the input side of locator calculation section 13, such as acceleration sensor 14 that detects the acceleration in the front, rear, left and right directions of vehicle M, wheel speed sensor 15 that detects the rotational speed of each of the front, rear, left and right wheels, gyro sensor 16 that detects the angular velocity or angular acceleration of the vehicle, and GNSS receiver 17 that receives positioning signals transmitted from multiple positioning satellites.
[0024] In addition, the locator calculation unit 13 is connected to a vehicle-side transceiver 18 for transmitting and receiving information with the control device 100 (road-to-vehicle communication: see the dashed line in Figure 2) and for transmitting and receiving information with other vehicles (vehicle-to-vehicle communication: see the dashed line in Figure 2).
[0025] Furthermore, a high-precision road map database 19 is connected to locator calculation unit 13. High-precision road map database 19 is a large-capacity storage medium such as an HDD, and stores high-precision road map information (dynamic map). Note that the road map information may be received from a device outside the vehicle and provided to locator calculation unit 13.
[0026] This high-precision road map information has, for example, the same information as the road map information that is sequentially updated in the above-mentioned road map information integration_ECU 101, as information required for driving control of the vehicle M. That is, the high-precision road map information has four layers of information consisting of static information and quasi-static information that mainly constitute road information, and quasi-dynamic information and dynamic information that mainly constitute traffic information.
[0027] The locator calculation unit 13 includes a map information acquisition unit 13a, a vehicle position estimation unit 13b, and a driving environment recognition unit 13c. The map information acquisition unit 13a acquires route map information from a current location to a destination from map information stored in a high-precision road map database 19, based on a destination set by a driver during automatic driving, for example.
[0028] The map information acquisition unit 13a also transmits the acquired route map information (lane data on the route map) to the vehicle position estimation unit 13b. The vehicle position estimation unit 13b acquires the position coordinates of the vehicle M based on the positioning signal received by the GNSS receiver 17.
[0029] Furthermore, the vehicle position estimation unit 13b map-matches the acquired position coordinates on the route map information to estimate the vehicle position on the road map, recognizes the left and right lane dividing lines that divide the vehicle's driving path (driving lane), and acquires the road curvature at the center of the driving lane stored in the road map data.
[0030] In addition, in an environment where a valid positioning signal from a positioning satellite cannot be received due to reduced sensitivity of the GNSS receiver 17, such as when driving inside a tunnel, the vehicle position estimation unit 13b switches to autonomous navigation, which estimates the vehicle position based on the vehicle speed calculated based on the wheel speed detected by the wheel speed sensor 15, the angular velocity detected by the gyro sensor 16, and the forward / backward / left / right acceleration detected by the acceleration sensor 14, and estimates the vehicle position on a road map.
[0031] Furthermore, when the vehicle position estimation unit 13b estimates the vehicle position on a road map based on the positioning signal received by the GNSS receiver 17 or information detected by the gyro sensor 16, as described above, it determines the road type of the road on which the vehicle M is traveling, etc., based on the estimated vehicle position on the road map.
[0032] The driving environment recognition unit 13c updates the road map information stored in or received from the high-precision road map database 19 to the latest state by using road map information acquired by external communication (roadside-to-vehicle communication and vehicle-to-vehicle communication) via the transceiver 18. This information update is performed not only on static information, but also on semi-static information, semi-dynamic information, and dynamic information.
[0033] As a result, the road map information includes road information and traffic information acquired through communication with the outside of the vehicle, and information on moving bodies such as vehicles traveling on the roads is updated in real time.
[0034] In addition, the driving environment recognition unit 13c updates the road map information stored in or received from the high-precision road map database 19 to the latest information. This information update is performed not only on static information, but also on semi-static information, semi-dynamic information, and dynamic information.
[0035] Furthermore, the driving environment recognition unit 13c recognizes, from among the updated road map information, road map information of a set range centered on the vehicle position estimated by the vehicle position estimation unit 13b, as driving environment information.
[0036] Here, the range of the driving environment information recognized by the driving environment recognition unit 13c is, for example, road map information within a range of a radius of 1 km centered on the vehicle position, and the road map information is recognized as the driving environment information.
[0037] The driving environment information recognized by the driving environment recognition section 13c of the locator unit 12 is read by the driving_ECU 22.
[0038] In addition, various switches and sensors are connected to the input side of the driving_ECU 22 (none of which are shown in the figure), such as a mode changeover switch that allows the driver to switch automatic driving (driving control) on / off, a steering torque sensor that detects steering torque as an amount of driving operation by the driver, a brake sensor that detects the amount of depression of the brake pedal as an amount of driving operation by the driver, an accelerator sensor that detects the amount of depression of the accelerator pedal as an amount of driving operation by the driver, and a yaw rate sensor that detects the yaw rate acting on the vehicle M.
[0039] The driving modes set in the travel_ECU 22 are a manual driving mode, a first driving control mode and a second driving control mode for driving control, and an evacuation mode. These driving modes can be selectively switched in the travel_ECU 22 based on the operation status of a mode selector switch, etc.
[0040] Here, the manual driving mode is a driving mode that requires the driver to maintain steering, for example, a driving mode in which the vehicle M is driven according to driving operations such as steering, accelerator, and brake operations by the driver.
[0041] Similarly, the first driving control mode is a driving mode that requires the driver to maintain steering. That is, the first driving control mode is a so-called semi-automatic driving mode in which the vehicle M is driven along a target driving route by appropriately combining mainly the adaptive cruise control (ACC), the active lane keep centering (ALKC), and the active lane keep bouncing (ALKC) controls through the control of the E / G_ECU 23, the PS_ECU 24, the BK_ECU 25, etc. while reflecting the driving operation by the driver.
[0042] The second driving control mode is an autonomous driving mode in which vehicle M is driven along a target route (route map information) by performing an appropriate combination of preceding vehicle following control, lane centering control, and lane departure prevention control, for example, through control of E / G_ECU23, PS_ECU24, BK_ECU25, etc., without requiring the driver to maintain steering, operate the accelerator, or operate the brakes.
[0043] The evacuation mode is a mode for automatically stopping the vehicle M on a roadside or the like when, for example, while driving in the second driving control mode, driving in that mode cannot be continued and the driver is unable to take over driving operations (i.e., when it is unable to transition to the manual driving mode or the first driving control mode).
[0044] The output side of the E / G_ECU 23 is the throttle actuator. 27 This throttle actuator is connected. 27opens and closes the throttle valve of the electronically controlled throttle provided in the throttle body of the engine, and generates the desired engine output by opening and closing the throttle valve in response to a drive signal from the E / G_ECU 23 to adjust the intake air flow rate.
[0045] An electric power steering motor 28, which is a drive source, is connected to the output side of the PS_ECU 24. This electric power steering motor 28 applies steering torque to a steering mechanism by the rotational force of the motor, and in autonomous driving, lane centering control for maintaining driving in the current driving lane and lane change control for moving the vehicle M to an adjacent lane (lane change control for overtaking control, etc.) are executed by controlling the operation of the electric power steering motor 28 by a drive signal from the PS_ECU 24.
[0046] A brake actuator 29 is connected to the output side of the BK_ECU 25. This brake actuator 29 adjusts the brake hydraulic pressure supplied to the brake wheel cylinders provided on each wheel, and when the brake actuator 29 is driven by a drive signal from the BK_ECU 25, the brake wheel cylinders generate a braking force of a braking mechanism on each wheel, forcing the wheel to decelerate.
[0047] In addition, when the first driving control mode, the second driving control mode, or the evacuation mode other than the manual driving mode is selected, various information delivered from the control device 100 is input to the driving environment recognition unit 13c of the locator calculation unit 13, and based on the driving environment information, driving control is performed, for example, through the E / G_ECU 23, the PS_ECU 24, the BK_ECU 25, etc.
[0048] Here, the vehicle travel locus transmission system and the vehicle traffic control The system is described in detail below.
[0049] First, as shown in FIG. 3 and FIG. 4, the vehicle M periodically records its travel path in the form of the latest position coordinates, which are an orthogonal coordinate system of latitude / longitude, at a predetermined interval, for example, at intervals (periods) of 500 msec to 1 sec. (First position coordinates) Pn is detected, and the position coordinates in the Cartesian coordinate system, which are the latitude / longitude information detected last time (one cycle ago), are calculated. (Second position coordinates) Pn-1 and Pn-2 are linear function parameters that connect (First linear coordinate) Ln is generated and stored in association with the map information.
[0050] Specifically, vehicle M inputs position coordinates Pn, which is the vehicle position estimated in road map information (hereinafter sometimes referred to as road map data) based on latitude / longitude information detected by a positioning signal (including gyro sensor 16) received by GNSS receiver 17 at a predetermined interval (cycle), to locator calculation unit 13. Note that the positioning signal received by GNSS receiver 17 is not limited to one transmitted from a positioning satellite, and may be received from a communication base station or the like.
[0051] Then, the vehicle M updates the road map information stored (or received) in the high-precision road map database 19 by associating (projecting) the latest driving trajectory information with the new straight line connecting the position coordinate Pn and the previous (most recent) position coordinate Pn-1.
[0052] At this time, the locator calculation unit 13 calculates the linear coordinates of the previous (one cycle before) (Second linear coordinate) If the angle θ between the extension line of Ln-1 and the latest straight line coordinate Ln is within a predetermined threshold, for example an angle of ±2° (-2≦θ≦+2), the latest (present) straight line coordinate Ln is extended from the previous (most recent) straight line coordinate Ln-1, which is the past driving trajectory, and the entire driving trajectory that the vehicle M has traveled in the past is updated by associating it with the road map information.
[0053] The vehicle M transmits (uploads) the vehicle speed calculated based on the wheel speed detected by the wheel speed sensor 15 and the vehicle ID (vehicle identification information) from the transceiver 18 to the transceiver 102 on the device side of the control device 100.
[0054] The control device 100, using the road map information integration_ECU 101 as a server, calculates the travel distance of the vehicle M based on the vehicle speed of the received vehicle ID, and extends and associates a new linear travel trajectory (latest linear coordinate Ln) from the previous travel trajectory (previous linear coordinate Ln-1) to the road map information. In other words, when the control device 100 does not receive a new linear travel trajectory (latest linear coordinate Ln) and receives (transfers) only the vehicle ID and the vehicle speed, it determines that the vehicle M is traveling straight ahead, calculates the travel distance from the vehicle speed, and associates the latest travel trajectory on an extension line of the previous travel trajectory with the road map information.
[0055] On the other hand, when the angle θ between the extension line of the immediately preceding line coordinate Ln-1 and the latest line coordinate Ln exceeds a predetermined threshold, for example, within ±2° (-2≦θ≦+2) (-2°>Σθ or +2°<Σθ), vehicle M transmits (transfers) the linear function parameters of the latest line coordinate Ln, including the vehicle ID and position information, to the control device 100. That is, the locator calculation unit 13 transmits (uploads) the linear function parameters of the latest line coordinate Ln, including the vehicle ID and position information, from the transceiver 18 to the transceiver 102 of the control device 100.
[0056] In this case, the control device 100, using the road map information integration_ECU101, which is a server, updates the driving trajectory of vehicle M by matching and associating the latest straight line coordinate Ln with the stored road map information as the latest (current) driving trajectory of vehicle M based on the received linear function parameters (latest straight line coordinate Ln) including the vehicle ID and position information.
[0057] Here, the vehicle travel locus transmission system and the vehicle traffic control A specific example of the control of the system will be described below.
[0058] First, a control example of the vehicle travel locus transmission system will be described based on a routine shown in the flowchart of FIG.
[0059] First, the vehicle M acquires the position coordinates Pn (S1). Here, the GNSS receiver 17 receives positioning signals transmitted from a plurality of positioning satellites, and latitude / longitude information is input.
[0060] Next, the vehicle M determines whether the engine is starting (S2), and if the engine is starting, transmits (transfers) the vehicle ID and the position coordinate Pn (S3). Here, the locator calculation unit 13 transmits (transfers) the vehicle ID and the current vehicle position from the transceiver 18. year The position coordinate Pn, which is the latitude / longitude information of the vehicle M, is transmitted (transferred) to the control device 100. As a result, in the road map information integration_ECU 101 of the control device 100, the new vehicle ID (vehicle M) is associated with the road map information.
[0061] In step S2, if the engine is not starting, vehicle M transmits (transfers) the vehicle ID and vehicle speed information of the vehicle (S4). In this step S4, locator calculation unit 13 calculates the vehicle speed of vehicle M based on the wheel speed detected by wheel speed sensor 15, and transmits (transfers) the vehicle ID and the calculated vehicle speed from transceiver 18 to control device 100.
[0062] Next, the vehicle M linearizes the previous position coordinate Pn-1 and the current position coordinate Pn, and maps them on the road map information of the vehicle (S5). In this step S5, the locator calculation unit 13 generates the latest line coordinate Ln, which is a linear function parameter obtained by linearizing two points in an orthogonal coordinate system as the latitude / longitude information from the previous position coordinate Pn-1 to the current (latest) position coordinate Pn, and projects and associates the latest line coordinate Ln with the stored road map data.
[0063] The vehicle M determines whether the angle θ between the new (present) straight line coordinate Ln and an extension line of the previous (most recent) straight line coordinate Ln-1 is equal to or greater than a threshold value (S6). In this step S6, the locator calculation unit 13 calculates and determines whether the angle θ between the new (present) straight line coordinate Ln generated by the locator calculation unit 13 and the extension line of the previous (most recent) straight line coordinate Ln-1 of the map data is within a predetermined threshold value (±2°) range (-2°≦θ≦+2°).
[0064] In step S6, if the angle θ of the latest straight line coordinate Ln with respect to the extension line of the previous (most recent) straight line coordinate Ln-1 is within a predetermined threshold range (-2°≦θ≦+2°), the vehicle M determines whether the angle θ is 0° (θ=0°) (S7). In step S7, the locator calculation unit 13 calculates and determines whether the angle θ of the new (current) straight line coordinate Ln generated with respect to the extension line of the previous (most recent) straight line coordinate Ln-1 is 0°.
[0065] If the angle θ is not 0° (θ≠0°), the vehicle M accumulates the detected angle θ (S8). In this step S8, the locator calculation unit 13 calculates and stores an accumulated angle Σθ, which is the total angle accumulated each time the locator calculation unit 13 accumulates the angles θ that are less than ±2° that it has detected in the past.
[0066] Then, vehicle M determines whether the accumulated angle Σθ exceeds a predetermined threshold (-2°>Σθ or +2°<Σθ) (S9). In this step S9, locator calculation unit 13 determines whether the current accumulated angle Σθ calculated exceeds a predetermined threshold (-2°≦θ≦+2°) (-2°>Σθ or +2°<Σθ).
[0067] If the current accumulated angle Σθ exceeds the threshold value (-2°>Σθ or +2°<Σθ), the vehicle M resets the stored accumulated angle Σθ and maps the latest straight line coordinate Ln onto the road map information of the vehicle (S10).
[0068] In step S6, if the angle θ between the latest line coordinate Ln and the extension line of the previous line coordinate Ln-1 exceeds the threshold range (-2°≦θ≦+2°) (-2°>Σθ or +2°<Σθ), the vehicle M also proceeds to step S10 to reset the stored cumulative angle Σθ and map the latest line coordinate Ln to the road map information of the vehicle (S10). In this step S10, the locator calculation unit 13 resets the stored cumulative angle Σθ to 0 (zero) and projects and associates the latest line coordinate Ln with the stored road map data.
[0069] Then, vehicle M transmits (transfers) the vehicle ID and the latest straight line coordinate Ln (S11). In this step S11, locator calculation unit 13 transmits (transfers) the vehicle ID and the latest straight line coordinate Ln from transceiver 18 to control device 100.
[0070] In step S7, if the angle θ between the latest line coordinate Ln and the extension line of the previous line coordinate Ln-1 is 0° (θ=0°), the vehicle M extends the line coordinate Ln as the latest travel trajectory (S12). In step S12, the locator calculation unit 13 extends the latest line coordinate Ln to the previous line coordinate Ln-1, and projects and associates it with the stored road map data.
[0071] Here, a state in which the vehicle M is traveling straight ahead will be described with reference to FIG. 6 and FIG.
[0072] 6 and 7, when vehicle M is traveling straight ahead, in step S1, information such as latitude / longitude detected by a positioning signal received by GNSS receiver 17 (or gyro sensor 16, etc.) is input to locator calculation unit 13 at a predetermined period (e.g., intervals of 500 msec to 1 sec) as position coordinates Pn at that time. Note that position coordinates Pn-1 to Pn-5 indicate vehicle position coordinates previously input to locator calculation unit 13 at the predetermined period.
[0073] In addition, the straight line coordinates Ln-1 to Ln-5 are linear function parameters indicating a traveling trajectory of the vehicle M that was previously generated by the locator calculation unit 13 in step S5 above, connecting two position coordinates Pn-1 to Pn-5 at a predetermined period.
[0074] In steps S6 to S9, when the angle θ between the linear coordinate Ln of the linear function parameter generated at each predetermined cycle and the extension line of the previous linear coordinate Ln-1 is 0° (θ=0°) or within a predetermined threshold range (-2°≦θ≦+2°), the latest linear coordinate Ln is extended on the extension line of the linear coordinate Ln-1 in step S12. Note that the same control is performed each time past linear coordinates Ln-1 to Ln-5 are generated.
[0075] For example, as shown in Fig. 7, when the angle θ4 between the extension of the line coordinate Ln-5 and the line coordinate Ln-4 is on the plus side, the angle θ3 between the extension of the line coordinate Ln-4 and the line coordinate Ln-3 is on the minus side, so the current angle θ3 is subtracted from the previous angle θ4 (θ4-θ3). That is, here, the inclination direction of the line coordinate Ln to the left in the vehicle width direction of the vehicle M is defined as plus, and the inclination direction of the line coordinate Ln to the right in the vehicle width direction is defined as minus. Note that the definition of plus / minus for the inclination direction of the line coordinate Ln to the left and right in the vehicle width direction may be reversed.
[0076] Also, because the angle θ1 between the extension of the line coordinate Ln-2 and the line coordinate Ln-1 is on the plus side, the angle θ1 at this point is added (θ4-θ3+θ1). And because the angle θ between the extension of the line coordinate Ln-1 and the line coordinate Ln is on the minus side, the angle θ at this point is subtracted (θ4-θ3+θ1-θ). Here, the angle θ between the extension of the line coordinate Ln-3 and the line coordinate Ln-2 is set to 0°, so no addition or subtraction is performed on the angle θ at this point.
[0077] In this way, the locator calculation unit 13 of vehicle M determines that vehicle M is traveling straight until the accumulated angle Σθ (=···θ4-θ3+θ1-θ) exceeds the threshold value (-2°>Σθ or +2°<Σθ), and extends the latest straight line coordinate Ln to the traveling trajectory, projects it onto the stored road map data, and associates it.
[0078] Next, a state in which the vehicle M is traveling around a curve will be described with reference to FIG. 8 and FIG.
[0079] 8 and 9, when the vehicle M is traveling around a curve, in step S6, the locator calculation unit 13 detects angles θ (-2°>Σθ or +2°<Σθ) that the linear function parameters Ln-15 to Ln-8, which are generated at a predetermined cycle (e.g., at intervals of 500 msec to 1 sec), make with an extension of the previous linear coordinates Ln-16 to Ln-9, exceeding a predetermined threshold range (-2°≦θ≦+2°). Note that, in this case, it is assumed that all angles θ in the section of the linear coordinates Ln-15 to Ln-8 exceed the predetermined threshold range (-2°≦θ≦+2°) (-2°>Σθ or +2°<Σθ).
[0080] Here, while vehicle M is traveling around the curve, locator calculation unit 13 resets (zero resets) the accumulated angle Σθ in step S10, and projects and associates the latest straight line coordinates Ln-15 to Ln-8 each time onto the stored map data. Then, in step S11, locator calculation unit 13 transmits (uploads) the straight line coordinates Ln-15 to Ln-8 generated at every predetermined period to control device 100 together with the vehicle ID.
[0081] Furthermore, a state in which the vehicle M changes lanes will be described with reference to FIG. 10 and FIG.
[0082] 10 and 11, when the vehicle M is changing lanes, the locator calculation unit 13 detects an angle θ between the linear coordinates Ln-14, Ln-8, which are linear function parameters generated at a predetermined cycle (e.g., at intervals of 500 msec to 1 sec), and the extension of the previous linear coordinates Ln-15, Ln-9, that exceeds a predetermined threshold range (−2°≦θ≦+2°) (−2°>Σθ or +2°<Σθ). Note that, here, it is assumed that the angles θ in the sections of the linear coordinates Ln-13 to Ln-9 (position coordinates Pn-14 to Pn-9) and Ln-7 (position coordinates Pn-8 to Pn-7) during the lane change are all within the predetermined threshold range (−2°≦θ≦+2°).
[0083] When vehicle M is at position coordinate Pn-14, if locator calculation unit 13 in step S6 determines that the angle θ between line coordinate Ln-14 and an extension of the immediately preceding line coordinate Ln-15 is an angle (-2°>Σθ or +2°<Σθ) that exceeds a predetermined threshold range (-2°≦θ≦+2°), then in step S11, it transmits (uploads) line coordinate Ln-14 together with the vehicle ID to control device 100, and projects and associates it with the stored road map data. Note that vehicle M is traveling straight ahead in the section between position coordinates Pn-14 and Pn-9.
[0084] Thereafter, when vehicle M is at position coordinate Pn-8, if locator calculation unit 13 in step S6 determines that the angle θ between line coordinate Ln-8 and an extension of the immediately preceding line coordinate Ln-9 is an angle (-2°>Σθ or +2°<Σθ) that exceeds a predetermined threshold range (-2°≦θ≦+2°), then in step S11, line coordinate Ln-14 is transmitted (uploaded) to control device 100 together with the vehicle ID, and is projected onto and associated with the stored road map data. Note that vehicle M is traveling straight ahead in the section between position coordinates Pn-8 and Pn-7.
[0085] As described above, when vehicle M is traveling straight, it transmits (uploads) only the vehicle ID and vehicle speed to the control device 100 at a predetermined period, and does not transmit (upload) the latest straight line coordinate Ln to the control device 100, but stores it in the road map data stored in the locator calculation unit 13.
[0086] In addition, vehicle M transmits (uploads) its vehicle ID, vehicle speed and latest straight line coordinate Ln to the control device 100 only when the angle θ of the latest straight line coordinate Ln with respect to the extension line of the previous straight line coordinate Ln-1 due to driving around a curve, changing lanes, etc. exceeds a predetermined threshold value (±2°).
[0087] Although not described above, even when turning right or left, the vehicle M transmits (uploads) the latest straight line coordinate Ln to the control device 100 because the angle θ between the latest straight line coordinate Ln and the extension line of the straight line coordinate Ln-1 exceeds a predetermined threshold value (±2°).
[0088] next ,tube An example of control executed by the control device 100 will be described with reference to the routines shown in the flowcharts of FIGS.
[0089] tube 12, when the control device 100 receives a position coordinate Pn of a new vehicle ID (S21), the control device 100 maps (registers in map data) the vehicle ID from the position coordinate Pn (S22). When the road map information integration_ECU 101 receives the position coordinate Pn of the new vehicle ID in step S21, the road map information integration_ECU 101 associates the position coordinate Pn of the vehicle ID with the stored map information in step S22.
[0090] When the control device 100 receives the vehicle speed information of a vehicle ID that has already been mapped (registered in map data) (S31), it identifies the travel path of the vehicle ID (S32). In this step S32, the road map information integration_ECU101 searches for and identifies the previous (most recent) straight line coordinate Ln-1, which is the actual travel path of the vehicle ID registered in the map data, or the estimated travel path.
[0091] Next, the control device 100 judges whether or not the latest straight line coordinate Ln of the vehicle ID has been received (S33). In this step S33, the road map information integration_ECU 101 judges whether or not the latest straight line coordinate Ln of the vehicle ID has been received.
[0092] In step S33, if the latest straight line coordinate Ln of the vehicle ID is not received, the control device 100 calculates the travel distance from the vehicle speed information of the vehicle ID (S34). In this step S34, the road map information integration_ECU 101 calculates the travel distance from the vehicle speed information of the vehicle ID.
[0093] Then, the control device 100 extends the estimated travel path of the vehicle ID (S35). In this step S35, the road map information integration_ECU 101 extends the latest estimated travel path on an extension line of the estimated travel path up to the previous moment based on the travel distance of the vehicle ID, and performs map matching (registers it in the road map data).
[0094] In the control device 100, when the road map information integration_ECU 101 receives the latest straight line coordinate Ln of the vehicle ID in step S33, the road map information integration_ECU 101 executes a matching process between the latest straight line coordinate Ln of the vehicle ID and the map information (S36). In this step S36, the road map information integration_ECU 101 executes a matching process between the straight line coordinate Ln of the vehicle ID and the road map data for the previous estimated driving trajectory or straight line coordinate Ln-1 of the vehicle ID.
[0095] Then, the control device 100 performs map matching of the latest straight line coordinate Ln of the vehicle ID to the map information (S37). In this step S37, the road map information integration_ECU 101 performs map matching of the latest straight line coordinate Ln of the vehicle ID so that the latest straight line coordinate Ln of the vehicle ID is continuous with the previous estimated travel path or straight line coordinate Ln-1 of the vehicle ID.
[0096] Here, map matching between the estimated travel path and the actual travel path of the vehicle M by the control device 100 will be described with reference to FIG. 14 and FIG.
[0097] 14 and 15, when the vehicle M is traveling straight ahead, the control device 100 receives only the information of the vehicle ID and the vehicle speed Vn from the vehicle M at a predetermined cycle in the above step S31, and identifies an estimated traveling trajectory Tn-1 of the vehicle M immediately before, shown here by a dashed line, from this vehicle ID in the above step S31. Note that, when the control device 100 has received the immediately preceding linear coordinate (Ln-1) from the vehicle M, it identifies the linear coordinate (Ln-1) of the vehicle ID.
[0098] Then, in the above steps S34 and S35, the control device 100 performs map matching (registers in road map data) by extending an estimated driving trajectory Tn-1 calculated by calculating the travel distance from the vehicle speed Vn-1 of the vehicle M received immediately before, or an estimated driving trajectory Tn shown by a dashed line calculated by calculating the travel distance from the latest vehicle speed Vn onto an extension line of the straight-line coordinate (Ln-1).
[0099] On the other hand, when the vehicle M is traveling around a curve, as shown in FIG. 14, each time the control device 100 receives straight line coordinates Ln-15 to Ln8 from the vehicle M, it performs a matching process of the straight line coordinates Ln-15 to Ln8 shown by solid lines with road map data in step S36, and performs map matching together with the vehicle ID in step S37.
[0100] Furthermore, when the vehicle M is changing lanes, the control device 100 performs map matching on the straight line coordinates Ln-14 indicated by the solid line of the received vehicle ID, as shown in FIG.
[0101] Then, in the next period, the control device 100 receives only the information of the vehicle ID and the vehicle speed Vn, and so extends the estimated travel trajectory Tn-13 shown by the dashed line, which is calculated by calculating the travel distance from the latest vehicle speed Vn-13, onto an extension of the immediately preceding linear coordinate Ln-14, and maps it (registers it in the map data). Note that the control device 100 executes the same control as when the vehicle M is traveling straight ahead in the section from the estimated travel trajectory Tn-13 to the estimated travel trajectory Tn-9 shown by the dashed lines, at every predetermined period.
[0102] Then, when the control device 100 receives the straight line coordinate Ln-8 from the vehicle M, it maps (registers in map data) the straight line coordinate Ln-8 indicated by the solid line of the received vehicle ID.
[0103] As described above, when vehicle M is traveling straight, the straight-line coordinates Ln are not transmitted from vehicle M to the control device 100, so the control device 100 calculates the travel distance from the vehicle speed Vn of the vehicle ID received at a predetermined period of, for example, 500 msec to 1 sec, and registers the estimated traveling trajectory Tn of vehicle M in road map data (map matching).
[0104] Moreover, since the vehicle M transmits the linear coordinates Ln to the control device 100 only when the traveling direction of the vehicle M changes by more than a predetermined angle (±2°) due to driving around a curve, changing lanes, turning right or left, etc., the load of processing the position information data can be reduced and the amount of data to be stored can be minimized. That is, the control device 100 reduces the amount of communication data, which is the amount of longitude / latitude information indicating the vehicle's position from multiple vehicles (M), and therefore reduces the communication load with multiple vehicles (M), the data processing load, and the data storage capacity for storing the position information of multiple vehicles (M).
[0105] As described above, the vehicle travel trajectory transmission system and vehicle traffic system of this embodiment can reduce the communication load between the control device 100 and multiple vehicles (M), the data processing load of the control device 100, and the data storage capacity.
[0106] The control device 100 analyzes the driving trajectories of each of the multiple vehicles (M) on the road map data, and distributes driving support data such as the presence or absence of construction zones, parked vehicles (broken down vehicles, etc.), traffic congestion information, accident information, lane regulations, etc. to each vehicle (M).
[0107] Furthermore, locator calculation section 13 of locator unit 12 and road map information integration_ECU 101 of control device 100 each have a processor including a central processing unit (CPU) and storage devices such as ROM and RAM. Furthermore, all or part of the configuration of the multiple circuits of the processor may be implemented by software. For example, the CPU may read and execute various programs corresponding to the respective functions stored in the ROM.
[0108] Furthermore, all or part of the functions of the processor may be configured using logic circuits or analog circuits, and the processing of various programs may be realized by electronic circuits such as FPGAs.
[0109] The invention described in the above embodiments is not limited to those embodiments, and various modifications can be made in the implementation stage without departing from the gist of the invention. Furthermore, the above includes inventions at various stages, and various inventions can be extracted by appropriate combinations of the disclosed constituent elements.
[0110] For example, if the stated problem can be solved and the stated effect can be obtained even if some of the constituent elements are deleted from all the disclosed constituent elements, the configuration from which these constituent elements are deleted can be extracted as an invention. [Explanation of symbols]
[0111] 1. Driving control system 10. Driving control device 12 Locator unit 13 Locator calculation unit 13a Map information acquisition section 13b Vehicle position estimation unit 13c Driving environment recognition unit 15...Wheel speed sensor 16. Gyro sensor 17 GNSS receiver 18 Transmitter / Receiver 19 High-precision road map database 100...control device 101···Road map information integration_ECU 102 Transmitter / Receiver Ln: Linear coordinates (linear function parameters) M...Vehicle NW: Network environment Pn...Position coordinates Tn...Estimated travel trajectory Vn...Vehicle speed Σθ··cumulative angle θ... angle
Claims
[Claim 1] A GNSS receiver for receiving a positioning signal; a vehicle-side transceiver for transmitting and receiving information to and from the server device; A wheel speed sensor that detects the rotation speed of a wheel; A gyro sensor for detecting angular velocity or angular acceleration; an acceleration sensor for detecting acceleration; A vehicle travel locus transmission system mounted on a vehicle comprising: The traveling trajectory transmission system includes a locator calculation device that acquires position coordinates of the vehicle at predetermined intervals based on the positioning signal received by the GNSS receiver or detection signals of the wheel speed sensor, the gyro sensor, and the acceleration sensor, The locator calculation unit is when detecting that an engine start of the vehicle has been detected, first information including last acquired position coordinate information and identification information of the vehicle is transmitted from the vehicle-side transceiver to the server device; After transmitting the first information, a first line coordinate is generated as a linear function parameter connecting the latest first position coordinate and the second position coordinate one cycle before; calculating an angle between the first linear coordinates and an extension line of the second linear coordinates generated one cycle before in response to the generation of the first linear coordinates; determining whether the angle exceeds a predetermined threshold value in response to the calculation of the angle; in response to a determination that the formed angle exceeds the predetermined threshold value, transmitting second information including the latest information of the first straight line coordinates, information of the vehicle speed of the vehicle calculated based on the detection signal of the wheel speed sensor, and the identification information from the vehicle-side transceiver to the server device; In response to a determination that the formed angle does not exceed the predetermined threshold, a determination is made as to whether or not a cumulative angle obtained by accumulating all of the formed angles calculated after the second information was last transmitted exceeds the predetermined threshold; transmitting the second information from the vehicle-side transceiver to the server device in response to a determination that the accumulated angle exceeds the predetermined threshold value; a vehicle driving trajectory transmission system characterized in that, in response to a determination that the cumulative angle does not exceed the predetermined threshold, third information having only the vehicle speed information and the identification information is transmitted from the vehicle-side transceiver to the server device.
Citation Information
Patent Citations
Vehicle emergency reporting system and device therefor
JP1999345384A
Traveling body location management system
JP2004265040A
Position information collection apparatus, position information collection method, position information collection program, and in-vehicle device
JP2013140033A
Vehicle traveling track data recording device and method
JP2013186782A
Own vehicle position detection device
JP2019066193A
