Factored OBBs into their own module
Added reporting on iterations of motion planning