Solve error in code
Add new calc of rotation errors for testing