Add a state-space drivetrain controller

[ewpratten]

This should contain a simulator, and a new constructor for tankdrivetrain should be added to accept this controller (abstraction time)