Makeblock-library-for-Arduino  V3.2.4
It's a library for arduino application developers
Me_Auriga_encoder_direct.ino
/**
* \par Copyright (C), 2012-2016, MakeBlock
* @file Me_Auriga_encoder_direct.ino
* @author MakeBlock
* @version V1.0.0
* @date 2016/07/14
* @brief Description: this file is sample code for auriga encoder motor device.
*
* Function List:
* 1. uint8_t MeEncoderOnBoard::getPortB(void);
* 2. uint8_t MeEncoderOnBoard::getIntNum(void);
* 3. void MeEncoderOnBoard::pulsePosPlus(void);
* 4. void MeEncoderOnBoard::pulsePosMinus(void);
* 5. void MeEncoderOnBoard::setMotorPwm(int pwm);
* 6. double MeEncoderOnBoard::getCurrentSpeed(void);
* 7. void MeEncoderOnBoard::updateSpeed(void);
*
* \par History:
* <pre>
* <Author> <Time> <Version> <Descr>
* Mark Yan 2016/07/14 1.0.0 build the new
* </pre>
*/
#include <MeAuriga.h>
MeEncoderOnBoard Encoder_1(SLOT1);
MeEncoderOnBoard Encoder_2(SLOT2);
void isr_process_encoder1(void)
{
if(digitalRead(Encoder_1.getPortB()) == 0)
{
Encoder_1.pulsePosMinus();
}
else
{
Encoder_1.pulsePosPlus();;
}
}
void isr_process_encoder2(void)
{
if(digitalRead(Encoder_2.getPortB()) == 0)
{
Encoder_2.pulsePosMinus();
}
else
{
Encoder_2.pulsePosPlus();
}
}
void setup()
{
attachInterrupt(Encoder_1.getIntNum(), isr_process_encoder1, RISING);
attachInterrupt(Encoder_2.getIntNum(), isr_process_encoder2, RISING);
Serial.begin(115200);
//Set PWM 8KHz
TCCR1A = _BV(WGM10);
TCCR1B = _BV(CS11) | _BV(WGM12);
TCCR2A = _BV(WGM21) | _BV(WGM20);
TCCR2B = _BV(CS21);
}
void loop()
{
Encoder_1.setMotorPwm(100);
Encoder_2.setMotorPwm(100);
Encoder_1.updateSpeed();
Encoder_2.updateSpeed();
Serial.print("Spped 1:");
Serial.print(Encoder_1.getCurrentSpeed());
Serial.print(" ,Spped 2:");
Serial.println(Encoder_2.getCurrentSpeed());
}