I'm looking for ways to accurately navigate from one GPS location to another. I have a GPS sensor and an IMU. I can calculate the distance with the help of GPS I believe and with the help of magnetometer sensor on the IMU(acc + gyro + mag), I can calculate the heading angle and know which way to go. But the GPS data has a lot of outliers and I need to do this navigation accurately. Any suggestions are appreciated.