# US 2023/0391328 A1 · Real-time, energy-efficient computations of optimal road vehicle velocity profiles

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0391328 A1
- Document ID: US20230391328A1
- Status: Published application
- Kind: A1
- Application number: 18/033,218
- Filed: 2020-10-22
- Published: 2023-12-07
- Earliest claimed: 2020-10-22
- Assignees: Embotech AG
- Applicants: Embotech AG
- Inventors: Sven VAN KOUTRIK; Joachim FERREAU; Stefano LONGO; Alexander DOMAHIDI
- Web page: https://patentgrep.com/patent/US20230391328A1

## CPC

- B60W 30/143: {Speed control (B60W30/16 takes precedence)}
- G05D 1/0217: {in accordance with energy consumption, time reduction or distance reduction criteria}
- B60W 40/105: Speed
- B60W 50/0097: {Predicting future conditions}
- G05D 1/0223: {involving speed control of the vehicle (vehicle fittings for automatically controlling, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator B60K31/00)}
- B60W 2050/0031: {Mathematical model of the vehicle}
- B60W 2520/10: Longitudinal speed
- B60W 2552/20: Road profile, i.e. the change in elevation or curvature of a plurality of continuous road segments
- B60W 2720/10: Longitudinal speed
- B60W 2720/103: Speed profile
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES

## Abstract

The invention is notably directed to a computer-implemented method for controlling a speed of a vehicle given energy-related quantities that pertain to moving the vehicle. Each of said energy-related quantities is being referred to as an energy expense in the following. The method involves two key operations (a full-horizon optimization and multiple, nested short-horizon optimizations), which are performed based on route parameters of a route segment and real-time signals capturing current states of the vehicle. First, a target function of a profile of an energy expense is optimized (S12) for a route segment, to determine a reference profile Xref of this energy expense. The optimization is constrained with respect to objectives in respect of a total travel time and/or a total travel energy expense for the vehicle to travel said route segment. A profile of parameter values is obtained (S14-S28) according to a by-product of the optimization. Next, short-horizon speed profiles Vref of the vehicle are repeatedly determined (S32) to plan speeds Vref of the vehicle along local sections of the route segment. Such predictions are achieved by minimizing, for each of the local sections, a cost function as parameterized by one of the parameter values. The cost function captures a cost of deviating from an output of the optimized target function due to such speed profiles; said output and said one of the parameter values pertain, each, to said each of the local sections. Finally, control signals are obtained based on the planned speeds Vref. Such control signals can be used for controlling (S40) a speed of the vehicle along each of said local sections of the route segment. The invention is further directed to related systems, vehicles, and computer program products.

## Claims

### Claim 1

A computer-implemented method for controlling a speed of a vehicle given energy-related quantities that pertain to moving the vehicle, each of said quantities being referred to as an energy expense, wherein the method comprises:
based on route parameters of a route segment, performing a full-horizon optimization by optimizing a target function of a profile of an energy expense, to determine a reference profile X*ref of this energy expense for the entire route segment, the optimization constrained with respect to objectives in respect of a total travel time and/or a total travel energy expense for the vehicle to travel said route segment;
obtaining a profile of parameter values according to a by-product of the optimization;
based on real-time signals capturing current states of the vehicle, repeatedly determining short-horizon speed profiles Vref of the vehicle to plan speeds Vref of the vehicle along local sections of said route segment, by minimizing, for each of the local sections, a cost function as parameterized by one of the parameter values, the cost function capturing a cost of deviating from an output of the optimized target function due to such speed profiles, wherein said output and said one of the parameter values pertain, each, to said each of the local sections; and
based on the planned speeds, obtaining control signals for controlling a speed of the vehicle along each of said local sections of the route segment.

### Claim 2 (depends on 1)

The method according to claim 1, wherein said target function:
represents a travel time t(Xref) for the vehicle to travel said route segment; and
is optimized so as to identify said reference profile X*ref as an argument of the minimum of the target function.

### Claim 3 (depends on 2)

The method according to claim 2, wherein
the cost function is a linear combination of two dependent variables, including a first variable t related to a travel time and a second variable E related to a travel energy expense, wherein the second variable is weighted by said one of the parameter values, and
the profile of parameter values reflects a rate of change of the travel time with respect to the travel energy expense, whereby the cost function represents a temporal cost of locally deviating from said output of the optimized target function.

### Claim 4 (depends on 3)

The method according to claim 3, wherein
the method further comprises storing a profile LFF of time-to-energy derivative values, as obtained as said by-product of the constrained optimization, in view of obtaining said profile of parameter values, and
the profile of parameter values is obtained based on the profile LFF of time-to-energy derivative values.

### Claim 5 (depends on 4)

The method according to claim 4, wherein the method further comprises:
monitoring the actual profile Xact of the energy expense of the vehicle as it travels along the route segment; and
comparing the actual profile Xact monitored with the reference profile X*ref obtained from the constrained optimization to obtain a comparison outcome, whereby the profile of parameter values is obtained according to both the profile LFF of time-to-energy derivative values and said comparison outcome.

### Claim 6 (depends on 5)

The method according to claim 5, wherein the method further comprises:
estimating a profile Ldev of derivatives of the time-to-energy derivative values with respect to a temporal energy consumption C of the vehicle; and
the parameter values are obtained according to both the comparison outcome and the estimated profile Ldev of derivatives of the time-to-energy derivative values.

### Claim 7 (depends on 6)

The method according to claim 6, wherein
estimating the derivatives of the time-to-energy derivative values comprises numerically computing such derivatives based on at least two profiles of time-to-energy derivative values.

### Claim 8 (depends on 6)

The method according to claim 6, wherein obtaining said parameter values comprises:
obtaining a correction value Lcor by
feeding the comparison outcome to a tracking controller to obtain a tracking controller output, and
multiplying the tracking controller output obtained by an estimated one of the derivatives of the time-to-energy derivative values corresponding to said each of the local sections to obtain a correction value; and
summing the correction value with one of the time-to-energy derivative values that corresponds to said each of the local sections to obtain said one of the parameter values.

### Claim 9 (depends on 2)

The method according to claim 2, wherein said constrained optimization is performed subject to:
a model of the vehicle taking said route parameters as inputs; and
one of the total travel time and the total travel energy expense being less than or equal to a given value at the end of a journey corresponding to said route segment.

### Claim 10 (depends on 9)

The method according to claim 9, wherein performing said constrained optimization further comprises
feeding the model of the vehicle with one or each of permanent parameters of the vehicle and an initial state of the vehicle.

### Claim 11 (depends on 1)

The method according to claim 1, wherein the method is performed for controlling the speed of the vehicle along multiple route segments, whereby the method comprises:
performing multiple full-horizon optimizations each similar to said full-horizon optimization, for respective ones of the multiple route segments, and,
for each of the multiple full-horizon optimizations performed, repeatedly determining short-horizon speed profiles Vref of the vehicle to plan speeds Vref of the vehicle along local sections of a respective one of said route segments.

### Claim 12 (depends on 1)

The method according to claim 1, wherein
the speeds are planned using a model predictive control algorithm, or MPC algorithm.

### Claim 13

The method according to 12, wherein
the MPC algorithm is run using a nonlinear programming solver.

### Claim 14 (depends on 1)

The method according to claim 1, wherein
the cost function is minimized subject to a dynamical model of the vehicle, the dynamical model taking said real-time signals as input, wherein the real-time signals represent one or more of a speed, an acceleration, an available energy, a thermal state, a powertrain, and a braking efficiency of the vehicle.

### Claim 15 (depends on 1)

The method according to claim 1, wherein
the method further comprises actuating the vehicle in the physical world, according to the control signals obtained.

### Claim 16 (depends on 1)

The method according to claim 1, wherein
the method further comprises planning motion of the vehicle based on the control signals obtained, and
the motion planned is tentatively constrained according to the planned speeds.

### Claim 17 (depends on 1)

The method according to claim 1, wherein
an average duration of minimizing the cost function is, for each of the local sections, between 10 ms and 1 s.

### Claim 18

A computerized system for controlling a speed of a vehicle given energy-related quantities that pertain to moving the vehicle, each of said quantities referred to as an energy expense, the system comprising:
processing means;
a memory; and
storage means storing computerized methods,
wherein the system is configured to load the computerized methods in the memory and run the loaded computerized methods, so as to cause the processing means to:
based on route parameters of a route segment, perform a full-horizon optimization by optimizing a target function of a profile of an energy expense, to determine a reference profile X*ref of this energy expense for the entire route segment, the optimization constrained with respect to objectives in respect of a total travel time and/or a total travel energy expense for the vehicle to travel said route segment;
obtain a profile of parameter values according to a by-product of the optimization;
based on real-time signals capturing current states of the vehicle, repeatedly determine short-horizon speed profiles Vref of the vehicle to plan speeds Vref of the vehicle along local sections of said route segment by minimizing, for each of the local sections, a cost function as parameterized by one of the parameter values, the cost function capturing a cost of deviating from an output of the optimized target function due to such speed profiles, wherein said output and said one of the parameter values pertain, each, to said each of the local sections; and
obtain, based on the planned speeds Vref, control signals for controlling a speed of the vehicle along each of said local sections of the route segment.

### Claim 19 (depends on 18)

A vehicle, comprising:
one or more sensors, each configured to detect a quantity impacting a dynamical state of the vehicle and accordingly produce sensor signals;
a receiving unit connected to the one or more sensors and configured to receive said sensor signals from the sensors to produce said real-time signals, in operation; and
the computerized system according to claim 18,
wherein, in operation,
the system is connected to the receiving unit, so as to receive said real-time signals, and
the computerized system is further configured in the vehicle so as to instruct to actuate the latter according to the control signals obtained.

### Claim 20

A computer program product for controlling a speed of a vehicle given energy-related quantities that pertain to moving the vehicle, each of said quantities being referred to as an energy expense, the computer program product comprising a computer readable storage medium having program instructions embodied therewith, the program instructions executable by processing means to cause the latter to:
based on route parameters of a route segment, perform a full-horizon optimization by optimizing a target function of a profile of an energy expense, to determine a reference profile X*ref of this energy expense for the entire route segment, the optimization constrained with respect to objectives in respect of a total travel time and/or a total travel energy expense for the vehicle to travel said route segment;
obtain a profile of parameter values according to a by-product of the optimization;
based on real-time signals capturing current states of the vehicle, repeatedly determine short-horizon speed profiles Vref of the vehicle to plan speeds Vref of the vehicle along local sections of said route segment by minimizing, for each of the local sections, a cost function as parameterized by one of the parameter values, the cost function capturing a cost of deviating from an output of the optimized target function due to such speed profiles, wherein said output and said one of the parameter values pertain, each, to said each of the local sections; and
obtain, based on the planned speeds Vref, control signals for controlling a speed of the vehicle along each of said local sections of the route segment.
