Predictive curve speed controller
A controller for a motor vehicle includes an electronic processor configured to receive sensor data from one or more sensors, process the sensor data to generate targets indicative of objects around the motor vehicle, plot the targets on a coordinate system representing space around the motor vehicle, generate a representation of a route ahead of the vehicle based on the plotted targets, analyze the representation of the route to determine whether a curve in a road is present ahead of the motor vehicle, and generate an instruction to reduce a speed of the motor vehicle in response to determining that the curve is present.
1 . A controller for a motor vehicle, the controller comprising:
an electronic processor configured to:
receive sensor data from one or more sensors,
process the sensor data to generate targets indicative of objects around the motor vehicle,
plot the targets on a coordinate system representing space around the motor vehicle,
generate a representation of a route ahead of the vehicle based on the plotted targets,
analyze the representation of the route to determine whether a curve in a road is present ahead of the motor vehicle, and
in response to determining that the curve is present, generate an instruction to reduce a speed of the motor vehicle by:
generating a virtual target ahead of the motor vehicle,
generating a command to follow the virtual target and maintain a fixed distance between the motor vehicle and the virtual target, and
reducing a speed of the virtual target according to a deceleration rate computed based on a distance between the motor vehicle and a beginning of the curve,
wherein the instruction to reduce the speed of the motor vehicle includes (i) increasing a brake pressure, (ii) modifying a torque output of an engine to decrease the speed of the motor vehicle, or (iii) a combination thereof.
2 . The controller of claim 1 , wherein generating instructions to reduce the speed of the motor vehicle comprises reducing a speed of the virtual target to a first speed, wherein the first speed is less than a current speed of the motor vehicle.
3 . The controller of claim 2 , wherein the first speed is determined based on a radius of the curve.
4 . The controller of claim 1 , wherein the representation of the route is a polynomial representation.
5 . The controller of claim 1 , wherein the electronic processor is configured to classify each target as stationary or moving.
6 . The controller of claim 5 , wherein the one or more sensors includes a radar sensor and classifying each target as stationary or moving includes classifying each target based on a Doppler shift of the target.
7 . A method for controlling a motor vehicle, the method comprising:
processing sensor data to generate targets indicative of objects around the motor vehicle,
plotting the targets on a coordinate system representing space around the motor vehicle,
generating a representation of a route ahead of the vehicle based on the plotted targets,
analyzing the representation of the route to determine whether a curve in a road is present ahead of the motor vehicle, and
in response to determining that the curve is present, generating an instruction to reduce a speed of the motor vehicle by:
generating a virtual target ahead of the motor vehicle,
generating a command to follow the virtual target and maintain a fixed distance between the motor vehicle and the virtual target, and
reducing a speed of the virtual target according to a deceleration rate computed based on a distance between the motor vehicle and a beginning of the curve,
wherein the instruction to reduce the speed of the motor vehicle include (i) increasing a brake pressure, (ii) modifying a torque output of an engine to decrease the speed of the motor vehicle, or (iii) a combination thereof.
8 . The method of claim 7 , wherein generating instructions to reduce the speed of the motor vehicle comprises reducing a speed of the virtual target to a first speed, wherein the first speed is less than a current speed of the motor vehicle.
9 . The method of claim 8 , wherein the first speed is determined based on a radius of the curve.
10 . The method of claim 7 , wherein the representation of the route is a polynomial representation.
11 . The method of claim 7 , further comprising classifying each target as stationary or moving.
12 . The method of claim 11 , wherein processing the sensor data includes processing a radar sensor data and classifying each target as stationary or moving includes classifying each target based on a Doppler shift of the target.