roundf() function for crossworks does not works - changed to define
preliminary naze32 rev5 support (not tested)