Added basic PID controller support. Still needs support for controller state.