Changed a few ints to doubles to increase the precision of the robot on
the screen. At high values the loss of precision with int were makeing
the robot show up way off.