Added initial version of rotation PID controller