#include <Arduino.h>

#include "afsk_sinus.hpp"


extern void sendOne(uint32_t *us, uint8_t *phaseShift);
extern void sendZero(uint32_t *us, uint8_t *phaseShift);

uint32_t m = 0;
uint8_t phaseShift = 0;

void sendBell202(uint8_t byt) {
  for (uint8_t i = 0; i < 8; ++i) {
    if ((byt >> i) & 1) {
      sendOne(&m, &phaseShift);
    } else {
      sendZero(&m, &phaseShift);
    }
  }
}

void sendBell202buf(uint8_t *buf, size_t len) {
  m = micros();
  for (size_t i = 0; i < len; ++i) {
    sendBell202(buf[i]);
  }
}


void setup() {
  OUT_DDR = 0xff;
  Serial.begin(115200);
}

uint8_t bytes[] = {
  0xff, 0x55, 0xff, 0x00, 0xff, 0x00
};

void loop() {
  sendBell202buf(bytes, 6);
}