Working 2D simulation!
Stable control, with gps noise
Merge https://github.com/Jochi-Labs/J3CA-main