Updated Program!

Now draws full goal. Will now start playing with sensors.