Planner mods

Changed the code in SimBA to reflect the relocation of the Protobufs and URDFParser to the HAL library.
Definitely a memory leak. Pointer needs to be deleted. In this case though, just make a stack object w/o `new`