Looked at use of floats and ints in the servo calculations