SITL: prevent initialisation error
SITL: use sinf() and cosf()

for some strange reason the double precision functions can crash