Done test indoor PI and tack, seems ok
navigation: NED to Race frame with translation
Added lat,lon and alt of top mark. Restayled set_ref in as