- added rigid body class
- added trajectory generator class
- added gymnasium and stablebaseline3 wrappers
- added drawing tools
- added plane class
- added trajectory tracking lqr controller
- added controller graphic output function
- added dynamic plot for trajectory optimization