Added time library and refactor the servo code slighly to trigger based on time