Motion planning for autonomous vehicles

PRODRIVER is Embotech’s solution to the problem of motion planning for autonomous or highly-automated vehicles. It is an essential component of the autonomous driving software stack, within the so-called ‘decision making’ layer. As a motion planner, PRODRIVER is responsible to generate drivable trajectories or directly actuator commands such as steering, accelerating and braking. These are computed given the surrounding environment information. PRODRIVER does so by continuously making predictions and solving an optimization problem in real time. Its most important inputs are information about the drivable space, the obstacles within it and a goal (which could be a position or an objective such as making progress along a route). Its outputs can be used directly to control the vehicle or to provide set-points for the vehicle’s low-level controllers to track. The diagram below gives a schematic overview of how PRODRIVER is integrated within a typical autonomous vehicle software stack.

design philosophy

We wanted to design a ground vehicle auto-pilot (a motion planner) that could drive like a human but would not make human-like mistakes. We moved away from learning-based methods or hard-coded rule-based heuristics. In the former, repeatability and determinism cannot be guaranteed and a large amount of training data is required. In the latter, it’s impossible to encode all situations and the trajectories tend to feel “artificial”. We don’t believe in what we call “situational pre-programming”.

We realized that the problem of driving is complex, but it can be described by mathematical functions about which we have knowledge. Such functions are the equations of motions of the vehicle, the tire dynamics and the constraints imposed by physics (e.g. maximum turning radius), regulation (e.g. speed limits) and safety (e.g. obstacles, road conditions). Those are the ingredients required to set up the mathematical optimization problem.

The necessity and difficulty to solve the problem in real time (within milliseconds) is what has stopped other motion planning engineers to go down this route.

In our case, the availability of Embotech’s core technology (the powerful and MISRA-C-compliant FORCESPRO solver) has allowed us to set up the motion planning challenge as a rich nonlinear optimization problem that can be executed reliability in automotive-grade embedded hardware.

The advantage is that the trajectories generated by PRODRIVER are smooth, human-like, consistent, and able to deal with scenarios never encountered before. By modifying a few parameters, different driving styles automatically emerge. For example, if in the cost function of the optimization problem we try to minimize lateral accelerations, we observe a driving style similar to the one of a careful chauffeur. On the other hand, if the aim is to minimize time, the result is a more race-like style.

Most importantly, our trajectories are physically consistent and correct (can be followed by the vehicle), which also allows us to deal with driving on low-friction surfaces (mud, gravel, snow, ice) and to create emergency avoidance maneuvers at the limits of handling within the same piece of software.

PRODRIVER Product Family

As human beings require different level of knowledge and experience to drive different vehicles, so does PRODRIVER. The physics-based approach we use to solve the motion planning problem requires mathematical models of the vehicle being driven, as well as tuning. In addition to this, PRODRIVER can drive and coordinate multiple vehicles, and will be available in different levels of certification depending on where it is used. We aim to achieve ASIL B for gated areas in Q3 2021 and ASIL D for public roads in Q3 2022. Below is a description of the PRODRIVER product family.


PRODRIVER Car is an SAE Level 4 autopilot for passengers cars or robo-taxis. It requires the highest level of certification and can drive conventional vehicles like passengers’ cars.

PRODRIVER Truck is an SAE Level 4 autopilot specialized for freight transport. Apart from the high level of certification also required here, this motion planner can drive a heavy vehicle with semi-trailers.

PRODRIVER Pod is a motion planner specific to Pods, which are typically driverless people carriers or cabinless trucks. They operate in more controlled areas, often driving in designated lanes.


PRODRIVER Logistics is a motion planner capable of driving and coordinating multiple vehicles. It is often executed in a cloud computer and used by logistic centers for yard automation.

PRODRIVER Special vehicles is a motion planner with more open characteristics. It can be tuned to drive unconventional vehicles from 400 ton haul tracks to articulated and multiple-axle vehicles.

PRODRIVER Testing automates vehicle dynamic testing where repeatability combined with human-like performance is essential. It’s a software substitute of driving robots that are currently used to perform such tests.

PRODRIVER Off-road is a motion planner designed to drive off-the-highway vehicles in un-smooth surfaces, often encountered in mining and constructions sites. This variant is specifically tuned to deal with low and frequently changing tire friction coefficients.


Our existing customers will be familiar with the products PROPARKER, our low-speed maneuvering motion planner and PROCRUISER, our highway-driving motion planner. These two products separately solved the problem of driving in structured and unstructured spaces, at high speeds and at low speeds. When it became clear that a single motion planner was what our customers needed, we developed PRODRIVER and phased out PROPARKER and PROCRUISER. If you are an existing customer still using the legacy products, we will continue supporting and helping you transitioning to PRODRIVER. Needless to say, PRODRIVER can do what its parents products could do and much more.


EU H2020 funding 

Embotech’s project “Motion Planning Software for Autonomous Car Industry” has received funding from the European Union’s Horizon 2020 research and innovation program under grant agreement No. 873550. Horizon 2020 is investing in smart and sustainable SME solutions for the future with emphasis on excellent science, industrial leadership and tackling societal challenges.


Looking for more information?


If you’d like to find out more about PRODRIVER, let us know. Either use the webform on the right or book a meeting via the link below. Our team of experts will be happy to discuss more details with you.