01 void setup() {
02   // put your setup code here, to run once:
03   pinMode ( 2 , INPUT_PULLUP );
04   pinMode ( 3 , INPUT_PULLUP );
05
06   pinMode ( 8 , OUTPUT );
07   pinMode ( 9 , OUTPUT );
08   pinMode ( 10 , OUTPUT );
09   pinMode ( 11 , OUTPUT );
10
11   digitalWrite ( 8, HIGH );
12   digitalWrite ( 9, HIGH );
13   digitalWrite ( 10, HIGH );
14   digitalWrite ( 11, HIGH );
15
16   Serial.begin(19200);
17 }
18
19 void loop() {
20   // put your main code here, to run repeatedly:
21   int iInput2 = 0;          // Wand 1
22   int iInput3 = 0;          // Wand 2
23   int iOut1State = 0;       // General output for Hand 1
24   int iOut2State = 0;       // General output for Hand 2
25   int iMotorReset1 = 0;     // Tracks if motor 1 has been shut off due to long contact
26   int iMotorReset2 = 0;  // Tracks if motor 2 has been shut off due to long contact
27   unsigned long ulReset1 = 0;  // Time in millis to turn off the Hand 1 buzzer and light
28   unsigned long ulReset2 = 0;  // Time in millis to tunr off the hand 2 buzzer and light
29   unsigned long ulMotor1 = 0;  // Time in millis to turn off the hand 1 motor for long contact
30   unsigned long ulMotor2 = 0;  // Time in millis to turn off the hand 2 motor for long contact
31
32   while ( 1 )
33   {
34     iInput2 = digitalRead ( 2 );  // Are we touching the hand 1 puzzle?
35     iInput3 = digitalRead ( 3 );  // Are we touching the hand 2 puzzle?
36
37     if ( iInput2 == LOW )         // If we're touching the hand 1 puzzle...
38     {
39       ulReset1 = millis() + 500; // Set a timer for 1 second from now
40       if ( ulMotor1 == 0 ) ulMotor1 = millis() + 10000;   // Set a timeout for 10 seconds from now
41       if ( iMotorReset1 == 0 ) {
42         Serial.println ( "Motor On" );
43         digitalWrite ( 8 , LOW );  // Turn on the motor if it hasn't been disabled
44         digitalWrite ( 9 , LOW );   // Turn on the light
45       }
46
47     }
48     else    // We're not touching the puzzle
49     {
50       iMotorReset1 = 0;   // Clear the timeout flag
51       //ulMotor1 = 0;       // Clear the timeout timer
52       Serial.println ( "Motor Off" );
53     }
54
55     if ( iInput3 == LOW )   // Same as above but hand 2
56     {
57       ulReset2 = millis() + 500;
58       if ( ulMotor2 == 0 ) ulMotor2 = millis() + 10000;
59       if ( iMotorReset2 == 0 ) {
60         digitalWrite ( 10 , LOW );
61         digitalWrite ( 11 , LOW );
62       }
63     }
64     else
65     {
66       iMotorReset2 = 0;
67       //ulMotor2 = 0;
68     }
69
70     if ( millis() > ulMotor1 && ulMotor1 != 0 )   // If current time (millis) is greater than the motor timeout AND we're watching for a timeout...
71     {
72       digitalWrite ( 8 , HIGH );    // Turn off the motor
73       digitalWrite ( 9 , HIGH );
74       iMotorReset1 = 1;       // Set the reset flag so we don't turn it on again
75       Serial.println ( "Motor Timeout" );
76     }
77
78     if ( millis() > ulMotor2 && ulMotor2 != 0 )
79     {
80       digitalWrite ( 10 , HIGH );
81       digitalWrite ( 11 , HIGH );
82       iMotorReset2 = 1;
83     }
84
85     if ( millis() > ulReset1 )    // Is it time to reset the buzzer / light?
86     {
87       digitalWrite ( 8 , HIGH );  // If so turn them off
88       digitalWrite ( 9 , HIGH );
89       ulMotor1 = 0;
90     }
91
92     if ( millis() > ulReset2 )
93     {
94       digitalWrite ( 10 , HIGH );
95       digitalWrite ( 11 , HIGH );
96       ulMotor2 = 0;
97     }
98   }
99 }