Hot fix in change coords from NED to Race frame
Removed some warnings
created file for optimal path computed offline