https://ameusimc.blogspot.com/2023/10/calculate-angular-displacement-with.html