Wheel speed controllers ready!

These are two independent speed controllers (one for each wheel) keeping both average speed of 0.4 m/s across 2.5 meters.
The robot oscillates a bit, but the trajectory is fairly straight. I think I’ll try to use it as a building block in the trajectory controller.