X-Bar: changed atan2 to atan2f, 

because I am using floats and not doubles. Have not checked with ros compiling yet