Why isn't the heading working? Actually I'm not even sure if I set it in the right direction, it's supposed to be facing towards the motors... not sure if that helps, though.
Also Starcore, I would be more than thankful if you could help get the AI working.