got the algorithm down to 260 seconds approx, where real time was around 205.6 seconds.  I used the hall dataset that had the vector nav.