Ah OK Dale, I didn't think of that at all, I had read something about Kalman filters regarding the sensor, that could be affecting the results. That's fantastic Dale, honestly I thought I was going a bit loopy. I probably need to go back to school and redo some physics!
Thanks again, you have...