Adding dynamic obstacle code, but it breaks the simulation
Merged CMakeLists