Further initializations. Made the reference torque and pitch values global...

Further initializations. Made the reference torque and pitch values global variables so that the 'old' values can be updated at the beginning of the next time step. Made sure that the controller can be called twice in the very first time step without treating it as an iteration.