Test name: Open Loop with LQR focus on travel
Variables changed: Q for travel set to 10, other 1
Expected behaviour: Optimal travel trajectory should be followed closer, less drift when standing still
Results: As expected :)