Professional Documents
Culture Documents
loop()
motorFoward()
newposition = encoder0Pos
vel =
newtime = millis() (newposition-oldposition) *
1000 /(newtime-oldtime);
pos = (newposition)
Serial.print ("speed = ");
erial.println (vel);
Serial.print ("Time = ");
data() Serial.println (newtime);
Serial.print ("position =
");
Serial.println (pos);
oldposition = newposition
oldtime = newtime
delay(250)
motorBackward()
newposition = encoder0Pos
newtime = millis()
vel = (newposition - oldposition) 1000 / (newtime - oldtime)
pos = (newposition)
Serial.print ("speed = ");
Serial.println (vel);
/Serial.print ("Time =
data()
");Serial.println (newtime);
Serial.print ("position =
"); Serial.println (pos);
oldposition = newposition
oldtime = newtime
delay(250)
void doEncoder()
digitalRead(encoder0PinA) == digitalRead(encoder0PinB)
True False
encoder0Pos++ encoder0Pos--
void data()
Serial.print("Speed =")
Serial.print(vel)
Serial.print(",")
Serial.print("Time = ")
Serial.print(newtime)
Serial.print (",") Serial.println (newtime);
Serial.print ("position = ")
Serial.println (pos)