AI Code Mark III

Changed some more minor things, such as where variables are declared.

Going to be adding smart turning in soon, but need more knowledge of
turning radius.