Форум РадиоКот

Код: Выделить всё

#include "main.h"
#include "led_classic.h"


static const uint8_t segment[] = { SEGMENT };
static const uint8_t common[]  = { COMMON };

void ledInit() {
  for (uint8_t i = 0; i < sizeof(segment); i++)
    out(segment[i]);
  for (uint8_t i = 0; i < sizeof(common); i++)
    out(common[i]);
}


static uint8_t segment_buffer[sizeof(common)];

// Вызов с периодом <= 12 / COMMON_MAX, ms (>= 60Hz)
void ledTick() {
  static uint8_t com;

  com_off(common[com]);
  if (++com >= sizeof(common))
    com = 0;
  for (uint8_t i = 0; i < sizeof(segment); i++)
    write(segment[i], !!(segment_buffer[com] & 1<<i) == CC);
  com_on(common[com]);
}


static const uint8_t font[] PROGMEM = {
  //gfedcba
  0b0111111,                            //0     a
  0b0000110,                            //1    --
  0b1011011,                            //2  f|  |b
  0b1001111,                            //3   g--
  0b1100110,                            //4  e|  |c
  0b1101101,                            //5    -- .h
  0b1111101,                            //6     d
  0b0000111,                            //7
  0b1111111,                            //8
  0b1101111,                            //9
  0b1110111,                            //A
  0b1111100,                            //b
  0b0111001,                            //C
  0b1011110,                            //d
  0b1111001,                            //E
  0b1110011                             //F
  //gfedcba
};
#define H_SEGMENT         (1<<7)

static uint8_t getFont(uint8_t dig) {
  return pgm_read_byte(&font[dig & 0x0f]);
}


static uint8_t dot_position;

// right justify
void display(uint16_t bin) {
  bool nz = false;
  uint8_t i = 0;
  for (uint16_t div = DIVIDER; div > 1; div /= 10, i++) {
    if (bin / div)
      nz = true;
    segment_buffer[i] = 0;
    if (nz)
      segment_buffer[i] = getFont(bin / div);
    bin %= div;
  }
  segment_buffer[i] = getFont(bin);
  if (dot_position)
    segment_buffer[dot_position - 1] |= H_SEGMENT;
}


void setDot(uint8_t pos) {
  dot_position = pos;
}