roboforum.ru

Технический форум по робототехнике.

Энкодер из движка от сидирома (6 тиков на оборот)

Энкодер из движка от сидирома (6 тиков на оборот)

dccharacter » 28 янв 2012, 22:01

Сделал энкодер из движка от сидирома - 6 тиков на оборот.

Код для дуни:
Код: Выделить всёРазвернуть
#include "Arduino.h"

int h2 = 3;
int counter = 0;

volatile int state = LOW;

void setup()
{
  Serial.begin(115200);
  pinMode(h2, INPUT);
  attachInterrupt(0, trigger, RISING);
}

void loop()
{
  delay (100);
  Serial.println(counter/6, DEC);
}

void trigger()
{
  if (digitalRead(h2)) counter++;
  else counter --;
}

По идее, магнит можно выцарапать из корпуса и вклеить прямо на борт колеса, например. Если еще помудрить с кодом, то можно, наверное, разрешение раза в три повысить. Т.е. смотреть по всем трем датчикам и по обоим фронтам.


Rambler\'s Top100 Mail.ru counter