tree dfbdb1b2ddf81fedd0b2f9023457a8bf8a9dddf6
parent d1ab5d49f0b229a0bf32063a0cdd8d3d9a772612
author Austin Schuh <austin.linux@gmail.com> 1728168996 -0700
committer Austin Schuh <austin.linux@gmail.com> 1729372692 -0700
gpgsig -----BEGIN PGP SIGNATURE-----
 
 iQGzBAABCgAdFiEExcNA7Sy+j6Ly5hA4QVYw08sOnWYFAmcUIhQACgkQQVYw08sO
 nWZ7OQv+NKTpRUvzNDin/CcPb5HPGW47abJqkFAk1I1b9hpqgcmYAtgKK8zlaiQo
 O1fV9IT5DxAP5No6nXfaecnBxFCbefzDweUTtK4SsRv5U8YX9YIVX5BKLQpUkcU7
 CgMdgcAOqN/49m2BtlyXJSyv22lb7oHOJGDS9OHPKWReohtlVXG1bZFhw1AHuAT8
 4wy5A1Oxqz7iy8GxOpNDkQXF/iTTa19zioMEUSKp8MldSTM4KtAJzC6KmvJa2pBB
 0RVJ1uomr2YGNTnx52BWfl54DxyRXpURz44FwbAn3++T0ELsFOafGGeuBPlU2RIa
 NGEd2SUREKblU3O+zCmnnmmMrC5PE+ySmEFd+XFYGunvJwrdncV0Z2u4pFS/iWF8
 8ze3lmR8OKIgXcwmdS5ENgLyGT4RjJU/v+MQ/7t8YvZODOYyGeb1U7Dtp40U7f8F
 rl4WbpVNQEICe3vB9p322aUQfIV/PQ10h+eE0s3fq/4iTDmsLUfF9WazzITAfRyh
 Noyqh6qK
 =6E6r
 -----END PGP SIGNATURE-----

Prep lqr_plot for plotting swerve

There were a lot of constants which were duplicated, makes more sense to
pull them into the physics to keep the logic cleaner.

Change-Id: I04cede2008dae1035de2f820a3d588e07c1573dd
Signed-off-by: Austin Schuh <austin.linux@gmail.com>