Adding Project 1 rotary encoder implementations
This commit is contained in:
@@ -0,0 +1,26 @@
|
||||
#include <digital_in.h>
|
||||
#include <avr/io.h>
|
||||
|
||||
Digital_in::Digital_in(int pin)
|
||||
{
|
||||
pinMask = static_cast<uint8_t>(1U << pin);
|
||||
}
|
||||
|
||||
void Digital_in::init()
|
||||
{
|
||||
// Configure pin as input
|
||||
DDRB &= static_cast<uint8_t>(~pinMask);
|
||||
|
||||
// Enable internal pull-up resistor
|
||||
PORTB |= pinMask;
|
||||
}
|
||||
|
||||
bool Digital_in::is_hi()
|
||||
{
|
||||
return (PINB & pinMask) != 0;
|
||||
}
|
||||
|
||||
bool Digital_in::is_lo()
|
||||
{
|
||||
return (PINB & pinMask) == 0;
|
||||
}
|
||||
@@ -0,0 +1,27 @@
|
||||
#include <digital_out.h>
|
||||
#include <avr/io.h>
|
||||
|
||||
Digital_out::Digital_out(int pin)
|
||||
{
|
||||
pinMask = static_cast<uint8_t>(1U << pin);
|
||||
}
|
||||
|
||||
void Digital_out::init()
|
||||
{
|
||||
DDRB |= pinMask;
|
||||
}
|
||||
|
||||
void Digital_out::set_hi()
|
||||
{
|
||||
PORTB |= pinMask;
|
||||
}
|
||||
|
||||
void Digital_out::set_lo()
|
||||
{
|
||||
PORTB &= static_cast<uint8_t>(~pinMask);
|
||||
}
|
||||
|
||||
void Digital_out::toggle()
|
||||
{
|
||||
PORTB ^= pinMask;
|
||||
}
|
||||
@@ -0,0 +1,48 @@
|
||||
#include <encoder.h>
|
||||
|
||||
Encoder::Encoder(int c1Pin, int c2Pin, int ledPin)
|
||||
: c1(c1Pin), c2(c2Pin), led(ledPin),
|
||||
previousC1(false), count(0)
|
||||
{
|
||||
}
|
||||
|
||||
void Encoder::init()
|
||||
{
|
||||
c1.init();
|
||||
c2.init();
|
||||
led.init();
|
||||
|
||||
led.set_lo();
|
||||
|
||||
previousC1 = c1.is_hi();
|
||||
count = 0;
|
||||
}
|
||||
|
||||
void Encoder::update()
|
||||
{
|
||||
led.set_lo();
|
||||
|
||||
bool currentC1 = c1.is_hi();
|
||||
|
||||
if (currentC1 != previousC1)
|
||||
{
|
||||
bool currentC2 = c2.is_hi();
|
||||
|
||||
if (currentC1 == currentC2)
|
||||
{
|
||||
count++;
|
||||
}
|
||||
else
|
||||
{
|
||||
count--;
|
||||
}
|
||||
|
||||
previousC1 = currentC1;
|
||||
led.set_hi();
|
||||
}
|
||||
}
|
||||
|
||||
int Encoder::position()
|
||||
{
|
||||
return count;
|
||||
}
|
||||
@@ -0,0 +1,22 @@
|
||||
#include <Arduino.h>
|
||||
#include <encoder.h>
|
||||
|
||||
int main()
|
||||
{
|
||||
init();
|
||||
|
||||
Encoder encoder(0, 1, 5);
|
||||
|
||||
encoder.init();
|
||||
|
||||
Serial.begin(9600);
|
||||
|
||||
while (1)
|
||||
{
|
||||
encoder.update();
|
||||
|
||||
Serial.println(encoder.position());
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user