**Please pay more attention to the correctness of the model, when the robot has closed-loop chains like CURI.** - [x] Forward kinematics - [x] Inverse kinematics - [ ] Forward dynamics - [ ] Inverse dynamics