Cast arguments to trig functions to doubles to prevent substitution of float functions.

When presented with code like:
atan2(float a, float b)
the compiler substitutes the float versions of the trig functions - eg:
atan2f(float a, float b)
These functions do not exist on th cRIO. Casing arguments to doubles prevents this.