Fixed a hard to find bug that I inserted when I made setRobotState a little fancier