Fw nav extras

why not using atan2f here ?