jordan/rpi4-osdev
1
0
Fork 0
mirror of https://github.com/isometimes/rpi4-osdev synced 2024-11-24 11:10:40 +00:00
Code Issues Projects Releases Packages Wiki Activity

part8 no works with DEBUG=0 in fb.c, but Eddystone beacon in part7 does not

Browse source
This commit is contained in:
Adam Greenwood-Byrne 2021-02-14 20:32:02 +00:00
parent 58b073a8de
commit 6dd0ab424e
6 changed files with 197 additions and 272 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

195
part7-bluetooth/bt.c
View file

@ -1,8 +1,6 @@
#include "io.h" #include "io.h"
#include "fb.h" #include "fb.h"
volatile unsigned char *params = (unsigned char *)SAFE_ADDRESS;
// UART0 // UART0
enum { enum {
@ -91,9 +89,7 @@ enum {
LL_ADV_NONCONN_IND = 0x03 LL_ADV_NONCONN_IND = 0x03
}; };
unsigned char empty[] = {}; int hciCommandBytes(unsigned char *opcodebytes, volatile unsigned char *data, unsigned char length)
int hciCommandBytes(volatile unsigned char *opcodebytes, volatile unsigned char *data, unsigned char length)
{ {
unsigned char c=0; unsigned char c=0;
@ -139,11 +135,13 @@ int hciCommand(unsigned short ogf, unsigned short ocf, volatile unsigned char *d
} }
void bt_reset() { void bt_reset() {
volatile unsigned char empty[] = {};
if (hciCommand(OGF_HOST_CONTROL, COMMAND_RESET_CHIP, empty, 0)) uart_writeText("bt_reset() failed\n"); if (hciCommand(OGF_HOST_CONTROL, COMMAND_RESET_CHIP, empty, 0)) uart_writeText("bt_reset() failed\n");
} }
void bt_loadfirmware() void bt_loadfirmware()
{ {
volatile unsigned char empty[] = {};
if (hciCommand(OGF_VENDOR, COMMAND_LOAD_FIRMWARE, empty, 0)) uart_writeText("loadFirmware() failed\n"); if (hciCommand(OGF_VENDOR, COMMAND_LOAD_FIRMWARE, empty, 0)) uart_writeText("loadFirmware() failed\n");
extern unsigned char _binary_BCM4345C0_hcd_start[]; extern unsigned char _binary_BCM4345C0_hcd_start[];
@ -152,16 +150,22 @@ void bt_loadfirmware()
unsigned int c=0; unsigned int c=0;
unsigned int size = (long)&_binary_BCM4345C0_hcd_size; unsigned int size = (long)&_binary_BCM4345C0_hcd_size;
while (c < size) { unsigned char opcodebytes[2];
params[0] = _binary_BCM4345C0_hcd_start[c]; unsigned char length;
params[1] = _binary_BCM4345C0_hcd_start[c+1]; unsigned char *data = &(_binary_BCM4345C0_hcd_start[0]);
unsigned char length = _binary_BCM4345C0_hcd_start[c+2];
unsigned char *data = &(_binary_BCM4345C0_hcd_start[c+3]);
if (hciCommandBytes(params, data, length)) { while (c < size) {
opcodebytes[0] = *data;
opcodebytes[1] = *(data+1);
length = *(data+2);
data += 3;
if (hciCommandBytes(opcodebytes, data, length)) {
uart_writeText("Firmware data load failed\n"); uart_writeText("Firmware data load failed\n");
break; break;
} }
data += length;
c += 3 + length; c += 3 + length;
} }
@ -170,24 +174,14 @@ void bt_loadfirmware()
void bt_setbaud() void bt_setbaud()
{ {
params[0] = 0; volatile unsigned char command[6] = { 0, 0, 0x00, 0xc2, 0x01, 0x00 }; // little endian, 115200
params[1] = 0; if (hciCommand(OGF_VENDOR, COMMAND_SET_BAUD, command, 6)) uart_writeText("bt_setbaud() failed\n");
params[2] = 0x00;
params[3] = 0xc2;
params[4] = 0x01;
params[5] = 0x00; // little endian, 115200
if (hciCommand(OGF_VENDOR, COMMAND_SET_BAUD, params, 6)) uart_writeText("bt_setbaud() failed\n");
} }
void bt_setbdaddr() void bt_setbdaddr()
{ {
params[0] = 0xee; volatile unsigned char command[6] = { 0xee, 0xff, 0xc0, 0xee, 0xff, 0xc0 }; // reversed
params[1] = 0xff; if (hciCommand(OGF_VENDOR, COMMAND_SET_BDADDR, command, 6)) uart_writeText("bt_setbdaddr() failed\n");
params[2] = 0xc0;
params[3] = 0xee;
params[4] = 0xff;
params[5] = 0xc0; // reversed
if (hciCommand(OGF_VENDOR, COMMAND_SET_BDADDR, params, 6)) uart_writeText("bt_setbdaddr() failed\n");
} }
void bt_getbdaddr(unsigned char *bdaddr) { void bt_getbdaddr(unsigned char *bdaddr) {
@ -226,84 +220,72 @@ void sendACLsubscribe(unsigned int handle)
bt_writeByte(lo(channel)); bt_writeByte(lo(channel));
bt_writeByte(hi(channel)); bt_writeByte(hi(channel));
params[0] = 0x12; volatile unsigned char command[5] = { 0x12, 0x2b, 0x00, 0x01, 0x00 };
params[1] = 0x2b;
params[2] = 0x00;
params[3] = 0x01;
params[4] = 0x00;
unsigned int c=0; unsigned int c=0;
while (c++<data_length) bt_writeByte(params[c-1]); while (c++<data_length) bt_writeByte(command[c-1]);
} }
void setLEeventmask(unsigned char mask) void setLEeventmask(unsigned char mask)
{ {
params[0] = mask; volatile unsigned char command[8] = { 0 };
params[1] = 0; command[0] = mask;
params[2] = 0;
params[3] = 0; if (hciCommand(OGF_LE_CONTROL, 0x01, command, 8)) uart_writeText("setLEeventmask failed\n");
params[4] = 0;
params[5] = 0;
params[6] = 0;
params[7] = 0;
if (hciCommand(OGF_LE_CONTROL, 0x01, params, 8)) uart_writeText("setLEeventmask failed\n");
} }
void setLEscanenable(unsigned char state, unsigned char duplicates) { void setLEscanenable(unsigned char state, unsigned char duplicates) {
params[0] = state; volatile unsigned char command[2];
params[1] = duplicates; command[0] = state;
if (hciCommand(OGF_LE_CONTROL, 0x0c, params, 2)) uart_writeText(" setLEscanenable failed\n"); command[1] = duplicates;
if (hciCommand(OGF_LE_CONTROL, 0x0c, command, 2)) uart_writeText(" setLEscanenable failed\n");
} }
void setLEscanparameters(unsigned char type, unsigned char linterval, unsigned char hinterval, unsigned char lwindow, unsigned char hwindow, unsigned char own_address_type, unsigned char filter_policy) { void setLEscanparameters(unsigned char type, unsigned char linterval, unsigned char hinterval, unsigned char lwindow, unsigned char hwindow, unsigned char own_address_type, unsigned char filter_policy) {
params[0] = type; volatile unsigned char command[7];
params[1] = linterval; command[0] = type;
params[2] = hinterval; command[1] = linterval;
params[3] = lwindow; command[2] = hinterval;
params[4] = hwindow; command[3] = lwindow;
params[5] = own_address_type; command[4] = hwindow;
params[6] = filter_policy; command[5] = own_address_type;
if (hciCommand(OGF_LE_CONTROL, 0x0b, params, 7)) uart_writeText("setLEscanparameters failed\n"); command[6] = filter_policy;
if (hciCommand(OGF_LE_CONTROL, 0x0b, command, 7)) uart_writeText("setLEscanparameters failed\n");
} }
void setLEadvertenable(unsigned char state) { void setLEadvertenable(unsigned char state) {
params[0] = state; volatile unsigned char command[1];
if (hciCommand(OGF_LE_CONTROL, 0x0a, params, 1)) uart_writeText("setLEadvertenable failed\n"); command[0] = state;
if (hciCommand(OGF_LE_CONTROL, 0x0a, command, 1)) uart_writeText("setLEadvertenable failed\n");
} }
void setLEadvertparameters(unsigned char type, unsigned char linterval_min, unsigned char hinterval_min, unsigned char linterval_max, unsigned char hinterval_max, unsigned char own_address_type, unsigned char filter_policy) { void setLEadvertparameters(unsigned char type, unsigned char linterval_min, unsigned char hinterval_min, unsigned char linterval_max, unsigned char hinterval_max, unsigned char own_address_type, unsigned char filter_policy) {
params[0] = linterval_min; volatile unsigned char command[15] = { 0 };
params[1] = hinterval_min;
params[2] = linterval_max; command[0] = linterval_min;
params[3] = hinterval_max; command[1] = hinterval_min;
params[4] = type; command[2] = linterval_max;
params[5] = own_address_type; command[3] = hinterval_max;
params[6] = 0; command[4] = type;
params[7] = 0; command[5] = own_address_type;
params[8] = 0; command[13] = 0x07;
params[9] = 0; command[14] = filter_policy;
params[10] = 0;
params[11] = 0; if (hciCommand(OGF_LE_CONTROL, 0x06, command, 15)) uart_writeText("setLEadvertparameters failed\n");
params[12] = 0;
params[13] = 0x07;
params[14] = filter_policy;
if (hciCommand(OGF_LE_CONTROL, 0x06, params, 15)) uart_writeText("setLEadvertparameters failed\n");
} }
void setLEadvertdata() { void setLEadvertdata() {
params[0] = 0x19; volatile unsigned char command[32] = {
params[1] = 0x02; params[2] = 0x01; params[3] = 0x06; 0x19,
params[4] = 0x03; params[5] = 0x03; params[6] = 0xAA; params[7] = 0xFE; 0x02, 0x01, 0x06,
params[8] = 0x11; params[9] = 0x16; params[10] = 0xAA; params[11] = 0xFE; params[12] = 0x10; params[13] = 0x00; params[14] = 0x03; 0x03, 0x03, 0xAA, 0xFE,
params[15] = 0x69; params[16] = 0x73; params[17] = 0x6f; params[18] = 0x6d; params[19] = 0x65; params[20] = 0x74; params[21] = 0x69; params[22] = 0x6d; 0x11, 0x16, 0xAA, 0xFE, 0x10, 0x00, 0x03,
params[23] = 0x2e; params[24] = 0x65; params[25] = 0x73; 0x69, 0x73, 0x6f, 0x6d, 0x65, 0x74, 0x69, 0x6d,
params[26] = 0x00; 0x2e, 0x65, 0x73,
params[27] = 0x00; 0, 0, 0, 0, 0, 0
params[28] = 0x00; };
params[29] = 0x00;
params[30] = 0x00; if (hciCommand(OGF_LE_CONTROL, 0x08, command, 32)) uart_writeText("setLEadvertdata failed\n");
params[31] = 0x00;
if (hciCommand(OGF_LE_CONTROL, 0x08, params, 32)) uart_writeText("setLEadvertdata failed\n");
} }
void stopScanning() { void stopScanning() {
@ -350,44 +332,25 @@ void connect(unsigned char *addr)
float BleGranularity = 1.25; float BleGranularity = 1.25;
unsigned int p = BleScanInterval / BleScanDivisor; unsigned int p = BleScanInterval / BleScanDivisor;
unsigned char lp = lo(p);
unsigned char hp = hi(p);
unsigned int q = BleScanWindow / BleScanDivisor; unsigned int q = BleScanWindow / BleScanDivisor;
unsigned char lq = lo(q);
unsigned char hq = hi(q);
unsigned int min_interval = connMinFreq / BleGranularity; unsigned int min_interval = connMinFreq / BleGranularity;
unsigned char lmini = lo(min_interval);
unsigned char hmini = hi(min_interval);
unsigned int max_interval = connMaxFreq / BleGranularity; unsigned int max_interval = connMaxFreq / BleGranularity;
unsigned char lmaxi = lo(max_interval);
unsigned char hmaxi = hi(max_interval);
params[0] = lp; volatile unsigned char command[25] = { 0 };
params[1] = hp;
params[2] = lq;
params[3] = hq;
params[4] = 0;
params[5] = 0;
params[6] = addr[5];
params[7] = addr[4];
params[8] = addr[3];
params[9] = addr[2];
params[10] = addr[1];
params[11] = addr[0];
params[12] = 0;
params[13] = lmini;
params[14] = hmini;
params[15] = lmaxi;
params[16] = hmaxi;
params[17] = 0;
params[18] = 0;
params[19] = 0x2a;
params[20] = 0x00;
params[21] = 0;
params[22] = 0;
params[23] = 0;
params[24] = 0;
if (hciCommand(OGF_LE_CONTROL, 0x0d, params, 25)) uart_writeText("createLEconnection failed\n"); command[0] = lo(p);
command[2] = lo(q);
command[6] = *(addr+5);
command[7] = *(addr+4);
command[8] = *(addr+3);
command[9] = *(addr+2);
command[10] = *(addr+1);
command[11] = *addr;
command[13] = lo(min_interval);
command[15] = lo(max_interval);
command[19] = 0x2a;
command[20] = 0x00;
if (hciCommand(OGF_LE_CONTROL, 0x0d, command, 25)) uart_writeText("createLEconnection failed\n");
} }

25
part7-bluetooth/kernel.c
View file

@ -136,13 +136,13 @@ void bt_conn()
unsigned char *buf; unsigned char *buf;
while ( (buf = hci_poll()) ) { while ( (buf = hci_poll()) ) {
if (data_len >= 2) { if (!connected && data_len >= 2 && buf[0] == LE_CONNECT_CODE) {
if (buf[0] == LE_CONNECT_CODE && !connected) { connected = !*(buf+1);
connected = !buf[1];
debughex(connected); debugstr(" "); debughex(connected); debugstr(" ");
connection_handle = buf[2] | (buf[3] << 8); connection_handle = *(buf+2) | (*(buf+3) << 8);
debughex(connection_handle); debugstr(" "); debughex(connection_handle); debugstr(" ");
}
if (connection_handle == 0) wait_msec(0x186A);
} }
} }
} }
@ -157,13 +157,14 @@ void acl_poll()
unsigned char length = bt_waitReadByte(); unsigned char length = bt_waitReadByte();
for (int i=0;i<length;i++) bt_waitReadByte(); for (int i=0;i<length;i++) bt_waitReadByte();
} else if (byte == HCI_ACL_PKT) { } else if (byte == HCI_ACL_PKT) {
bt_waitReadByte(); // handle1 unsigned char h1 = bt_waitReadByte(); // handle1
bt_waitReadByte(); // handle2 unsigned char h2 = bt_waitReadByte(); // handle2
unsigned char thandle = h1 | (h2 << 8);
unsigned char h1 = bt_waitReadByte(); unsigned char d1 = bt_waitReadByte();
unsigned char h2 = bt_waitReadByte(); unsigned char d2 = bt_waitReadByte();
unsigned int dlen = h1 | (h2 << 8); unsigned int dlen = d1 | (d2 << 8);
unsigned char data[dlen]; unsigned char data[dlen];
if (dlen > 7) { if (dlen > 7) {
@ -173,7 +174,7 @@ void acl_poll()
unsigned int channel = data[2] | (data[3] << 8); unsigned int channel = data[2] | (data[3] << 8);
unsigned char opcode = data[4]; unsigned char opcode = data[4];
if (length == 4 && opcode == 0x1b) { if (thandle == connection_handle && length == 4 && opcode == 0x1b) {
if (channel == 4 && data[5] == 0x2a && data[6] == 0x00) { if (channel == 4 && data[5] == 0x2a && data[6] == 0x00) {
debugcrlf(); debugcrlf();
debugstr("Got ACL packet... "); debugstr("Got ACL packet... ");
@ -224,7 +225,7 @@ void run_eddystone(void) {
// Start advertising // Start advertising
debugstr("Setting event mask... "); debugstr("Setting event mask... ");
setLEeventmask(0xff); setLEeventmask(0xff);
debugstr("Starting advertsing... "); debugstr("Starting advertising... ");
startActiveAdvertising(); startActiveAdvertising();
// Enter an infinite loop // Enter an infinite loop

196
part8-breakout-ble/bt.c
View file

@ -1,8 +1,6 @@
#include "io.h" #include "io.h"
#include "fb.h" #include "fb.h"
volatile unsigned char *params = (unsigned char *)SAFE_ADDRESS;
// UART0 // UART0
enum { enum {
@ -91,9 +89,7 @@ enum {
LL_ADV_NONCONN_IND = 0x03 LL_ADV_NONCONN_IND = 0x03
}; };
unsigned char empty[] = {}; int hciCommandBytes(unsigned char *opcodebytes, volatile unsigned char *data, unsigned char length)
int hciCommandBytes(volatile unsigned char *opcodebytes, volatile unsigned char *data, unsigned char length)
{ {
unsigned char c=0; unsigned char c=0;
@ -139,11 +135,13 @@ int hciCommand(unsigned short ogf, unsigned short ocf, volatile unsigned char *d
} }
void bt_reset() { void bt_reset() {
volatile unsigned char empty[] = {};
if (hciCommand(OGF_HOST_CONTROL, COMMAND_RESET_CHIP, empty, 0)) uart_writeText("bt_reset() failed\n"); if (hciCommand(OGF_HOST_CONTROL, COMMAND_RESET_CHIP, empty, 0)) uart_writeText("bt_reset() failed\n");
} }
void bt_loadfirmware() void bt_loadfirmware()
{ {
volatile unsigned char empty[] = {};
if (hciCommand(OGF_VENDOR, COMMAND_LOAD_FIRMWARE, empty, 0)) uart_writeText("loadFirmware() failed\n"); if (hciCommand(OGF_VENDOR, COMMAND_LOAD_FIRMWARE, empty, 0)) uart_writeText("loadFirmware() failed\n");
extern unsigned char _binary_BCM4345C0_hcd_start[]; extern unsigned char _binary_BCM4345C0_hcd_start[];
@ -152,16 +150,22 @@ void bt_loadfirmware()
unsigned int c=0; unsigned int c=0;
unsigned int size = (long)&_binary_BCM4345C0_hcd_size; unsigned int size = (long)&_binary_BCM4345C0_hcd_size;
while (c < size) { unsigned char opcodebytes[2];
params[0] = _binary_BCM4345C0_hcd_start[c]; unsigned char length;
params[1] = _binary_BCM4345C0_hcd_start[c+1]; unsigned char *data = &(_binary_BCM4345C0_hcd_start[0]);
unsigned char length = _binary_BCM4345C0_hcd_start[c+2];
unsigned char *data = &(_binary_BCM4345C0_hcd_start[c+3]);
if (hciCommandBytes(params, data, length)) { while (c < size) {
opcodebytes[0] = *data;
opcodebytes[1] = *(data+1);
length = *(data+2);
data += 3;
if (hciCommandBytes(opcodebytes, data, length)) {
uart_writeText("Firmware data load failed\n"); uart_writeText("Firmware data load failed\n");
break; break;
} }
data += length;
c += 3 + length; c += 3 + length;
} }
@ -170,24 +174,14 @@ void bt_loadfirmware()
void bt_setbaud() void bt_setbaud()
{ {
params[0] = 0; volatile unsigned char command[6] = { 0, 0, 0x00, 0xc2, 0x01, 0x00 }; // little endian, 115200
params[1] = 0; if (hciCommand(OGF_VENDOR, COMMAND_SET_BAUD, command, 6)) uart_writeText("bt_setbaud() failed\n");
params[2] = 0x00;
params[3] = 0xc2;
params[4] = 0x01;
params[5] = 0x00; // little endian, 115200
if (hciCommand(OGF_VENDOR, COMMAND_SET_BAUD, params, 6)) uart_writeText("bt_setbaud() failed\n");
} }
void bt_setbdaddr() void bt_setbdaddr()
{ {
params[0] = 0xee; volatile unsigned char command[6] = { 0xee, 0xff, 0xc0, 0xee, 0xff, 0xc0 }; // reversed
params[1] = 0xff; if (hciCommand(OGF_VENDOR, COMMAND_SET_BDADDR, command, 6)) uart_writeText("bt_setbdaddr() failed\n");
params[2] = 0xc0;
params[3] = 0xee;
params[4] = 0xff;
params[5] = 0xc0; // reversed
if (hciCommand(OGF_VENDOR, COMMAND_SET_BDADDR, params, 6)) uart_writeText("bt_setbdaddr() failed\n");
} }
void bt_getbdaddr(unsigned char *bdaddr) { void bt_getbdaddr(unsigned char *bdaddr) {
@ -226,85 +220,72 @@ void sendACLsubscribe(unsigned int handle)
bt_writeByte(lo(channel)); bt_writeByte(lo(channel));
bt_writeByte(hi(channel)); bt_writeByte(hi(channel));
params[0] = 0x12; volatile unsigned char command[5] = { 0x12, 0x2b, 0x00, 0x01, 0x00 };
params[1] = 0x2b;
params[2] = 0x00;
params[3] = 0x01;
params[4] = 0x00;
unsigned int c=0; unsigned int c=0;
while (c++<data_length) bt_writeByte(command[c-1]);
while (c++<data_length) bt_writeByte(params[c-1]);
} }
void setLEeventmask(unsigned char mask) void setLEeventmask(unsigned char mask)
{ {
params[0] = mask; volatile unsigned char command[8] = { 0 };
params[1] = 0; command[0] = mask;
params[2] = 0;
params[3] = 0; if (hciCommand(OGF_LE_CONTROL, 0x01, command, 8)) uart_writeText("setLEeventmask failed\n");
params[4] = 0;
params[5] = 0;
params[6] = 0;
params[7] = 0;
if (hciCommand(OGF_LE_CONTROL, 0x01, params, 8)) uart_writeText("setLEeventmask failed\n");
} }
void setLEscanenable(unsigned char state, unsigned char duplicates) { void setLEscanenable(unsigned char state, unsigned char duplicates) {
params[0] = state; volatile unsigned char command[2];
params[1] = duplicates; command[0] = state;
if (hciCommand(OGF_LE_CONTROL, 0x0c, params, 2)) uart_writeText(" setLEscanenable failed\n"); command[1] = duplicates;
if (hciCommand(OGF_LE_CONTROL, 0x0c, command, 2)) uart_writeText(" setLEscanenable failed\n");
} }
void setLEscanparameters(unsigned char type, unsigned char linterval, unsigned char hinterval, unsigned char lwindow, unsigned char hwindow, unsigned char own_address_type, unsigned char filter_policy) { void setLEscanparameters(unsigned char type, unsigned char linterval, unsigned char hinterval, unsigned char lwindow, unsigned char hwindow, unsigned char own_address_type, unsigned char filter_policy) {
params[0] = type; volatile unsigned char command[7];
params[1] = linterval; command[0] = type;
params[2] = hinterval; command[1] = linterval;
params[3] = lwindow; command[2] = hinterval;
params[4] = hwindow; command[3] = lwindow;
params[5] = own_address_type; command[4] = hwindow;
params[6] = filter_policy; command[5] = own_address_type;
if (hciCommand(OGF_LE_CONTROL, 0x0b, params, 7)) uart_writeText("setLEscanparameters failed\n"); command[6] = filter_policy;
if (hciCommand(OGF_LE_CONTROL, 0x0b, command, 7)) uart_writeText("setLEscanparameters failed\n");
} }
void setLEadvertenable(unsigned char state) { void setLEadvertenable(unsigned char state) {
params[0] = state; volatile unsigned char command[1];
if (hciCommand(OGF_LE_CONTROL, 0x0a, params, 1)) uart_writeText("setLEadvertenable failed\n"); command[0] = state;
if (hciCommand(OGF_LE_CONTROL, 0x0a, command, 1)) uart_writeText("setLEadvertenable failed\n");
} }
void setLEadvertparameters(unsigned char type, unsigned char linterval_min, unsigned char hinterval_min, unsigned char linterval_max, unsigned char hinterval_max, unsigned char own_address_type, unsigned char filter_policy) { void setLEadvertparameters(unsigned char type, unsigned char linterval_min, unsigned char hinterval_min, unsigned char linterval_max, unsigned char hinterval_max, unsigned char own_address_type, unsigned char filter_policy) {
params[0] = linterval_min; volatile unsigned char command[15] = { 0 };
params[1] = hinterval_min;
params[2] = linterval_max; command[0] = linterval_min;
params[3] = hinterval_max; command[1] = hinterval_min;
params[4] = type; command[2] = linterval_max;
params[5] = own_address_type; command[3] = hinterval_max;
params[6] = 0; command[4] = type;
params[7] = 0; command[5] = own_address_type;
params[8] = 0; command[13] = 0x07;
params[9] = 0; command[14] = filter_policy;
params[10] = 0;
params[11] = 0; if (hciCommand(OGF_LE_CONTROL, 0x06, command, 15)) uart_writeText("setLEadvertparameters failed\n");
params[12] = 0;
params[13] = 0x07;
params[14] = filter_policy;
if (hciCommand(OGF_LE_CONTROL, 0x06, params, 15)) uart_writeText("setLEadvertparameters failed\n");
} }
void setLEadvertdata() { void setLEadvertdata() {
params[0] = 0x19; volatile unsigned char command[32] = {
params[1] = 0x02; params[2] = 0x01; params[3] = 0x06; 0x19,
params[4] = 0x03; params[5] = 0x03; params[6] = 0xAA; params[7] = 0xFE; 0x02, 0x01, 0x06,
params[8] = 0x11; params[9] = 0x16; params[10] = 0xAA; params[11] = 0xFE; params[12] = 0x10; params[13] = 0x00; params[14] = 0x03; 0x03, 0x03, 0xAA, 0xFE,
params[15] = 0x69; params[16] = 0x73; params[17] = 0x6f; params[18] = 0x6d; params[19] = 0x65; params[20] = 0x74; params[21] = 0x69; params[22] = 0x6d; 0x11, 0x16, 0xAA, 0xFE, 0x10, 0x00, 0x03,
params[23] = 0x2e; params[24] = 0x65; params[25] = 0x73; 0x69, 0x73, 0x6f, 0x6d, 0x65, 0x74, 0x69, 0x6d,
params[26] = 0x00; 0x2e, 0x65, 0x73,
params[27] = 0x00; 0, 0, 0, 0, 0, 0
params[28] = 0x00; };
params[29] = 0x00;
params[30] = 0x00; if (hciCommand(OGF_LE_CONTROL, 0x08, command, 32)) uart_writeText("setLEadvertdata failed\n");
params[31] = 0x00;
if (hciCommand(OGF_LE_CONTROL, 0x08, params, 32)) uart_writeText("setLEadvertdata failed\n");
} }
void stopScanning() { void stopScanning() {
@ -351,44 +332,25 @@ void connect(unsigned char *addr)
float BleGranularity = 1.25; float BleGranularity = 1.25;
unsigned int p = BleScanInterval / BleScanDivisor; unsigned int p = BleScanInterval / BleScanDivisor;
unsigned char lp = lo(p);
unsigned char hp = hi(p);
unsigned int q = BleScanWindow / BleScanDivisor; unsigned int q = BleScanWindow / BleScanDivisor;
unsigned char lq = lo(q);
unsigned char hq = hi(q);
unsigned int min_interval = connMinFreq / BleGranularity; unsigned int min_interval = connMinFreq / BleGranularity;
unsigned char lmini = lo(min_interval);
unsigned char hmini = hi(min_interval);
unsigned int max_interval = connMaxFreq / BleGranularity; unsigned int max_interval = connMaxFreq / BleGranularity;
unsigned char lmaxi = lo(max_interval);
unsigned char hmaxi = hi(max_interval);
params[0] = lp; volatile unsigned char command[25] = { 0 };
params[1] = hp;
params[2] = lq;
params[3] = hq;
params[4] = 0;
params[5] = 0;
params[6] = addr[5];
params[7] = addr[4];
params[8] = addr[3];
params[9] = addr[2];
params[10] = addr[1];
params[11] = addr[0];
params[12] = 0;
params[13] = lmini;
params[14] = hmini;
params[15] = lmaxi;
params[16] = hmaxi;
params[17] = 0;
params[18] = 0;
params[19] = 0x2a;
params[20] = 0x00;
params[21] = 0;
params[22] = 0;
params[23] = 0;
params[24] = 0;
if (hciCommand(OGF_LE_CONTROL, 0x0d, params, 25)) uart_writeText("createLEconnection failed\n"); command[0] = lo(p);
command[2] = lo(q);
command[6] = *(addr+5);
command[7] = *(addr+4);
command[8] = *(addr+3);
command[9] = *(addr+2);
command[10] = *(addr+1);
command[11] = *addr;
command[13] = lo(min_interval);
command[15] = lo(max_interval);
command[19] = 0x2a;
command[20] = 0x00;
if (hciCommand(OGF_LE_CONTROL, 0x0d, command, 25)) uart_writeText("createLEconnection failed\n");
} }

2
part8-breakout-ble/fb.c
View file

@ -2,7 +2,7 @@
#include "mb.h" #include "mb.h"
#include "terminal.h" #include "terminal.h"
#define DEBUG 1 #define DEBUG 0
unsigned int width, height, pitch, isrgb; unsigned int width, height, pitch, isrgb;
unsigned char *fb; unsigned char *fb;

33
part8-breakout-ble/kernel.c
View file

@ -138,13 +138,13 @@ void bt_conn()
unsigned char *buf; unsigned char *buf;
while ( (buf = hci_poll()) ) { while ( (buf = hci_poll()) ) {
if (data_len >= 2) { if (!connected && data_len >= 2 && buf[0] == LE_CONNECT_CODE) {
if (buf[0] == LE_CONNECT_CODE && !connected) { connected = !*(buf+1);
connected = !buf[1];
debughex(connected); debugstr(" "); debughex(connected); debugstr(" ");
connection_handle = buf[2] | (buf[3] << 8); connection_handle = *(buf+2) | (*(buf+3) << 8);
debughex(connection_handle); debugstr(" "); debughex(connection_handle); debugstr(" ");
}
if (connection_handle == 0) wait_msec(0x186A);
} }
} }
} }
@ -182,13 +182,11 @@ enum {
OBJ_BALL = 3 OBJ_BALL = 3
}; };
#define OBJS_ADDRESS 0x02200000 // Somewhere safe to store a lot of data
unsigned int numobjs = 0; unsigned int numobjs = 0;
struct Object *objects = (struct Object *)OBJS_ADDRESS; struct Object *objects = (struct Object *)SAFE_ADDRESS;
struct Object *ball; struct Object *ball;
struct Object *paddle; struct Object *paddle;
int paddlewidth = 80; const int paddlewidth = 80;
void removeObject(struct Object *object) void removeObject(struct Object *object)
{ {
@ -227,7 +225,7 @@ void initBricks()
int brickwidth = 32; int brickwidth = 32;
int brickheight = 8; int brickheight = 8;
int brickspacer = 20; int brickspacer = 20;
static int brickcols[] = { 0x11, 0x22, 0xEE, 0x44, 0x66 }; const int brickcols[] = { 0x11, 0x22, 0xEE, 0x44, 0x66 };
int ybrick = MARGIN + brickheight; int ybrick = MARGIN + brickheight;
@ -305,13 +303,14 @@ void acl_poll()
unsigned char length = bt_readByte(); unsigned char length = bt_readByte();
for (int i=0;i<length;i++) bt_readByte(); for (int i=0;i<length;i++) bt_readByte();
} else if (byte == HCI_ACL_PKT) { } else if (byte == HCI_ACL_PKT) {
bt_readByte(); // handle1 unsigned char h1 = bt_readByte(); // handle1
bt_readByte(); // handle2 unsigned char h2 = bt_readByte(); // handle2
unsigned char thandle = h1 | (h2 << 8);
unsigned char h1 = bt_readByte(); unsigned char d1 = bt_readByte();
unsigned char h2 = bt_readByte(); unsigned char d2 = bt_readByte();
unsigned int dlen = h1 | (h2 << 8); unsigned int dlen = d1 | (d2 << 8);
unsigned char data[dlen]; unsigned char data[dlen];
if (dlen > 7) { if (dlen > 7) {
@ -321,7 +320,7 @@ void acl_poll()
unsigned int channel = data[2] | (data[3] << 8); unsigned int channel = data[2] | (data[3] << 8);
unsigned char opcode = data[4]; unsigned char opcode = data[4];
if (length == 4 && opcode == 0x1b) { if (thandle == connection_handle && length == 4 && opcode == 0x1b) {
if (channel == 4 && data[5] == 0x2a && data[6] == 0x00) { if (channel == 4 && data[5] == 0x2a && data[6] == 0x00) {
dir = data[7]; dir = data[7];
moveObjectAbs(paddle, MARGIN + (dir * ((VIRTWIDTH - paddlewidth + MARGIN)/100)), paddle->y); moveObjectAbs(paddle, MARGIN + (dir * ((VIRTWIDTH - paddlewidth + MARGIN)/100)), paddle->y);
@ -442,7 +441,7 @@ void main()
// Connecting to echo // Connecting to echo
debugstr("Connecting to echo: "); debugstr("Connecting to echo: ");
connect(echo_addr); connect(echo_addr);
while (!connected) bt_conn(); while (!(connected && connection_handle)) bt_conn();
debugstr("Connected!"); debugstr("Connected!");
debugcrlf(); debugcrlf();

4
part8-breakout-ble/terminal.h
View file

@ -1,4 +1,4 @@
unsigned int vgapal[] = { const unsigned int vgapal[16] = {
0x000000, 0x000000,
0x0000AA, 0x0000AA,
0x00AA00, 0x00AA00,
@ -25,7 +25,7 @@ enum {
FONT_NUMGLYPHS = 224 FONT_NUMGLYPHS = 224
}; };
unsigned char font[FONT_NUMGLYPHS][FONT_BPG] = { const unsigned char font[FONT_NUMGLYPHS][FONT_BPG] = {
{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0000 (nul) { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0000 (nul)
{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0001 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0001
{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0002 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, // U+0002