Updated to stop the servo on more light