Updated code to continously move the servo's until stopped