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)
