Use [Choreo](https://choreo.autos/) for basic routes Run test paths for: - [x] Driving straight in the X direction - [x] Driving stright in the Y direction - [x] Rotating while driving in a straight line - [x] Driving diagonally - [ ] Driving and localising position - [x] Find the gains for the auton constants using [sysid](https://first-plus-docs.readthedocs.io/en/latest/docs/software/pathplanning/system-identification/introduction.html)
Use Choreo for basic routes
Run test paths for:
Driving straight in the X direction
Driving stright in the Y direction
Rotating while driving in a straight line
Driving diagonally
Driving and localising position
Find the gains for the auton constants using sysid