Estimating velocity and position

The first thing I checked was the total acceleration and it was wrong I stopped at that point. It would be a lot easier to look at the code that was supposed to implement those equations then looking at the output.