Add last bit of last minute stuff requested by Chrome which failed on the road

1 files changed, 135 insertions, 0 deletions

diff --git a/bikewedge/software/NewClock.ino b/bikewedge/software/NewClock.ino
new file mode 100644
index 0000000..e76cdd7
--- /dev/null
+++ b/bikewedge/software/NewClock.ino
@@ -0,0 +1,135 @@
+/*------------------------------------------------------------------------------------
+ * rough in of new clock. 
+ * bikewedge proxy provides the number of steps wanted from goldsprints data.
+ * this should do some pid ling around so that it will be less jerkey. 
+ * requires the modified stepper motors to do half stepping.
+ *
+ * (c) 2013 Donald Delmar Davis, Suspect Devices 
+ * 
+ */
+
+#include <Stepper.h>
+#define MIN_MILLIS_PER_STEP 8
+#define DEFAULT_MILLIS_PER_STEP 15
+#define STEPPER_STEPS 200
+#define STEPS_PER_REVOLUTION 2132                                    
+#define INBUFFERLENGTH 100
+char inbuffer[INBUFFERLENGTH];
+int bufferIndex;
+int yellowGoal=0;
+int blueGoal=0;
+int yellowPosition=0;
+int bluePosition=0;
+int stepCount = 0;
+
+long int lastStepMillis;
+long int blueReadMillis;
+long int blueStepMillis;
+long int blueDeltaT;
+long int blueStepDelta;
+long int yellowReadMillis;
+long int yellowStepMillis;
+long int yellowDeltaT;
+long int yellowStepDelta;
+
+Stepper blue(STEPPER_STEPS, 8,9,10,11,1);            
+Stepper yellow(STEPPER_STEPS, 2,3,4,5,1);            
+
+void setup() {
+  // initialize the serial port:
+  Serial.begin(115200);
+}
+
+void loop() {
+  int target;
+  int delta;
+  while (Serial.available()) {
+    // get the new byte:
+    char inChar = (char)Serial.read(); 
+    // add it to the inputString:
+    if (bufferIndex<INBUFFERLENGTH)
+      inbuffer[bufferIndex++]=inChar;
+    if (inChar == '\n') {
+      inbuffer[bufferIndex]=0;
+      if ((inbuffer[0]=='d') && bufferIndex>3) {
+        target=atoi(inbuffer+3);
+        if (target>STEPS_PER_REVOLUTION) target=STEPS_PER_REVOLUTION;
+        if (inbuffer[1]=='1') {
+          blueGoal=target;
+          delta = target - bluePosition;
+          if (delta>0) {
+            blueStepDelta = (millis() - blueReadMillis) / delta;
+            if (blueStepDelta<MIN_MILLIS_PER_STEP) {
+              blueStepDelta=MIN_MILLIS_PER_STEP;
+            }
+          } else {
+            blueStepDelta = DEFAULT_MILLIS_PER_STEP;
+          }
+          blueReadMillis=millis();
+        } else {
+          yellowGoal=target;
+          delta = target - yellowPosition;
+          if (delta>0) {
+            yellowStepDelta = (millis() - yellowReadMillis) / delta;
+            if (yellowStepDelta<MIN_MILLIS_PER_STEP) {
+              yellowStepDelta=MIN_MILLIS_PER_STEP;
+            }
+
+          } else {
+            yellowStepDelta = DEFAULT_MILLIS_PER_STEP;
+          }
+          yellowReadMillis=millis();
+        } 
+      } else if (inbuffer[0]=='v') {
+        Serial.println("RaceClock 0.");
+        Serial.flush();
+      } else if (inbuffer[0]=='s') {
+        if (blueGoal||yellowGoal) {
+          blueGoal=yellowGoal=STEPS_PER_REVOLUTION;
+        }
+        blueDeltaT = 0L;
+        blueStepDelta = DEFAULT_MILLIS_PER_STEP;
+        blueStepMillis = blueReadMillis = millis();
+        yellowDeltaT = 0L;
+        yellowStepDelta = DEFAULT_MILLIS_PER_STEP;
+        yellowStepMillis = yellowReadMillis = millis();   
+
+      } else if (inbuffer[0]=='g') {
+        blueDeltaT = 0L;
+        blueStepDelta = DEFAULT_MILLIS_PER_STEP;
+        blueStepMillis = blueReadMillis = millis();
+        yellowDeltaT = 0L;
+        yellowStepDelta = DEFAULT_MILLIS_PER_STEP;
+        yellowStepMillis = yellowReadMillis = millis();   
+      }
+
+      bufferIndex=0; //reset input
+
+    }
+  }
+//  if ((millis()-lastStepMillis)>MIN_MILLIS_PER_STEP){
+  if ((millis()-blueStepMillis)>blueStepDelta) {
+    if ((blueGoal==STEPS_PER_REVOLUTION)&&((bluePosition==0)||(blueGoal==bluePosition))){
+         blueGoal=bluePosition=0;
+    }
+    if ((blueGoal>bluePosition) && (bluePosition<STEPS_PER_REVOLUTION)){
+        blue.step(-1);
+        bluePosition++;  
+    }
+    blueStepMillis=millis();
+  } else if ((millis()-yellowStepMillis)>yellowStepDelta) {
+    if ((yellowGoal==STEPS_PER_REVOLUTION)&&((yellowPosition==0)||(yellowGoal==yellowPosition))){
+         yellowGoal=yellowPosition=0;
+    }   
+    if ((yellowGoal>yellowPosition) && (yellowPosition<STEPS_PER_REVOLUTION)) {
+        yellow.step(-1);
+        yellowPosition++;
+    }
+    yellowStepMillis=millis();
+  }
+//  }
+
+   
+}
+
+