VEHICULAR CONTROL METHOD AND CONTROL SYSTEM
20220340202 · 2022-10-27
Assignee
Inventors
- Michiharu YAMAMOTO (Tokai-shi, Aichi, JP)
- Tomohiko NAGAO (Tokai-shi, Aichi, JP)
- Hitoshi AOYAMA (Tokai-shi, Aichi, JP)
Cpc classification
B60W30/18163
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W2552/05
PERFORMING OPERATIONS; TRANSPORTING
B62D15/0255
PERFORMING OPERATIONS; TRANSPORTING
B62D15/0265
PERFORMING OPERATIONS; TRANSPORTING
G01V3/081
PHYSICS
International classification
B62D15/02
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A control system (1) for letting a vehicle travel by automatic steering is a system which includes a vehicle control part (112) which controls the vehicle so that a subject point set for the vehicle passes through a predetermined route, a subject-point selection processing part (113) which selects a subject point, and a subject-point updating processing part (114) which updates the subject point as a control subject as appropriate by setting the subject point newly selected by the subject-point selection processing part (113) as the control subject, and a highly-versatile system capable of automatic steering irrespective of the type of the vehicle or the shape of the route.
Claims
1. A vehicular control method for letting a vehicle travel by automatic steering, the control method executing: a traveling control process of controlling the vehicle so that a subject point set for the vehicle passes through a predetermined route defined in advance; a subject-point selection process of selecting a new subject point set as the subject point; and a subject-point updating process of updating the subject point as a control subject of the traveling control process to the new subject point selected by the subject-point selection process, wherein a route where the vehicle actually travels can be adjusted based on the predetermined route.
2. The vehicular control method in claim 1, wherein the subject-point selection process is a process of selecting, as the new subject point, a position having reflected thereon at least either one of a route specification, which is a shape specification of the predetermined route, and a vehicle specification, which is a specification of the vehicle.
3. The vehicular control method in claim 1, wherein the subject-point selection process is a process of selecting the new subject point by correcting an initially-set position of the subject point, and a correction amount of the initially-set position of the subject point by the subject-point selection process is an amount obtained by multiplying correction coefficient D1 representing a route specification, which is a shape specification of the predetermined route, and correction coefficient D2 representing a vehicle specification, which is a specification of the vehicle.
4. The vehicular control method in claim 3, wherein the correction coefficient D1 is a correction coefficient in accordance with a curvature of the predetermined route, and the correction coefficient D2 is a correction coefficient in proportion to a wheel base of the vehicle.
5. The vehicular control method in claim 3, wherein the correction coefficient D1 is a coefficient which becomes zero when the predetermined route is a straight road.
6. The vehicular control method in claim 3, wherein the correction coefficient D1 is a coefficient which varies in accordance with a lane width and a lane type.
7. The vehicular control method in claim 3, wherein the correction coefficient D2 is a coefficient which varies in accordance with a vehicle width.
8. The vehicular control method in claim 1, wherein the subject-point selection process can select the new subject point to avoid an obstacle on the predetermined route or change the lane during traveling.
9. The vehicular control method in claim 8, wherein the subject-point selection process can select a position outside the vehicle as the new subject point.
10. The vehicular control method in claim 1, wherein the subject-point selection process selects the new subject point by learning, during driving of the vehicle by a driver, a position of the vehicle preferred by the driver and using the result of learning the position of the vehicle.
11. A vehicular control system for letting a vehicle travel by automatic steering, the control system comprising: a vehicle control part which controls the vehicle so that a subject point set for the vehicle passes through a predetermined route defined in advance; a subject-point selection processing part which selects a new subject point set as the subject point; and a subject-point updating processing part which updates the subject point as a control subject of the vehicle control part to the new subject point selected by the subject-point selection processing part, wherein a route where the vehicle actually travels can be adjusted based on the predetermined route.
12. The vehicular control system in claim 11, wherein the subject-point selection processing part selects, as the new subject point, a position having reflected thereon at least either one of a route specification, which is a shape specification of a traveling route where the vehicle travels, and a vehicle specification, which is a specification of the vehicle.
13. The vehicular control system in claim 11, comprising an operating part to be operated by a driver to adjust a position of the vehicle in a vehicle-width direction on a traveling road, wherein the subject-point selection processing part corrects a position of the new subject point in accordance with operation by the driver on the operating part.
14. The vehicular control method in claim 1, wherein the predetermined route is a route along a lane sectioned by left and right lane marks on a road, the route being defined in accordance with a shape of the road.
15. The vehicular control system in claim 11, wherein the predetermined route is a route along a lane sectioned by left and right lane marks on a road, the route being defined in accordance with a shape of the road.
16. The vehicular control method in claim 2, wherein the subject-point selection process is a process of selecting the new subject point by correcting an initially-set position of the subject point, and a correction amount of the initially-set position of the subject point by the subject-point selection process is an amount obtained by multiplying correction coefficient D1 representing a route specification, which is a shape specification of the predetermined route, and correction coefficient D2 representing a vehicle specification, which is a specification of the vehicle.
17. The vehicular control method in claim 4, wherein the correction coefficient D1 is a coefficient which becomes zero when the predetermined route is a straight road.
18. The vehicular control method in claim 4, wherein the correction coefficient D1 is a coefficient which varies in accordance with a lane width and a lane type.
19. The vehicular control method in claim 3, wherein the subject-point selection process can select the new subject point to avoid an obstacle on the predetermined route or change the lane during traveling.
20. The vehicular control method in claim 19, wherein the subject-point selection process can select a position outside the vehicle as the new subject point.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
DESCRIPTION OF EMBODIMENTS
[0036] Modes of the present invention are specifically described by using the following embodiments.
First Embodiment
[0037] The present embodiment is an example regarding a control method and control system for letting vehicle 5 travel along a target route set in advance (one example of a predetermined route). Details of this are described by using
[0038] Automatic driving system 1 as one example of a control system is configured to include, as in
[0039] In the following, (1) magnetic marker 30 to be laid in a road is generally described, and then details of (2) sensor unit 2, (3) tag reader 13, (4) positioning unit 12, and (5) traveling control unit 11 are described.
[0040] (1) Magnetic Marker
[0041] Magnetic marker 30 is, as in
[0042] The magnetic marker 30 has a columnar shape having a diameter of 20 mm and a height of 28 mm. This magnetic marker 30 is laid in a state of being accommodated in a hole provided in road surface 300S. A magnet forming magnetic marker 30 is a ferrite plastic magnet with magnetic powder of iron oxide as a magnetic material dispersed in a polymer material as a base material. The maximum energy product (BHmax) of this magnet is 6.4 kJ/square m.
[0043] Specifications of magnetic marker 30 of the present embodiment are partially depicted in Table 1.
TABLE-US-00001 TABLE 1 Type of magnet Ferrite plastic magnet Diameter Ø 20 mm Height 28 mm Magnetic flux density Gs 45 mT at the surface
[0044] Magnetic marker 30 acts with magnetism of a magnetic flux density of 8 μT (microtesla) at an upper-limit height of 250 mm in a range from 100 mm to 250 mm assumed as an attachment height of sensor unit 2. Also, in this magnetic marker 30, a magnetic flux density Gs of the surface indicating a magnetic strength on the surface is 45 mT.
[0045] In magnetic marker 30 of the present embodiment, as in
[0046] Here, as described above, magnetic marker 30 is the magnet with magnetic powder of iron oxide dispersed in the polymer material. This magnet has low conductivity and is hard to cause eddy current or the like at the time of wireless power feeding. Therefore, RFID tag 35 annexed to magnetic marker 30 can efficiently receive wirelessly-transmitted power.
[0047] RFID tag 35 is an electronic component having IC chip 357 implemented on a surface of tag sheet 350 (
[0048] (2) Sensor Unit
[0049] Sensor unit 2 is, as in
[0050] Magnetic sensor array 21 (
[0051] Magnetic sensors Cn are sensors which detect magnetism by using the known MI effect (Magnet Impedance Effect) in which impedance of a magneto-sensitive body such as an amorphous wire sensitively changes in response to an external magnetic field. Magnetic sensors Cn have magnetic sensitivity in the longitudinal direction of the amorphous wire.
[0052] In magnetic sensors Cn of the present embodiment, magneto-sensitive bodies, not depicted, such as amorphous wires are arranged along two orthogonal axial directions. According to magnetic sensors Cn, magnetism acting on the two orthogonal axial directions can be detected. Note that in sensor unit 2 of the present embodiment, magnetic sensors Cn are incorporated so as to be able to detect magnetic components in a forwarding direction and the vehicle-width direction in a state of being attached to vehicle 5.
[0053] Magnetic sensors Cn are highly-sensitive sensors having a measurement range of the magnetic flux density of ±0.6 mT and a magnetic flux resolution of 0.02 μT within the measurement range. In the present embodiment, a frequency of magnetic measurement by each magnetic sensor Cn of sensor unit 2 is set at 3 kHz so as to support high-speed vehicle traveling.
[0054] Specifications of magnetic sensor Cn are partially depicted in Table 2.
TABLE-US-00002 TABLE 2 Me asurernent range ±0.6 mT Magnetic flux resolution 0.02 μT Sampling frequency 3 kHz
[0055] As described above, magnetic marker 30 can act with magnetism having the magnetic flux density equal to or larger than 8 μT in the range from 100 mm to 250 mm assumed as the attachment height of magnetic sensors Cn. Magnetic marker 30 acting with magnetism having the magnetic flux density equal to or larger than 8 μT can be detected with high reliability by using magnetic sensors Cn having the magnetic flux resolution of 0.02 μT.
[0056] Detection processing circuit 212 (
[0057] Detection processing circuit 212 obtains a sensor signal outputted from each of magnetic sensors Cn at the frequency of 3 kHz to perform marker detection process. Detection processing circuit 212 inputs detection result of the marker detection process to positioning unit 12. Although details will be described further below, in this marker detection process, in addition to detection of magnetic marker 30, measurement of a lateral shift amount of a subject point of vehicle 5 with respect to magnetic marker 30 is performed.
[0058] IMU 22 (
[0059] (3) Tag Reader
[0060] Tag reader 13 (
[0061] (4) Positioning Unit
[0062] Positioning unit 12 (
[0063] Positioning unit 12 includes an electronic substrate (omitted in the drawing) having implemented thereon a CPU which performs various computations, memory elements such as a ROM and a RAM, and so forth. A method of identifying the own vehicle position by positioning unit 12 varies depending on a case when vehicle 5 reaches magnetic marker 30 or a case when vehicle 5 is positioned in an intermediate position between adjacent magnetic markers 30. Although details will be described further below, in the former case, positioning unit 12 estimates the own vehicle position based on the position data (marker position information) received from RFID tag 35. On the other hand, in the latter case, the own vehicle position is identified based on the relative position of vehicle 5 estimated by inertial navigation.
[0064] (5) Traveling Control Unit
[0065] Traveling control unit 11 (
[0066] To traveling control unit 11, map database (map DB) 110 having stored therein detailed three-dimensional map data (3D map data) is connected. Furthermore, what are controllably connected in to traveling control unit 11 are steering unit 151, engine throttle 152, brake actuator 153, and so forth.
[0067] Traveling control unit 11 includes an electronic substrate having implemented thereon a CPU, memory devices such as a ROM and a RAM, an I/O chip for external input/output, and so forth not depicted. For example, with the CPU executing a program read from the ROM, traveling control unit 11 achieves functions as respective parts 111 to 114 described above. Also, in a storage area of the ROM, data regarding vehicle specifications is stored, such as the vehicle width, which is a lateral-width dimension of vehicle 5; a wheel base, which is an interaxial distance between a front-wheel axis and a rear-wheel axis.
[0068] Next, (A) marker detection process, (B) traveling control process, and (C) subject-point selecting process of the present embodiment are described.
[0069] (A) Marker Detection Process
[0070] The marker detection process is a process to be performed by magnetic sensor array 21. Magnetic sensor array 21 performs, as described above, marker detection process at the frequency of 3 kHz by using magnetic sensors Cn.
[0071] As described above, magnetic sensors Cn can measure magnetic components in the forwarding direction and the vehicle-width direction of vehicle 5. For example, when these magnetic sensors Cn move in the forwarding direction to pass directly above magnetic marker 30, the magnetic measurement value in the forwarding direction has its sign reversed before and after passing magnetic marker 30 as in
[0072] Also, for example, as for a magnetic sensor with the same specification as that of magnetic sensors Cn, a movement along a virtual line in the vehicle-width direction passing directly above magnetic marker 30 is assumed. In this case, the magnetic measurement value in the vehicle-width direction has its sign reversed on both sides across magnetic marker 30 and changes so as to cross zero at a position directly above magnetic marker 30. Therefore, in the case of magnetic sensor array 21 having fifteen magnetic sensors Cn arrayed in the vehicle-width direction, the sign of the magnetic measurement value in the vehicle-width direction to be detected by magnetic sensor Cn varies depending on which side the magnetic sensor is present with respect to magnetic marker 30 (
[0073] In a distribution of
[0074] Detection processing circuit 212 measures a deviation of the subject point of vehicle 5 in the vehicle-width direction with respect to magnetic marker 30 as the lateral shift amount. For example, when the center of vehicle 5 in the vehicle-width direction is selected as a subject point, the position of magnetic sensor C8 at the center of sensor unit 2 is the subject point. For example, in the case of
[0075] (B) Traveling Control Process
[0076] Next, an entire operation of automatic driving system 1 is described with reference to
[0077] In automatic driving system 1, the driver can set a destination by using, for example, a vehicle onboard monitor such as a touch panel, a voice input system, or the like. Upon obtaining the destination inputted by the driver (S101), traveling control unit 11 refers to the 3D map data stored in map DB 110 to perform route calculation for generation of route data (S102).
[0078] Here, the route data is data representing target route 1R for letting the subject point of vehicle 5 pass at the time of automatic driving control. For example, as target route 1R exemplarily depicted in
[0079] In automatic driving control, vehicle 5 is controlled so that the subject point of vehicle 5 passes through target route 1R (predetermined route). Note that the subject point of vehicle 5 is updated as occasion arises during automatic driving control. The own vehicle position in the following description means an absolute position of the subject point being set.
[0080] During automatic driving control, positioning unit 12 controls sensor unit 2 to cause the above-described marker detection process to be repeatedly performed (S201). If magnetic marker 30 has been detected (S202: YES), positioning unit 12 obtains the lateral shift amount of the subject point with respect to that magnetic marker 30 and also obtains marker position information (position data) of RFID tag 35 (S223).
[0081] Positioning unit 12 identifies, as the own vehicle position (exemplarily indicated by a Δ mark in
[0082] On the other hand, when vehicle 5 is positioned in the intermediate position between adjacent magnetic markers 30 and any magnetic marker 30 cannot be detected (S202: NO), positioning unit 12 estimates a relative position of vehicle 5 with respect to the latest own vehicle position identified at the time of detection of magnetic marker 30 (position indicated by the A mark in
[0083] As exemplarily depicted in
[0084] Upon obtaining the own vehicle position, traveling control unit 11 identifies the own vehicle position in target route 1R. Then, traveling control unit 11 identifies the shape of the route ahead of vehicle 5 (S103). Traveling control unit 11 identifies, for example, a curvature of a curve ahead or the like as a route specification, which is a shape specification of the route of vehicle 5 ahead. Here, the shape of the route ahead means a route shape several meters ahead of vehicle 5. Note that, in place of the one several meters ahead, the route shape may be a route shape at a location several tens of meters ahead or at a location vehicle 5 has reached (zero meter ahead). For example, if the route shape has been identified before a location, its route shape may be identified when it is estimated to have reached at that location.
[0085] By using route specifications and the vehicle specifications stored in the ROM, traveling control unit 11 selects a new subject point (S104, subject-point selection process). In this subject-point selection process, for example, a position having reflected thereon a route specification such as the curvature of a curve, and a vehicle specification such as the vehicle width or wheel base is selected as a new subject point. Note that a new subject point may be selected in consideration of only either one of the route specification and the vehicle specification. Note that details of the subject-point selection process will be described further below.
[0086] Traveling control unit 11 updates the subject point as a control subject with the subject point newly selected at step S104 (S105, subject-point updating process). Then, for the newly updated subject point, as in
[0087] Here, target route 1R represented by the route data of the present embodiment indicates a position at the center of lane 300 forming a traveling route, that is, a position on the laying line of magnetic markers 30. For example, if the position of magnetic sensor C8 corresponding to the center in the vehicle-width direction is set as subject point 1S, as in
[0088] (C) Subject-Point Selection Process
[0089] The subject-point selection process at step S104 in
[0090] In automatic driving system 1 of the present embodiment, correction coefficients (
[0091] In the subject-point selection process, for example, a new subject point is selected by solving the following Equation 1.
(new subject point)=(initially-set subject point)±(D1×D2) [Equation 1]
[0092] The initially-set subject point in Equation 1 is a subject point suitable for, for example, a straight road. For example, the position of magnetic sensor C8 corresponding to the center of vehicle 5 is set. When the position of magnetic sensor C8 is the initially-set subject point, the value (initially-set subject point) in Equation 1 is 8. Also, for example, when a value of 3 is calculated (as new subject point) by Equation 1, the position of magnetic sensor C3 is selected as a new subject point.
[0093] In Equation 1, “±” for switching whether the correction amount (D1×D2) is added to or subtracted from the initially-set subject point is defined depending on a left curve or right curve. In the case of a left curve, in consideration of the inner wheel difference, vehicle 5 is required to be pulled to the right in the lane. Thus, in the case of a left curve, the correction amount is preferably subtracted from the initially-set subject point so as to allow a leftward subject point to be selected. In this case, the above-described Equation 1 is (initially-set subject point)−(D1×D2). On the other hand, in the case of a right curve, in consideration of the inner wheel difference, vehicle 5 is required to be pulled to the left in the lane. Thus, in the case of a right curve, the correction amount is preferably added to the initially-set subject point so as to allow a rightward subject point to be selected. In this case, the above-described Equation 1 is (initially-set subject point)+(D1×D2).
[0094] According to the above-described Equation 1, an appropriate subject point can be calculated in accordance with whether the route ahead (several meters ahead) is straight or curved. For example, when the route ahead is in a straight line, the curvature is approximately zero, and correction coefficient D1 is thus approximately zero. Therefore, when the route ahead is in a straight line, irrespective of the value of correction coefficient D2, the correction amount is approximately zero, and a subject point positioned close to the initially-set subject point is selected. On the other hand, when the route ahead is curved, correction coefficient D1 has a large value, and the correction amount becomes a large amount. With this, a subject point positioned away from the initially-set subject point is selected.
[0095] In this manner, the subject-point selection process with Equation 1 described above is a process in which correction of the subject point is not performed when the route ahead is in a straight line and the degree of correction of the subject point is intensified when the curvature of the curve ahead is large. Note that the degree of correction varies also depending on vehicle width W. As vehicle width W is larger, correction coefficients D1 and D2 increase (refer to
[0096] Here, the significance of correction of the subject point is described by taking, as an example, a case in which vehicle 5 passes through a tight left curve.
[0097] In the subject-point selection process with Equation 1 described above, when the road is a straight road, for example, a point near the position of magnetic sensor C8, which is the initially-set subject position, is selected as a subject point. On the other hand, when the road is a left curve, a subject point leftward of the position of magnetic sensor C8 is selected by correction. When vehicle 5 passes through a route of
[0098] If a subject point is selected by the subject-point selection process with Equation 1 described above in the above-described manner, while the position of vehicle 5 in the lane going straight ahead is appropriately held, the path of the left rear wheel on the inner side of the curve can be made favorable. Path RG of the left rear wheel of vehicle 5 is, as in
[0099] Also, in the subject-point selection process of the present embodiment, as the wheel base is longer, correction coefficient D2 (
[0100] As described above, automatic driving system 1 of the present embodiment is a system which lets vehicle 5 travel by automatic steering so that the subject point of vehicle 5 passes through target route 1R. Automatic driving system 1 has one of technical features in selecting a subject point as a control subject and updating it as occasion arises.
[0101] In automatic driving system 1, by updating the subject point as a control subject, the route where vehicle 5 actually travels can be adjusted. In this automatic driving system 1, in adjusting the actual traveling route of vehicle 5, it is less necessary to change the control specifications and the target route. Automatic driving system 1 can adjust the actual traveling route of vehicle 5 without changing the control specifications and the target route, and can be applied with high versatility to various vehicle types and traveling roads.
[0102] Note that the curvature of the curve is exemplarily described as a route specification in the present embodiment. The lane width and the type of the lane may be included in route specifications. This is because it is more required to control the position of the vehicle on the lane with high accuracy as the lane width is narrower. As the type of the lane, there are types such as an expressway or ordinary road; an outer lane or inner lane of two lanes on one side, and so forth.
[0103] Note that while the position of vehicle 5 in the lane is generally at the center, a driver who prefers a leftward or rightward position is present. Thus, setting screen 50 (
[0104] Furthermore, a driver-preferred position of the vehicle may be learnt from the position of the vehicle during manual driving or the like. Furthermore, a driver-preferred position of the vehicle may be learnt by differentiation for each road type. In this case, the traveling control unit can finely select a subject point by using the results of learning the driver's preference for each road type. If a subject point is selected in accordance with the drive in this manner, the traveling route of vehicle 5 by automatic driving can be made closer to the traveling route when the driver drives, thereby reducing a sense of incongruity the driver can feel during automatic driving.
[0105] In the present embodiment, the configuration is exemplarily described in which any position on the straight line where fifteen magnetic sensors Cn are arrayed is selected as a vehicle subject point. In place of this configuration, a subject point may be two-dimensionally selected in a horizontal plane parallel to the road surface. In this case, a subject point may be selected irrespective of the inside or outside of the vehicle. For example, as in
[0106] According to the configuration of the present embodiment, by selecting subject point 1S as a control subject, it is possible to perform control for avoiding an obstacle on target route 1R, control for making a lane change, and so forth. In this case, if subject point 1S positioned outside vehicle 5 is selected, it is possible to perform lateral control with a displacement amount in a lateral direction as exceeding the vehicle width or a half of the vehicle width. For example, as in
[0107] Note that in place of or in addition to correction coefficient D1 (
(New subject point)=(initially-set subject point)±(D1×D2×D3) [Equation 2]
[0108] In the foregoing, specific examples of the present invention are described in detail as in the embodiments, these specific examples merely disclose examples of technology included in the scope of the claims. Needless to say, the scope of the claims should not be restrictively construed based on the configuration, numerical values, and so forth of the specific examples. The scope of the claims includes technologies acquired by variously modifying, changing, or combining as appropriate the above-described specific examples by using known technologies, knowledge of a person skilled in the art, and so forth.
REFERENCE SIGNS LIST
[0109] 1 automatic driving system (control system) [0110] 1R target route (predetermined route) [0111] 1S subject point [0112] 11 traveling control unit [0113] 12 positioning unit [0114] 13 tag reader [0115] 110 map database (map DB) [0116] 111 route data generating part [0117] 112 vehicle control part [0118] 113 subject-point selection processing part [0119] 114 subject-point updating processing part [0120] 2 sensor unit [0121] 21 magnetic sensor array [0122] 212 detection processing circuit [0123] 22 IMU [0124] 30 magnetic marker [0125] 35 RFID tag [0126] 5 vehicle