better calculation for angle/velocity/direction