Added initialization and cycling of motor 1