Fixed a whole lot of stuff during robot testing