Finished go-to-goal and avoid-obstacles demo for Sim.I.am in Simulink.