added basic PID controller
depends on stubbed distance that will be received from the encoders