Replace all doubles with floats including some constants
replace strtod with strtof
replace sqrt, hypot, sin, cos with float variants (ie sqrtf, hypotf, sinf, cosf)
missed an atan() in Robot, changed to atanf