Planner mods

Changed the code in SimBA to reflect the relocation of the Protobufs and URDFParser to the HAL library.
Would it help to make this a `shared_ptr` or `unique_ptr`?