Now use a more accurate dt while integrating. This seems to have fixed the accuracy for at the very least the z-axis. I'll verify the other axes later.