Add standard form PID controller, update README, create basic high-level controller.