2020-07-23 19:37:48 +00:00
|
|
|
#include "io.h"
|
|
|
|
#include "bt.h"
|
2021-02-07 22:04:44 +00:00
|
|
|
#include "fb.h"
|
|
|
|
|
|
|
|
int curx = 0;
|
|
|
|
int cury = 0;
|
|
|
|
|
|
|
|
int strlen(const char *str) {
|
|
|
|
const char *s;
|
|
|
|
|
|
|
|
for (s = str; *s; ++s);
|
|
|
|
return (s - str);
|
|
|
|
}
|
|
|
|
|
|
|
|
void debugstr(char *str) {
|
|
|
|
if (curx + (strlen(str) * 8) >= 1920) {
|
|
|
|
curx = 0; cury += 8;
|
|
|
|
}
|
|
|
|
drawString(curx, cury, str, 0x0f, 1);
|
|
|
|
curx += (strlen(str) * 8);
|
|
|
|
}
|
|
|
|
|
|
|
|
void debugcrlf(void) {
|
|
|
|
curx = 0; cury += 8;
|
|
|
|
}
|
|
|
|
|
|
|
|
void debugch(unsigned char b) {
|
|
|
|
unsigned int n;
|
|
|
|
int c;
|
|
|
|
for(c=4;c>=0;c-=4) {
|
|
|
|
n=(b>>c)&0xF;
|
|
|
|
n+=n>9?0x37:0x30;
|
|
|
|
debugstr((char *)&n);
|
|
|
|
}
|
|
|
|
debugstr(" ");
|
|
|
|
}
|
2020-08-10 19:20:13 +00:00
|
|
|
|
2020-07-23 19:37:48 +00:00
|
|
|
void main()
|
|
|
|
{
|
2021-02-07 22:04:44 +00:00
|
|
|
fb_init();
|
2020-07-23 19:37:48 +00:00
|
|
|
uart_init();
|
|
|
|
bt_init();
|
|
|
|
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr("Initialising Bluetooth: ");
|
|
|
|
debugstr(">> reset: ");
|
2020-07-26 18:28:44 +00:00
|
|
|
bt_reset();
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr(">> firmware load: ");
|
2020-07-26 18:28:44 +00:00
|
|
|
bt_loadfirmware();
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr(">> set baud: ");
|
2020-08-05 20:30:54 +00:00
|
|
|
bt_setbaud();
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr(">> set bdaddr: ");
|
2020-08-05 20:30:54 +00:00
|
|
|
bt_setbdaddr();
|
|
|
|
|
2020-08-10 19:20:13 +00:00
|
|
|
// Print the BD_ADDR
|
2020-08-05 20:30:54 +00:00
|
|
|
unsigned char local_addr[6];
|
|
|
|
bt_getbdaddr(local_addr);
|
2021-02-07 22:04:44 +00:00
|
|
|
for (int c=5;c>=0;c--) debugch(local_addr[c]);
|
|
|
|
debugcrlf();
|
2020-08-05 20:30:54 +00:00
|
|
|
|
2021-02-07 19:18:44 +00:00
|
|
|
// Start advertising
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr("Setting event mask... ");
|
2020-08-06 09:53:58 +00:00
|
|
|
setLEeventmask(0xff);
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr("Starting advertsing... ");
|
2021-02-07 19:18:44 +00:00
|
|
|
startActiveAdvertising();
|
2020-08-10 19:20:13 +00:00
|
|
|
|
2021-02-07 19:18:44 +00:00
|
|
|
// Enter an infinite loop
|
2021-02-07 22:04:44 +00:00
|
|
|
debugstr("Going loopy...");
|
2020-08-11 15:16:18 +00:00
|
|
|
while (1) {
|
|
|
|
uart_update();
|
|
|
|
}
|
2020-07-23 19:37:48 +00:00
|
|
|
}
|