Added steady state posittion simulation, try ekf from pixhawk
Hot fix simulator GPS, ekf seems to work well, parameters has to be tested and tuned