ported PID code over to arduino
one PID per motor