Main control loop to 190Hz
Update gains