Fixed loop bug where I had a number in degrees instead of centidegrees
Added I and D to the controller, parameters at the top.
Created a separate bang bang controller - change the function at the bottom to call this if desired.

Neither controller leads to stable control - PID seems closer and may just need parameter tuning.
Would definitely help if we had RX-64's for every hip.