PatrikE's Fixed Wing RTH

no need to zero init STATIC vars ,they're zero by default. See C standard
Also compress them all into a single line
static int16_t NAV_fag, GPS_blah etc