diff --git a/firmware/funk/Makefile b/firmware/funk/Makefile index dd2a593..bc05c8e 100644 --- a/firmware/funk/Makefile +++ b/firmware/funk/Makefile @@ -7,6 +7,7 @@ OBJS = OBJS += nrf24l01p.o OBJS += rftransfer.o OBJS += filetransfer.o +OBJS += openbeacon.h LIBNAME=funk diff --git a/firmware/funk/openbeacon.c b/firmware/funk/openbeacon.c new file mode 100644 index 0000000..b980a90 --- /dev/null +++ b/firmware/funk/openbeacon.c @@ -0,0 +1,46 @@ +#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); +} diff --git a/firmware/funk/openbeacon.h b/firmware/funk/openbeacon.h new file mode 100644 index 0000000..3d9d82d --- /dev/null +++ b/firmware/funk/openbeacon.h @@ -0,0 +1,10 @@ +#ifndef _OPENBEACON_H_ +#define _OPENBEACON_H_ +#include + +void openbeaconSetup(uint32_t id, uint32_t ctr); +void openbeaconSendPacket(uint32_t id, uint32_t ctr, + uint8_t flags, uint8_t strength); +void openbeaconSend(void); + +#endif