restructuring and added elevation map support in autopilot