improved the servo stuff