blob: 22194c341b126f9ffcd768eeaf57134ce8b657d0 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
|
/*------------------------------------------------------------------------------------
* 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 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;
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;
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;
Serial.println(inbuffer+3);
} else {
yellowGoal=target;
}
} else if (inbuffer[0]=='v') {
Serial.println("RaceClock 0.1");
Serial.flush();
} else if (inbuffer[0]=='s') {
if (blueGoal||yellowGoal) {
blueGoal=yellowGoal=STEPS_PER_REVOLUTION;
}
}
bufferIndex=0; //reset input
}
}
if ((millis()-lastStepMillis)>MIN_MILLIS_PER_STEP){
if ((blueGoal==STEPS_PER_REVOLUTION)&&((bluePosition==0)||(blueGoal==bluePosition))){
blueGoal=bluePosition=0;
}
if ((yellowGoal==STEPS_PER_REVOLUTION)&&((yellowPosition==0)||(yellowGoal==yellowPosition))){
yellowGoal=yellowPosition=0;
}
if ((blueGoal>bluePosition) && (bluePosition<STEPS_PER_REVOLUTION)){
blue.step(-1);
bluePosition++;
}
if ((yellowGoal>yellowPosition) && (yellowPosition<STEPS_PER_REVOLUTION)) {
yellow.step(-1);
yellowPosition++;
}
lastStepMillis=millis();
}
}
|
