Has any one used the encoder included in the KOP with the arduino? can someone give me the code for it so i can read the rpm?
Thanks
I can give you code, but wouldn’t you learn more by doing the research and writing your own?
Let me push you in the right direction and see how far you can go. Don’t be surprised if you learn to fly along the way.
The first thing you want to learn is how to use the “interrupt” input(s), more specifically, “External Interrupt”. One channel of the encoder will go to that input. The other channel will be used to determine direction.
Your interrupt service routine will sample that input. High would be forward, otherwise it’s reverse.
RPM after that is simply a little math.
OK, that’s enough hints for now. Let us know what you find. I’ll always help you out if you just ask.
We are using a Grayhill 63R64 encoder with an Arduino mega for the RPMs of our shooter. We opted for that encoder instead of the KOP because the PPR on the KOP encoder is so high that we were concerned at overrunning the Arduino. Further testing shows that the Arduino is easily capable of 30,000 PPS. So, that concern turned out to be bogus. But, using the KOP encoder would require another gearbox up high on our bot that would adversely effect the COG while trying to balance or going over the bump.
The Arduino mega can source the 5V for the Grayhill or the KOP encoder with no problem. We bring the A channel back from the encoder to Digital Pin 2 on the Arduino. The magic you’re looking for can be found in the “attachInterrupt” command. Use it to increment a counter on the rising edge of the encoder pulse and then periodically read the pulse count and do your math for the RPM.
We also added the “SimpleTimer” library from the Arduino playground site so we could get updates every 100 ms. This library attaches a timer interrupt to a function so it’s called at the interval you desire rather than simply polling the counter.
Our code sends it’s output via an Ethernet shield direct to the cRio using UDP. We found some really interesting gotchas with the cRio robot code in that you must read the packets or face the possibility of a robot lockup. So, you’ll need a blocking thread to read the socket constantly. Our robot code is written in C++, so creating a thread was pretty easy.
In addition, our Arduino is also sampling an absolute encoder on our ball shooting angle device. No problem doing both functions and sending out the results.
I’d say that the entire Arduino program for both sensors and the Ethernet output is maybe 50 lines of code total.
how do i use the simpletimer and the attachinterrupt command?
Too funny. I’m literally doing this as I speak. Here’s my code.
// Controlling a servo position using a potentiometer (variable resistor)
// by Michal Rinott <http://people.interaction-ivrea.it/m.rinott>
#include <Servo.h>
Servo motor1; // create servo object to control a motor
Servo motor2; // ditto
int potpin = 0; // analog pin used to connect the potentiometer
int val; // variable to read the value from the analog pin
volatile byte rpmcount;
unsigned int rpm;
unsigned long timeold;
void setup()
{
motor1.attach(9); // attaches the motor 1 on pin 9 to the servo object
motor2.attach(10); // attaches the motor 2 on pin 10 to the servo object
attachInterrupt(0, rpm_fun, RISING); // attaches the encoder on (digital pin 2)
rpmcount = 0;
rpm = 0;
timeold = 0;
digitalWrite(2, HIGH);
Serial.begin(9600);
}
void loop()
{
val = analogRead(potpin); // reads the value of the potentiometer (value between 0 and 1023)
val = map(val, 0, 1023, 0, 179); // scale it to use it with the servo (value between 0 and 180)
if (rpmcount >= 0) {
rpm = 30*1000/(millis() - timeold)*rpmcount;
timeold = millis();
rpmcount = 0;
Serial.print("RPM: ");
Serial.print(rpm);
Serial.print(" Pot: ");
Serial.print(val);
Serial.print("
");
}
motor1.write(val); // sets the motor speed according to the scaled value
motor2.write(val);
}
void rpm_fun()
{
rpmcount++;
}
Note that you either have to use a pullup resistor or use the digitalWrite(2, HIGH) command in the setup section (as I did). This uses the internal pull-up resistor on that pin. Also, note that I’m controlling 2 motors with a potentiometer. That’s what’s basically happening here.
You have to treat victors as servos rather than directly feed PWM. Victors actually read PPM, so you have to treat them as servos (which read PPM) in Arduino.
do i have to divide the rpm by 360 since my encoder has 360 positions in 1 rotation?
i noticed that your code resets back to zero after 60,000 rpm. it is reading much faster that actually spinning. what do i do to make it the actual rpm
My encoder is the kop encoder and it has 360 positions in 1 rotation
Actually, I just modified my code. I realized I had a mistake:
// Controlling a servo position using a potentiometer (variable resistor)
// by Michal Rinott <http://people.interaction-ivrea.it/m.rinott>
#include <Servo.h>
Servo motor1; // create servo object to control a motor
Servo motor2; // ditto
int potpin = 0; // analog pin used to connect the potentiometer
int val; // variable to read the value from the analog pin
float dt;
volatile byte rpmcount;
float rpm;
unsigned long timeold;
void setup()
{
motor1.attach(9); // attaches motor 1 on pin 9 to the servo object
motor2.attach(10); // ditto
attachInterrupt(0, rpm_fun, RISING);
rpmcount = 0;
rpm = 0;
timeold = 0;
digitalWrite(2, HIGH);
Serial.begin(9600);
}
void loop()
{
val = analogRead(potpin); // reads the value of the potentiometer (value between 0 and 1023)
val = map(val, 0, 1023, 0, 179); // scale it to use it with the motor (value between 0 and 180)
if (rpmcount >= 20) {
dt = (float)(millis() - timeold)/1000;
Serial.print(dt);
rpm = rpmcount/dt*60;
timeold = millis();
rpmcount = 0;
Serial.print(" RPM: ");
Serial.print(rpm);
Serial.print(" Pot: ");
Serial.print(val);
Serial.print("
");
}
motor1.write(val); // sets the motor speed according to the scaled value
motor2.write(val);
}
void rpm_fun()
{
rpmcount++;
}
At any rate, when used as an interrupt, it only counts once per revolution.
[quote=]
At any rate, when used as an interrupt, it only counts once per revolution.[/quote]
it may only count once, but i was getting around 8000 rpm.
with your new code, the faster it spins, the lower the rpm.
Are you looking at the first column?
If you are, disregard that. That’s the “dt” value. Sorry, I didn’t make it very legible. Look at the second set of numbers.
0.43 RPM: 2803.74 Pot: 82
means that 0.43 is the time between calculations, 2803.74 is the revolutions per minute, and 82 is the potentiometer value.
ok now im reading the right number. but it seems the rpm is way to high then the actual rpm.
im spinning it by hand and its reading around 21,000 rpm. this is way to high. im spinning it at around 60 rpm +or- 10 rpm
You didn’t multiply it by 360 did you? If not, The arduino board MIGHT somehow me picking up every encoder tick. If that’s the case, divide by 360. (Notice that 21000/360 = 58.3)
It would make sense, by the way, if it is. My code is for a hall effect sensor being used as an encoder that reads a screw once per revolution.
sorry if i was unclear but i was looking for code for a encoder that reads 360 positions per revolution compared to your 1 . no worries, all i did was divide your rpm by 360.
So you got it working then? Dividing by 360 would be the solution I think.
Oh, and I thought I’d caution you. There’s a maximum read rate on the arduinos. It takes about 100 microseconds to take a reading, so it can read about 10,000 times/second. Since you’re reading all 360 values every rotation, you’ve got a maximum of 27.78 rev/sec, or 1666.67 RPM. Not really sure what you’re using it for, but keep that in mind.
Thank you folks. I found this thread very informative and useful.
We are also working to “off-load” more robot functions to an Arduino Mega.
Doc
are you sure its 1666? i went up to as high as 2000 multiple times in a row
i think the fastest i could spin it was 2100rpm