#include "openbeacon.h"
#include "nrf24l01p.h"
#include "basic/byteorder.h"

const uint32_t key = {0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF};
const uint8_t enctoggle = 0;
uint32_t mid = 0;
uint32_t mctr = 0;
uint8_t strength = 0;

void openbeaconSetup(uint32_t id, uint32_t ctr)
{
    mid = id;
    mctr = ctr;
    strength = 0;
}

void openbeaconSendPacket(uint32_t id, uint32_t ctr, uint8_t flags, uint8_t strength)
{
    uint8_t buf[32];
    int status;

    buf[0]=0x10; // Length: 16 bytes
    buf[1]=0x17; // Proto - fixed at 0x17?
    buf[2]=flags;
    buf[3]=strength*85; // Send intensity

    uint322uint8p(ctr, buf+4);
    uint322uint8p(id, buf+8);

    buf[12]=0xff; // salt (0xffff always?)
    buf[13]=0xff;

    status=nrf_snd_pkt_crc_encr(16,buf,enctoggle?testkey:NULL);
}

void openbeaconSend(void)
{
    //uint8_t tmp = nrfgetstrength();
    //nrfsetstrength(strength);
    openbeaconSendPacket(mid, ctr++, 0xFF, strength++);
    if( strength == 4 )
        strength = 0;
    //maybe this produces timing problems?
    //nrfsetstrength(tmp);
}