trying different PID parameters...
plot actual torque too
plotting actual torque