#define EJECT OUT_B #define WIND OUT_C #define CLOSED IN_1 #define NOTOPEN IN_2 sub eject { if (NOTOPEN == 1) { Fwd(EJECT, 7); while (NOTOPEN == 1); Sleep(30); Off(EJECT); Sleep(50); } Float(EJECT); } sub load { Rev(WIND, 1); Rev(EJECT, 7); while (CLOSED == 0); Off(EJECT); Off(WIND); } task main { Sensor(NOTOPEN, IN_SWITCH); Sensor(CLOSED, IN_SWITCH); eject(); while (1 == 1) { while (NOTOPEN == 0); load(); Sleep(100); Fwd(WIND, 7); Sleep(300); Off(WIND); Sleep(100); eject(); } }