Understanding TrajOpt

TrajOpt is an optimization based approach for motion planning. More specifically, it uses a sequential convex optimization procedure along with a formulation of collision constraints to find locally optimal planning trajectories, even for robotic systems that have a large number of degrees of freedom. This post will go into the details of the optimization part, and give an outline of how it can be implemented. My implementation can be found… [Read More]

Multi Vehicle Mixed Integer Programming

In this post, we take a look at this paper, which introduces a simple, yet interesting approach to solving a multi-vehicle path planning problem. My implementation of the algorithm that was used to evaluate its performance and generate all the results in this post can be found here Problem The paper tries to tackle the issue of finding fuel optimal paths for multiple vehicles, given vehicle-obstacle and vehicle-vehicle collision constraints.… [Read More]