The robot code from the scrimmage

Here is the current code