The present invention relates to a control method and control system for letting a vehicle travel by automatic steering.
Conventionally, a car navigation system has been known in which, for example, GPS waves are received to measure a vehicle position and the vehicle is guided to a destination set in advance (refer to, for example, Patent Literature 1 mentioned below). According to driving assist control such as voice output for guiding a route, it is possible to efficiently arrive at the destination without losing the route even during movement in an unfamiliar area.
Furthermore, for example, there is also a suggestion of a driving assist system using 3D map data which three-dimensionally represents a road environment including peripheral environments such as surrounding buildings, guardrails, signs, and curbs. According to this driving assist system, for example, by mapping an own vehicle position on the 3D map data, it is possible to achieve sophisticated driving assist including automatic driving. If automatic driving becomes possible, load of driving the vehicle can be reduced.
Patent Literature 1: Japanese Unexamined Patent Application Publication No. 2001-264076
However, the above-described vehicular systems have the following problems. That is, there are problems in which an appropriate traveling route varies in accordance with the type of a vehicle as a control subject, the shape of a traveling road, and so forth, and it is not easy to achieve highly-versatile control specifications.
The present invention was made in view of the above-described conventional problems, and is to provide a highly-versatile automatic-steering control method and control system.
One mode of the present invention resides in a vehicular control method for letting a vehicle travel by automatic steering, the control method executing:
One mode of the present invention resides in a vehicular control system for letting a vehicle travel by automatic steering, the control system including:
The vehicle control method and control system according to the present invention are a control method and so forth which let the vehicle travel by automatic steering so that the subject point set for the vehicle passes through the predetermined route. The present invention has one of technical features in selecting the new subject point set as the subject point as the control subject and updating the subject point.
In the control method and so forth according to the present invention, by updating the subject point as a control subject, the route where the vehicle actually travels can be adjusted. In the present invention, to adjust the actual traveling route, it is less necessary to change the control specifications. In this manner, the control method and control system according to the present invention are highly-versatile control method and control system which can adjust the traveling route of the vehicle without greatly changing the control specifications.
Modes of the present invention are specifically described by using the following embodiments.
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
Automatic driving system 1 as one example of a control system is configured to include, as in
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.
(1) Magnetic Marker
Magnetic marker 30 is, as in
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.
Specifications of magnetic marker 30 of the present embodiment are partially depicted in Table 1.
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.
In magnetic marker 30 of the present embodiment, as in
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.
RFID tag 35 is an electronic component having IC chip 357 implemented on a surface of tag sheet 350 (
(2) Sensor Unit
Sensor unit 2 is, as in
Magnetic sensor array 21 (
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.
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.
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.
Specifications of magnetic sensor Cn are partially depicted in Table 2.
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.
Detection processing circuit 212 (
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.
IMU 22 (
(3) Tag Reader
Tag reader 13 (
(4) Positioning Unit
Positioning unit 12 (
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.
(5) Traveling Control Unit
Traveling control unit 11 (
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.
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.
Next, (A) marker detection process, (B) traveling control process, and (C) subject-point selecting process of the present embodiment are described.
(A) Marker Detection Process
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.
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
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 (
In a distribution of
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
(B) Traveling Control Process
Next, an entire operation of automatic driving system 1 is described with reference to
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).
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
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.
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).
Positioning unit 12 identifies, as the own vehicle position (exemplarily indicated by a Δ mark in
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
As exemplarily depicted in
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.
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.
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
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
(C) Subject-Point Selection Process
The subject-point selection process at step S104 in
In automatic driving system 1 of the present embodiment, correction coefficients (
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]
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.
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).
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.
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
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.
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
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
Also, in the subject-point selection process of the present embodiment, as the wheel base is longer, correction coefficient D2 (
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.
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.
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.
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 (
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.
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
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
Note that in place of or in addition to correction coefficient D1 (
(New subject point)=(initially-set subject point)±(D1×D2×D3) [Equation 2]
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.
Number | Date | Country | Kind |
---|---|---|---|
2019-115911 | Jun 2019 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2020/024003 | 6/18/2020 | WO |