NxRLab / ModernRobotics

Modern Robotics: Mechanics, Planning, and Control Code Library --- The primary purpose of the provided software is to be easy to read and educational, reinforcing the concepts in the book. The code is optimized neither for efficiency nor robustness.
http://modernrobotics.org/
MIT License
1.9k stars 807 forks source link

Detect values more than 1 in rotation matrix in case of computational errors #23

Closed likerobotics closed 5 years ago

likerobotics commented 5 years ago

Added a new function to detect values more than 1 in the rotation matrix in cases of computational errors

HuanWeng commented 5 years ago

I think to solve this problem we can use the function ProjectToSO3 in our library.

likerobotics commented 5 years ago

I think to solve this problem we can use the function ProjectToSO3 in our library.

I didn't think about ProjectToSO3,absolutely agree.