Added basic initialization of PID