Working Version V1

Goalie tries to stays in goal, but if it leaves it is completely confused and useless.

Attacker works, but sometimes goes off on weird tangents, and a bit clunk at times. Heading PID needs work.