Vehicle control system
11709239 · 2023-07-25
Assignee
Inventors
Cpc classification
International classification
Abstract
The vehicle control system comprises a vehicle speed acquisition device, a rotary-typed LIDAR and a controller. The vehicle speed acquisition device is configured to acquire traveling speed of a vehicle. The LIDAR is configured to acquire surrounding information of the vehicle using a laser beam. The controller is configured to control a rotational movement of the LIDAR. The controller is configured to execute processing to set a cycle of the rotational movement based on the traveling speed. In the setting processing, the controller is configured to set the cycle during the traveling speed is relatively fast to a longer cycle than that during the traveling speed is relatively slow.
Claims
1. A vehicle control system, comprising: a vehicle speed sensor which is configured to acquire traveling speed of a vehicle; a LIDAR which is configured to acquire surrounding information of the vehicle using a laser beam, the LIDAR includes a movable mirror; and a controller which is configured to control a rotational movement of the movable mirror, wherein the controller is further configured to execute processing to set a cycle of the rotational movement based on the traveling speed such that the cycle of the rotational movement is longer at a faster speed than at a slower speed, wherein the slower speed is slower than the faster speed, wherein the controller is further configured to execute processing to set a rotational speed of the movable mirror based on the traveling speed such that the rotational speed of the movable mirror is slower at the faster speed than at the slower speed, wherein the controller sets the rotational speed of the movable mirror using the following expression (1):
ω=α.Math.ω1+(1−α).Math.ω2 (1) wherein: ω is the rotational speed of the movable mirror; ω1 is an upper limit value of the rotational speed of the movable mirror; ω2 is a lower limit value of the rotational speed of the movable mirror; α is a coefficient; ω1 and ω2 are preset values corresponding to the traveling speed of the vehicle; the controller maintains the coefficient α when one of a first change condition and a second change condition is satisfied, and changes the coefficient α when one of a third change condition and a fourth change condition is satisfied; the first change condition is satisfied when a stop line on a pathway of the vehicle within a detecting region is detected; the second change condition is satisfied when a blocking object around an intersection on the pathway of the vehicle within the detecting region is detected; the third change condition is satisfied when the traveling speed of the vehicle is equal that of a preceding vehicle; and the fourth change condition is satisfied when the preceding vehicle decelerates, wherein the controller decelerates the vehicle when one of the first change condition and the second change condition is satisfied, wherein the controller changes the coefficient α to a first value larger than a default value when the third change condition is satisfied, and wherein the controller changes the coefficient α to a second value larger than the first value when the fourth change condition is satisfied.
2. The vehicle control system according to claim 1, further comprising: a GPS receiver which is configured to acquire positional information of the vehicle; and a map database is configured to store map information, wherein the controller is further configured to: determine, based on the traveling speed and the positional and map information, whether or not the first change condition is satisfied.
3. The vehicle control system according to claim 1, further comprising: a GPS receiver which is configured to acquire positional information of the vehicle; and a map database is configured to store map information, wherein the controller is further configured to: determine, based on the traveling speed and the positional and map information, whether or not the second change condition is satisfied, the second change condition is satisfied when the blocking object blocks the laser beam located around the intersection.
4. The vehicle control system according to claim 1, further comprising an external sensor configured to acquire the surrounding information, wherein the controller is further configured to: execute, based on information on preceding vehicle data which is included in the surrounding information, following control to follow traveling of the preceding vehicle; determine, under a condition where an inter-vehicular distance is maintained, whether or not the following control is executed; and when it is determined that the following control is executed under the condition, set the cycle shorter in the setting processing as compared with a case where it is determined that the following control is not executed under the condition.
5. The vehicle control system according to claim 4, wherein the controller is further configured to: determine, based on the information on the preceding vehicle, whether or not the preceding vehicle has started decelerating travel during the execution of the following control; and when it is determined that the preceding vehicle has started the decelerating travel, set the cycle shorter in the setting processing as compared with a case where it is determined that the preceding vehicle has not started the decelerating travel.
Description
BRIEF DESCRIPTION OF DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
DESCRIPTION OF EMBODIMENTS
(17) Embodiments of the present disclosure are described hereunder with reference to the accompanying drawings. However, it is to be understood that even when the number, quantity, amount, range or other numerical attribute of an element is mentioned in the following description of the embodiments, the present disclosure is not limited to the mentioned numerical attribute unless it is expressly stated or theoretically defined. Further, structures or steps or the like described in conjunction with the following embodiments are not necessarily essential to embodiments of the present disclosure unless expressly stated or theoretically defined.
1. First Embodiment
(18) First, a first embodiment will be described with reference to
(19) 1.1 Entire Configuration of Vehicle Control System
(20)
(21) As shown in
(22) A vehicle speed sensor 10 is a device that acquires a traveling speed of the vehicle M1 (hereinafter also referred to as “vehicle speed”). A wheel speed sensor is exemplified as the vehicle speed sensor 10. The wheel speed sensor may be provided on wheels of the vehicle M1 or on a drive shaft which rotates integrally with the wheels. The vehicle speed sensor 10 transmits the acquired data of the vehicle speed to the controller 30.
(23) The LIDAR 20 is a device that acquires information on surrounding of the vehicle M1 using a laser beam. The LIDAR 20 includes a laser, a movable mirror, and a photodetector. The laser emits light. Number of light emissions per second is unique to the LIDAR 20. The movable mirror reflects the emitted light (i.e., the laser beam) from the laser to irradiate surrounding environment. The direction of movement of the movable mirror may be a horizontal direction or a vertical direction. A mechanical mirror is exemplified as the movable mirror. Examples of the mechanical mirror include a polygon mirror and a small integrated mirror which uses a MEMS (Micro Electra Mechanical Systems) technique. The photodetector detects light reflected from the surrounding environment. The photodetector transmits the detected data of the reflected light to the controller 30.
(24) The LIDAR 20 further includes a driving member 21 to drive the movable mirror. The driving member 21 controls cycle of rotational movement T[s.sup.−1] of the movable mirror based on a control signal from the controller 30. The cycle T is defined as a period until the movable mirror, which has started the rotational movement from a reference position, returns to the reference position via a turn-around position. For convenience of explanation, the present disclosure assumes that deflection angle of the movable mirror is 360 degrees, and the rotational speed ω [Hz] per second of the movable mirror is controlled instead of controlling the cycle T.
(25) The controller 30 is a microcomputer that includes a processor, a memory, and an input interface and an output interface. The controller 30 receives various kinds of data via the input and output interface. The information received by the controller 30 includes vehicle speed and reflected light information. The controller 30 executes various controls based on the received data.
(26) 1.2 Configuration of Controller
(27) The configuration of the controller 30 will be described. As shown in
(28) The object recognition portion 31 executes processing to recognize objects around the vehicle M1 based on the reflected light data. The objects around the vehicle M1 include a moving object and a stationary object. Examples of the moving object include a vehicle, a motorcycle, a bicycle, and a walker. Examples of the stationary object include a white lane and a mark. Known processing is applied to the recognition processing. Therefore, descriptions of the recognition processing are omitted.
(29) The rotational speed control portion 32 executes rotational speed control in which the rotational speed ω of the LIDAR 20 is controlled based on the information on the vehicle speed. In the rotational speed control, processing to set the rotational speed ω in accordance with the vehicle speed is executed. This setting processing will be described below.
(30) 1.3 Setting Processing
(31) In the setting processing, the rotational speed ω is set based on an upper limit value ω1 and a lower limit value ω2 of the rotational speed ω. Prior to the explanation of the upper limit value ω1 and the lower limit value ω2, a relationship between density of the rotational speed ω and the laser beam (or the density of the data (point group)) ρ constituting the reflected light data) will be described. As mentioned above, the number of the irradiation of the laser beam is unique to the LIDAR 20. Therefore, when the rotational speed ω changes under a constant vehicle speed condition, the density ρ changes. Specifically, when the rotational speed ω increases, the density ρ decreases. And when the rotational speed ω decreases, the density ρ increases. When the density ρ is high, information amount of the objects included in the reflected light is larger than when the density ρ is low.
(32) 1.3.1 Upper Limit Value ω1
(33)
(34) In order to avoid contacting with the object B1, the vehicle M1 must be stopped in front of the object B1 after the object recognition portion 31 recognizes the object B1. A travel length L(v) from a position where the object B1 is recognized to a position where the vehicle M1 stops is expressed by the following equation (1) using vehicle speed v, and coefficients a and b.
L(v)=av+bv.sup.2 (1)
The first term on the right side of the equation (1) represents an idle traveling length, and the second term on the right side of the equation (1) represents a braking length. The idle traveling length is defined as a length that the vehicle M1 travels from the recognition of the object B1 until a brake device of the vehicle M1 begins to work. The braking length is defined as a length that the vehicle M1 travels from the brake device begins to work until the vehicle M1 stops.
(35) Here, a circle CI whose radius is the travel length L(v) is considered. The circumference length of the circle CI is represented by 2πL(v). The density ρ at a position separated from the vehicle M1 by the travel length L(v) is expressed by the following equation (2) using the number N of the laser beam per second, the rotational speed ω and the travel length (v).
ρ=(N/ω))/2πL(v) (2)
(36) Furthermore, a lowest value ρ min of the density ρ required to recognize the objects around the vehicle M1 is considered. The lowest value ρ min is able to set from a software configuration to execute the recognition processing and a configuration of the LIDAR 20. Then, if at least the density ρ is equal to or larger than the lowest value ρ min, the object B1 is able to be recognized, and the contacting with the object B1 is able to be avoided by a deceleration operation after the recognition. That is, if the density ρ satisfies the condition show with the following equation (3), it is possible to avoid contacting with the object B1.
ρ□ρ.sub.min (3)
(37) The condition shown in the following equation (4) is derived from the equations (2) and (3). This condition is defined as the upper limit condition of the rotational speed ω.
ω≤N/(2πL(v)ρ.sub.min) (4)
(38) The rotational speed ω when the values of the left side and the right side of the expression (4) are equal corresponds to the upper limit value ω1.
(39) 1.3.2 Lower Limit Value ω2
(40)
(41) In order to treat the object B2 as same object, a length S between the detected position of the object 132 at the time t1 and that at the time t2 requires to be less than or equal to a tolerance Smax. The tolerance Smax can be set from the software configuration to execute the recognition processing and the configuration of the LIDAR 20. That is, if the length S satisfy the condition of the following equation (5), the object B2 can be treated as the same object.
(42)
(43) The condition shown in the following equation (6) is derived from the equation (5). This condition is defined as the lower limit condition of the rotational speed ω.
ω≥v/S max (6)
(44) The rotational speed ω when the values of the left side and the right side of the expression (6) are equal corresponds to the lower limit value ω2.
(45) 1.4 Example of Setting Processing
(46)
(47) The average ωave is set based on the upper limit value ω1 and the lower limit value ω2 obtained by referring to an upper limit map and a lower limit map individually. The upper limit map is a control map in which the upper limit value ω1 is set for each vehicle speed v. The lower limit map is a control map in which the lower limit value ω2 is set for each vehicle speed v. These control maps are preset and stored in the memory.
(48) The average ωave may be set directly by referring to an average map. The average map is a control map in which the average ωave is set for each vehicle speed v. The vehicle speed v, the upper limit value ω1 and the lower limit value ω2 may be separately calculated based on the equations (4) and (6), and the average ωave may be calculated based on the calculated values.
(49) As can be seen from the tendency of the average ωave shown in
(50) As described in the section 1.3, the density ρ decreases as the rotational speed ω increases, whereas the density ρ increases as the rotational speed ω decreases. Furthermore, when the density ρ is high, the information amount of the objects included in the information on the reflected light becomes larger than when the density ρ is low. Therefore, when the rotational speed ω is set to the average ωave, the density ρ increases as the vehicle speed v increases, and thus the information amount increases.
(51) 1.5 Example of Specific Processing
(52)
(53) In the processing routine shown in
(54) Subsequent to the step S10, the upper limit value ω1 and the lower limit value ω2 are acquired (step S11). The upper limit value ω 1 is obtained by referring to the upper limit map. The lower limit value ω2 is obtained by referring to the lower limit map.
(55) Subsequent to the step S11, the rotational speed ω is calculated (step S12). The rotational speed ω is calculated by averaging the upper limit value ω1 and the lower limit value ω2 (i.e. the average ωave).
(56) Subsequent to the step S12, it is determined whether or not the rotational speed ω is within the movable range (step S13). When the rotational speed ω calculated in the step S12 is between the lower and upper restrictions, it is determined that the rotational speed ω is within the movable range. Otherwise, it is determined that the rotational speed ω is outside the movable range.
(57) If the determination result of the step S13 is negative, the rotational speed ω is changed (step S14). The change of the rotational speed ω is executed by considering content of the determination of the step S13. Specifically, if the rotational speed ω is less than lower restriction, the rotational speed ω is changed to the lower restriction. If the rotational speed ω is higher than upper restriction, the rotational speed ω is changed to the upper restriction.
(58) Subsequent to the step S13 or S14, a control signal is output (step S15). The control signal is output in accordance with the rotational speed ω set in the step S13 or S14. The control signal is input to the driving member 21. In this way, the rotational speed of the movable mirror is controlled.
(59) 1.6 Advantageous Effects
(60) According to the first embodiment described above, the setting processing is executed in the rotational speed control. The setting processing allows the movable mirror to rotate faster as the vehicle speed decreases. Therefore, it is possible to detect the objects in the vicinity of the vehicle M1 at an earlier timing during a low-speed driving. Furthermore, it is possible to rotate the movable mirror at lower speed as the vehicle speed increases. Therefore, it is possible to acquire the detailed information of the object which locates far from the vehicle M1 at the first detecting time during a high-speed driving.
2. Second Embodiment
(61) Next, a second embodiment will be described with reference to
(62) 2.1 Entire Configuration of Vehicle Control System
(63)
(64) The map database 40 is a data base in which high-precision map information is stored. The map information includes information on positional information and road shape of roads (e.g., information on road type such as straight and curve, and curvature of the curve). The positional information on the roads also includes information on intersections and divergent points. The map information also includes information on marks on the roads (e.g., compartment lines, stop lines and crosswalks) and that installed at breakdown lanes (e.g., information on no-parking areas, legal speed and stop lines). The map information also includes information on appendages on the roads (e.g., location, geometry and width). The appendage includes constructions (e.g., guard fences, marks and light fixtures) installed around the roads and buildings founded next to the roads.
(65) The map database 40 is formed in a storage device (e.g., a hard disk and a flash memory) mounted on the vehicle M1. The map database 40 may be formed in a computer of a facility (e.g., a management center) that is capable of communicating with the vehicle M1.
(66) The sensors 50 includes a GPS (Global Positioning System) receiver, an external sensor, and an internal sensor.
(67) The GPS receiver is a device that receives signals from more than two GPS satellites. The GPS receiver is also a device to require information on position of the vehicle M1. The GPS receiver calculates the position and orientation of the vehicle M1 based on the received signals. The GPS receiver transmits the calculated data to the controller 30.
(68) The external sensor is a device to acquire the information on the surrounding of the vehicle M1. The LIDAR 20 is also a type of the external sensor. However, the LIDAR 20 is not included in the external sensor referred to herein. Examples of the external sensor include a millimeter wave radar and a camera. The millimeter wave radar detects the objects around the vehicle M1 by using radio waves. The camera images surrounding conditions of the vehicle M1. The external sensor transmits the detected data to the controller 30.
(69) The internal sensor is a device that acquires a traveling state of the vehicle M1. The vehicle speed sensor 10 is also a type of internal sensor. However, the vehicle speed sensor 10 is not included in the internal sensor referred to herein. Examples of the internal sensor include an acceleration sensor and an acceleration yaw rate sensor. The acceleration sensor detects acceleration of the vehicle M1. The yaw rate sensor detects yaw rate around a vertical axis of a center of gravity of the vehicle M1. The internal sensor transmits the detected data to the controller 30.
(70) 2.2 Configuration of Controller
(71) The configuration of the controller 30 will be described. As shown in
(72) The vehicle position estimation portion 33 executes processing to estimate actual position of the vehicle M1 based on the data from the sensors 50 and the map information. In the estimate processing, the information from the GPS receiver is compared with the map information, whereby the position of the vehicle M1 on a map is specified. The specified position of the vehicle M1 is transmitted to the coefficient change portion 34.
(73) The coefficient change portion 34 executes processing to change a coefficient α based on the information on the vehicle speed, the positional information of the vehicle M1 and the map information. The coefficient α is a weighting coefficient used in the setting process of the rotational speed ω. This coefficient change processing will be described below. For convenience of explanation, the coefficient change processing of the present embodiment will be referred to as “first change processing”.
(74) 2.3 First Change Processing
(75) As described above, in the setting processing, the rotational speed ω is set based on the upper limit value ω1 and the lower limit value ω2. By using the upper limit value ω1, the lower limit value ω2, and the coefficient α, an arithmetic expression of the rotational speed ω is expressed by the following expression (7).
ω=α.Math.ω1+(1−α).Math.ω2 (7)
(76) A default value α0 of the coefficient α is set to 0.5. In the first change processing, when a first change condition or a second change condition is satisfied, the coefficient α is changed to a value larger than the default value α0. The first and second change conditions will be described below.
(77) 2.3.1 First Change Condition
(78) The first change condition is satisfied when there is a stop line on a pathway of the vehicle M1 within the detecting region R1.
(79) 2.3.2 Second Change Condition
(80) The second change condition is satisfied when there is the laser beam blocking object around an intersection on the pathway of the vehicle M1 within the detecting region R1.
(81) 2.3.3 Specific Example of First Change Processing
(82)
(83) In the processing routine shown in
(84) Subsequent to the step S20, it is determined whether or not the first or second change condition is satisfied (step S21). In the processing of the step S21, it is determined whether or not the change condition described in
(85) If it is determined that the first or second change condition is satisfied, the coefficient α is changed (step S22). Specifically, the coefficient α is changed to the value larger than the default value α0.
(86) 2.4 Advantageous Effects
(87)
(88) As described in
3. Third Embodiment
(89) Next, a third embodiment will be described with reference to
(90) 3.1 Entire Configuration of Vehicle Control System
(91)
(92) The traveling device 60 automatically drives the vehicle M1 in accordance with control signals from the controller 30. The traveling device 60 includes a driving force outputting device, a steering device and a brake device. The driving force outputting device generates a driving force for traveling. The steering device turns the wheels. The brake device generates a braking force to be applied to the wheels.
(93) 3.2 Configuration of Controller
(94) The configuration of the controller 30 will be described. As shown in
(95) The following control portion 35 executes following control to follow the traveling of a preceding vehicle M2 by the operation of the traveling device 60. The preceding vehicle M2 may be recognized based on the information on the reflected light or may be recognized based on the information from the external sensor. The preceding vehicle M2 may be recognized based on an integration of these information. As processing to execute the following control, a known processing is applied. Therefore, descriptions of the processing of the following control are omitted.
(96) The coefficient change portion 34 executes processing to change the coefficient α based on the information on the preceding vehicle M2. This coefficient change processing will be described below. For convenience of explanation, the coefficient change processing of the present embodiment will be referred to as “second change processing”.
(97) 3.3 Second Change Processing
(98) In the second change processing, when a third condition or a fourth change condition is satisfied, the coefficient α is changed to the value larger than the default value α0. Hereinafter, the third and fourth change conditions and the processing examples executed when these change conditions are satisfied will be described.
(99) 3.3.1 Third Change Condition
(100) The third change condition is satisfied when the following control is executed and an inter-vehicular distance is kept constant. The inter-vehicular distance is a distance between the preceding vehicle M2 and the vehicle M1.
(101)
(102) 3.3.2 Fourth Change Condition
(103) The fourth change condition is satisfied when the following control is executed and the preceding vehicle M2 decelerates its speed. The decelerating travel of the preceding vehicle M2 may be recognized based on the information on the reflected light or may be recognized based on the information from the external sensor. If the preceding vehicle M2 decelerates its speed, the preceding vehicle M2 may tack or stop.
(104)
(105) In the processing routine shown in
(106) Subsequent to the step S30, it is determined whether or not the preceding vehicle M2 decelerate its speed (step S31). The processing of the step S31 is processing to determine whether or not the fourth change condition is satisfied.
(107) If it is determined that the fourth change condition is satisfied, the coefficient α is changed (step S32). Specifically, the coefficient α is changed to the value larger than the present value α1. As described in the third change condition, during the execution of the following control, the coefficient α is set in accordance with the inter-vehicular distance LM. Therefore, when the coefficient α is changed, the changed value becomes larger than the present value α1 (i.e., α1□α0).
(108) 3.4 Advantageous Effects
(109) According to the third embodiment described above, the second change processing is executed. In a situation where the third change condition is satisfied, it is desirable to be paid attention to the preceding vehicle M2. In this respect, according to the second change processing, the coefficient α is changed to the value larger than the default value α0 when the third change condition is satisfied. Then, as described in
(110) Also, in a situation where the fourth change condition is satisfied, the preceding vehicle M2 may tack or stop. Therefore, in such the situation, it is desirable to be paid more attention to the preceding vehicle M2 than in the situation where the third change condition is satisfied. In this respect, according to the second change processing, the coefficient α is changed to the value larger than the present value α1 when the fourth change condition is satisfied. Therefore, it is possible to detect the change in the traveling state of the preceding vehicle M2 due to an initiation of the decelerating travel at an earlier timing. Therefore, it is possible to improve the accuracy of the following control.
4. Fourth Embodiment
(111) Next, a fourth embodiment will be described with reference to
(112) 4.1 Entire Configuration of Vehicle Control System
(113)
(114) 4.2 Configuration of Controller
(115) The configuration of the controller 30 will be described. As shown in
(116) The deceleration control portion 36 executes deceleration control of the vehicle M1 based on the information on the vehicle speed, the positional information of the vehicle M1 and the map information. The deceleration control is to decelerate the vehicle M1 by the operation of the brake device. The deceleration control will be described below.
(117) 4.3 Deceleration Control
(118) The deceleration control is executed when the first or second change condition is met. These change conditions are as described in the items 2.3.1 and 2.3.2. The deceleration control may be executed until the vehicle M1 stops, or may be executed temporarily. For example, when the first change condition is satisfied, the deceleration control is executed until the vehicle M1 stops. When the second change condition is satisfied, the deceleration control is executed temporarily. When the deceleration control is executed, the vehicle speed is lowered. The lower the vehicle speed is, the faster the movable mirror rotates due to the execution of the setting processing. The setting processing is as described in the above first embodiment.
(119)
(120) In the processing routine shown in
(121) If it is determined in the step S41 that the first or second change condition is satisfied, control amount of the brake device is calculated (step S42). In the processing of the step S42, the control amount is calculated in accordance with the change condition satisfied in the step S41. For example, if the first change condition is satisfied, the control amount is calculated such that the vehicle M1 stops in front of the stop line SL. If the second change condition are met, the control amount is calculated such that at least the vehicle speed is reduced.
(122) 4.4 Advantageous Effects
(123) According to the fourth embodiment described above, the deceleration control is executed when the first or second change condition is satisfied. Therefore, it is possible to rotate the movable mirror at a high speed without changing the coefficient α. Therefore, it is possible to obtain the same effects as when the first change processing described in the second embodiment is executed.