You are on page 1of 1

void 

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)

You might also like