Major Version Update:
- Publish the documentation for the project.
- Add coverage tests for the project.
- Refactor the kinematics handler and geometry handler to configure the robot and obstacles.
- Reorganize the lidar2d step function to improve its performance.
- Update the comments for the functions.
- Fix some bugs in the project.
- Add a 3D plotting environment.