Ad van der Weiden / neigbourhood

attempt to save recently used BT devices with their link keys in the BT dongle link key storage

Dependents:   ftusbClass

neighbourhood.h@0:6707543df242, 2011-06-19 (annotated)

Committer:
networker
Date:
Sun Jun 19 12:51:41 2011 +0000
Revision:
0:6707543df242
initial (untested)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
networker 0:6707543df242 1 #ifndef NEIGHBOURHOOD_H
networker 0:6707543df242 2 #define NEIGHBOURHOOD_H
networker 0:6707543df242 3
networker 0:6707543df242 4 #include <list>
networker 0:6707543df242 5 #include "hci.h"
networker 0:6707543df242 6
networker 0:6707543df242 7 //#define STRICT_MRU
networker 0:6707543df242 8
networker 0:6707543df242 9 /******************************************************************************************
networker 0:6707543df242 10 call 'read' as part of the startup
networker 0:6707543df242 11 on HCI_READ-STORED-LINK-KEY -COMPLETED event, call 'set_cap'
networker 0:6707543df242 12 on RETURN_LINK_KEYS_EVENT call 'add' for each key with init=true
networker 0:6707543df242 13 on LINK_KEY_NOTIFICATION_EVENT call 'add' with init=false (default)
networker 0:6707543df242 14 on LINK_KEY_REQUEST_EVENT call 'get' and send the proper reply
networker 0:6707543df242 15 call 'write' as part of shutdown
networker 0:6707543df242 16
networker 0:6707543df242 17 a simpler approach could be to check for a link if it exists (single read) and try to add it.
networker 0:6707543df242 18 when it fails just delete all.
networker 0:6707543df242 19 ********************************************************************************************/
networker 0:6707543df242 20
networker 0:6707543df242 21 #define HCI_DELETE_STORED_LINK_KEY 0x0C12
networker 0:6707543df242 22 #define HCI_WRITE_STORED_LINK_KEY 0x0C11
networker 0:6707543df242 23 #define HCI_READ_STORED_LINK_KEY 0x0C0D
networker 0:6707543df242 24
networker 0:6707543df242 25 void printf(const BD_ADDR* addr);
networker 0:6707543df242 26
networker 0:6707543df242 27 class neighbourhood {
networker 0:6707543df242 28 static const int lksize = 16;
networker 0:6707543df242 29 struct item {
networker 0:6707543df242 30 BD_ADDR a;
networker 0:6707543df242 31 unsigned char lk[lksize];
networker 0:6707543df242 32 bool used;
networker 0:6707543df242 33 item (BD_ADDR *ad, const unsigned char *k, bool d) {
networker 0:6707543df242 34 memcpy(&a, ad, sizeof(BD_ADDR));
networker 0:6707543df242 35 memcpy(lk, k, lksize);
networker 0:6707543df242 36 used=d;
networker 0:6707543df242 37 }
networker 0:6707543df242 38 };
networker 0:6707543df242 39 int cap, initsize, used;
networker 0:6707543df242 40 list<item> keys;
networker 0:6707543df242 41 bool dirty;
networker 0:6707543df242 42 HCI *hci;
networker 0:6707543df242 43 void delete_link_key(BD_ADDR *a) {
networker 0:6707543df242 44 unsigned char param[sizeof(BD_ADDR)+1];
networker 0:6707543df242 45 memcpy(param, a, sizeof(BD_ADDR));
networker 0:6707543df242 46 param[sizeof(BD_ADDR)] = 0;
networker 0:6707543df242 47 hci->SendCmd(HCI_DELETE_STORED_LINK_KEY, param, sizeof(param));
networker 0:6707543df242 48 }
networker 0:6707543df242 49 void write_link_keys(unsigned char param[]) {
networker 0:6707543df242 50 hci->SendCmd(HCI_WRITE_STORED_LINK_KEY, param, param[0]*(sizeof(BD_ADDR)+lksize)+1);
networker 0:6707543df242 51 }
networker 0:6707543df242 52 public:
networker 0:6707543df242 53 neighbourhood(HCI *h): hci(h) {
networker 0:6707543df242 54 dirty = false;
networker 0:6707543df242 55 used = 0;
networker 0:6707543df242 56 cap=0;
networker 0:6707543df242 57 initsize=0;
networker 0:6707543df242 58 }
networker 0:6707543df242 59 void read() {
networker 0:6707543df242 60 unsigned char param[sizeof(BD_ADDR)+1];
networker 0:6707543df242 61 memset(param, 0, sizeof(BD_ADDR));
networker 0:6707543df242 62 param[sizeof(BD_ADDR)] = 1;
networker 0:6707543df242 63 hci->SendCmd(HCI_READ_STORED_LINK_KEY, param, sizeof(param));
networker 0:6707543df242 64 }
networker 0:6707543df242 65 void write();
networker 0:6707543df242 66 void set_cap(int c, int s) {
networker 0:6707543df242 67 cap = c;
networker 0:6707543df242 68 initsize = s;
networker 0:6707543df242 69 printf("Neighbourhood: capacity=%d, used=%d\n", c, s);
networker 0:6707543df242 70 }
networker 0:6707543df242 71 int get(BD_ADDR *a, unsigned char *key);
networker 0:6707543df242 72 int add(BD_ADDR *a, const unsigned char *key, bool init=false);
networker 0:6707543df242 73 };
networker 0:6707543df242 74
networker 0:6707543df242 75 extern neighbourhood *neighbors;
networker 0:6707543df242 76
networker 0:6707543df242 77 #endif