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

Book software bugs report in Chapter 3 #38

Closed zhuangzhuang-zhang closed 3 years ago

zhuangzhuang-zhang commented 3 years ago

hi, thank you for your great open source work, and there seems a problem in charpter 3 by python version, in the last line of the function def MatrixLog3(R): , which is return theta / 2.0 / np.sin(theta) * (R - np.array(R).T) I think the first theta should be the 1, not theta according to the formula in the book, could you check it, please.