Seeed / Mbed 2 deprecated xadow_smartstrap_for_pebble

the firmware for xadow smartstrap for pebble

Dependencies:   BufferedSerial USBDevice XadowGPS XadowNFC mbed mbedPebbleSerial IAP

main.cpp@0:5a372b5a35bb, 2015-11-04 (annotated)

Committer:
KillingJacky
Date:
Wed Nov 04 10:02:24 2015 +0000
Revision:
0:5a372b5a35bb
Child:
1:8d2e8f504ba3
init commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
KillingJacky 0:5a372b5a35bb 1 #include "mbed.h"
KillingJacky 0:5a372b5a35bb 2 #include "USBSerial.h"
KillingJacky 0:5a372b5a35bb 3 #include "BufferedSerial.h"
KillingJacky 0:5a372b5a35bb 4 #include "XadowGPS.h"
KillingJacky 0:5a372b5a35bb 5 #include "XadowNFC.h"
KillingJacky 0:5a372b5a35bb 6 #include "mbedPebbleSerial.h"
KillingJacky 0:5a372b5a35bb 7
KillingJacky 0:5a372b5a35bb 8 #define max(a,b) (((a) > (b)) ? (a) : (b))
KillingJacky 0:5a372b5a35bb 9 #define min(a,b) (((a) < (b)) ? (a) : (b))
KillingJacky 0:5a372b5a35bb 10
KillingJacky 0:5a372b5a35bb 11 #define SERVICE_BAT 0x2003
KillingJacky 0:5a372b5a35bb 12 #define ATTR_BAT_V 0x1001
KillingJacky 0:5a372b5a35bb 13 #define ATTR_BAT_CHG 0x1002
KillingJacky 0:5a372b5a35bb 14
KillingJacky 0:5a372b5a35bb 15 #define SERVICE_GPS 0x2001 //SPEC
KillingJacky 0:5a372b5a35bb 16 #define ATTR_GPS_LOCATION 0x0001 //SPEC
KillingJacky 0:5a372b5a35bb 17 #define ATTR_GPS_SPEED 0x0003 //spec
KillingJacky 0:5a372b5a35bb 18 #define ATTR_GPS_ALTITUDE 0x1001
KillingJacky 0:5a372b5a35bb 19 #define ATTR_GPS_FIX_QUALITY 0x0102 //SPEC
KillingJacky 0:5a372b5a35bb 20 #define ATTR_GPS_SATELLITES 0x0101 //spec
KillingJacky 0:5a372b5a35bb 21
KillingJacky 0:5a372b5a35bb 22 #define SERVICE_NFC 0x1E01 //NFC is not in spec now, we chose id from experimentation range
KillingJacky 0:5a372b5a35bb 23 #define ATTR_NFC_GET_UID 0x1001
KillingJacky 0:5a372b5a35bb 24 #define ATTR_NFC_READ_NDEF 0x1002
KillingJacky 0:5a372b5a35bb 25 #define ATTR_NFC_WRITE_NDEF 0x1003
KillingJacky 0:5a372b5a35bb 26 #define ATTR_NFC_ERASE_NDEF 0x1004
KillingJacky 0:5a372b5a35bb 27 #define ATTR_NFC_EMULATE_A_TAG 0x1005
KillingJacky 0:5a372b5a35bb 28
KillingJacky 0:5a372b5a35bb 29
KillingJacky 0:5a372b5a35bb 30 static uint16_t SUPPORTED_SERVICES[20] = {0};
KillingJacky 0:5a372b5a35bb 31 #define BUFFER_SIZE 200
KillingJacky 0:5a372b5a35bb 32 static uint8_t s_pebble_buffer[GET_PAYLOAD_BUFFER_SIZE(BUFFER_SIZE)];
KillingJacky 0:5a372b5a35bb 33
KillingJacky 0:5a372b5a35bb 34 DigitalOut pin_chg_led_on(P0_2);
KillingJacky 0:5a372b5a35bb 35 DigitalOut pin_5v_en(P1_19);
KillingJacky 0:5a372b5a35bb 36 AnalogIn ain(P0_11);
KillingJacky 0:5a372b5a35bb 37
KillingJacky 0:5a372b5a35bb 38 USBSerial dbg_serial;
KillingJacky 0:5a372b5a35bb 39 BufferedSerial serial(P0_19, P0_18); //(tx,rx)
KillingJacky 0:5a372b5a35bb 40
KillingJacky 0:5a372b5a35bb 41 I2C i2c(P0_5, P0_4);
KillingJacky 0:5a372b5a35bb 42
KillingJacky 0:5a372b5a35bb 43 Timer timer;
KillingJacky 0:5a372b5a35bb 44
KillingJacky 0:5a372b5a35bb 45 static uint8_t last_tagid[10] = {0};
KillingJacky 0:5a372b5a35bb 46 static uint8_t last_tagid_len = 0;
KillingJacky 0:5a372b5a35bb 47
KillingJacky 0:5a372b5a35bb 48
KillingJacky 0:5a372b5a35bb 49 float get_vbat()
KillingJacky 0:5a372b5a35bb 50 {
KillingJacky 0:5a372b5a35bb 51 return 3.3f*ain*2.25;
KillingJacky 0:5a372b5a35bb 52 }
KillingJacky 0:5a372b5a35bb 53
KillingJacky 0:5a372b5a35bb 54 int main()
KillingJacky 0:5a372b5a35bb 55 {
KillingJacky 0:5a372b5a35bb 56 /* init io */
KillingJacky 0:5a372b5a35bb 57 pin_chg_led_on = 0; //pull low to enable charge led
KillingJacky 0:5a372b5a35bb 58 pin_5v_en = 1; //pull high to enable battery to charge pebble
KillingJacky 0:5a372b5a35bb 59
KillingJacky 0:5a372b5a35bb 60 /* init uart */
KillingJacky 0:5a372b5a35bb 61 serial.baud(9600);
KillingJacky 0:5a372b5a35bb 62
KillingJacky 0:5a372b5a35bb 63 wait(1);
KillingJacky 0:5a372b5a35bb 64 dbg_serial.printf("Detecting connected device...\r\n");
KillingJacky 0:5a372b5a35bb 65
KillingJacky 0:5a372b5a35bb 66 int i = 0;
KillingJacky 0:5a372b5a35bb 67
KillingJacky 0:5a372b5a35bb 68 /* Raw data service */
KillingJacky 0:5a372b5a35bb 69 SUPPORTED_SERVICES[i++] = 0x0000;
KillingJacky 0:5a372b5a35bb 70
KillingJacky 0:5a372b5a35bb 71 /* battery service */
KillingJacky 0:5a372b5a35bb 72 SUPPORTED_SERVICES[i++] = SERVICE_BAT;
KillingJacky 0:5a372b5a35bb 73
KillingJacky 0:5a372b5a35bb 74 /* GPS service */
KillingJacky 0:5a372b5a35bb 75 dbg_serial.printf("CHK_GPS\r\n");
KillingJacky 0:5a372b5a35bb 76 uint8_t gps_online = gps_check_online();
KillingJacky 0:5a372b5a35bb 77 dbg_serial.printf("gps online: %d\r\n", gps_online);
KillingJacky 0:5a372b5a35bb 78 if (gps_online)
KillingJacky 0:5a372b5a35bb 79 {
KillingJacky 0:5a372b5a35bb 80 SUPPORTED_SERVICES[i++] = SERVICE_GPS;
KillingJacky 0:5a372b5a35bb 81 }
KillingJacky 0:5a372b5a35bb 82
KillingJacky 0:5a372b5a35bb 83 /* NFC Service*/
KillingJacky 0:5a372b5a35bb 84 dbg_serial.printf("CHK_NFC\r\n");
KillingJacky 0:5a372b5a35bb 85 uint8_t nfc_online = nfc_check_online();
KillingJacky 0:5a372b5a35bb 86 dbg_serial.printf("nfc online: %d\r\n", nfc_online);
KillingJacky 0:5a372b5a35bb 87 if (nfc_online)
KillingJacky 0:5a372b5a35bb 88 {
KillingJacky 0:5a372b5a35bb 89 SUPPORTED_SERVICES[i++] = SERVICE_NFC;
KillingJacky 0:5a372b5a35bb 90 nfc_adapter_init();
KillingJacky 0:5a372b5a35bb 91 }
KillingJacky 0:5a372b5a35bb 92
KillingJacky 0:5a372b5a35bb 93 mbedPebbleSerial::begin(s_pebble_buffer, sizeof(s_pebble_buffer), Baud9600, SUPPORTED_SERVICES, i);
KillingJacky 0:5a372b5a35bb 94
KillingJacky 0:5a372b5a35bb 95 dbg_serial.printf("Service self detecting done!\r\n");
KillingJacky 0:5a372b5a35bb 96
KillingJacky 0:5a372b5a35bb 97
KillingJacky 0:5a372b5a35bb 98 /* init i2c */
KillingJacky 0:5a372b5a35bb 99 i2c.frequency(100000); //100khz
KillingJacky 0:5a372b5a35bb 100
KillingJacky 0:5a372b5a35bb 101 timer.start();
KillingJacky 0:5a372b5a35bb 102
KillingJacky 0:5a372b5a35bb 103 size_t length;
KillingJacky 0:5a372b5a35bb 104 uint16_t service_id;
KillingJacky 0:5a372b5a35bb 105 uint16_t attribute_id;
KillingJacky 0:5a372b5a35bb 106 RequestType type;
KillingJacky 0:5a372b5a35bb 107
KillingJacky 0:5a372b5a35bb 108 while(1) {
KillingJacky 0:5a372b5a35bb 109 if(mbedPebbleSerial::feed(&service_id, &attribute_id, &length, &type))
KillingJacky 0:5a372b5a35bb 110 {
KillingJacky 0:5a372b5a35bb 111 // we have a raw data frame to process
KillingJacky 0:5a372b5a35bb 112 if ((service_id == 0) && (attribute_id == 0))
KillingJacky 0:5a372b5a35bb 113 {
KillingJacky 0:5a372b5a35bb 114 ;
KillingJacky 0:5a372b5a35bb 115 }
KillingJacky 0:5a372b5a35bb 116 else if (service_id == SERVICE_BAT)
KillingJacky 0:5a372b5a35bb 117 {
KillingJacky 0:5a372b5a35bb 118 if ((attribute_id == ATTR_BAT_V) && (type == RequestTypeRead))
KillingJacky 0:5a372b5a35bb 119 {
KillingJacky 0:5a372b5a35bb 120 float vbat_f = get_vbat();
KillingJacky 0:5a372b5a35bb 121 uint16_t vbat = (uint16_t)(vbat_f * 100);
KillingJacky 0:5a372b5a35bb 122 dbg_serial.printf("ATTR_BAT_V, vbat: %f, %d\r\n", vbat_f, vbat);
KillingJacky 0:5a372b5a35bb 123 memcpy(s_pebble_buffer, &vbat, sizeof(vbat));
KillingJacky 0:5a372b5a35bb 124 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(vbat));
KillingJacky 0:5a372b5a35bb 125 }
KillingJacky 0:5a372b5a35bb 126 else if((attribute_id == ATTR_BAT_CHG) && (type == RequestTypeWrite))
KillingJacky 0:5a372b5a35bb 127 {
KillingJacky 0:5a372b5a35bb 128 uint8_t enable_charge;
KillingJacky 0:5a372b5a35bb 129 memcpy(&enable_charge, s_pebble_buffer, sizeof(enable_charge));
KillingJacky 0:5a372b5a35bb 130 dbg_serial.printf("ATTR_BAT_CHG: %d\r\n", enable_charge);
KillingJacky 0:5a372b5a35bb 131 pin_5v_en = enable_charge;
KillingJacky 0:5a372b5a35bb 132 mbedPebbleSerial::write(true, NULL, 0);
KillingJacky 0:5a372b5a35bb 133 }
KillingJacky 0:5a372b5a35bb 134 else
KillingJacky 0:5a372b5a35bb 135 {
KillingJacky 0:5a372b5a35bb 136 mbedPebbleSerial::write(false, NULL, 0);
KillingJacky 0:5a372b5a35bb 137 }
KillingJacky 0:5a372b5a35bb 138 }
KillingJacky 0:5a372b5a35bb 139 else if (service_id == SERVICE_GPS)
KillingJacky 0:5a372b5a35bb 140 {
KillingJacky 0:5a372b5a35bb 141 if (attribute_id == ATTR_GPS_LOCATION && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 142 {
KillingJacky 0:5a372b5a35bb 143 float lat_f, lon_f;
KillingJacky 0:5a372b5a35bb 144 lat_f = gps_get_latitude();
KillingJacky 0:5a372b5a35bb 145 lon_f = gps_get_longitude();
KillingJacky 0:5a372b5a35bb 146 int32_t lat = (int32_t)(lat_f * (10000000));
KillingJacky 0:5a372b5a35bb 147 int32_t lon = (int32_t)(lon_f * (10000000));
KillingJacky 0:5a372b5a35bb 148 dbg_serial.printf("ATTR_GPS_LOCATION: %f, %f ---- %d, %d\r\n", lat_f,lon_f,lat,lon);
KillingJacky 0:5a372b5a35bb 149 memcpy(s_pebble_buffer, &lat, sizeof(lat));
KillingJacky 0:5a372b5a35bb 150 memcpy(s_pebble_buffer+sizeof(lat), &lon, sizeof(lon));
KillingJacky 0:5a372b5a35bb 151 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(lat)*2);
KillingJacky 0:5a372b5a35bb 152 }
KillingJacky 0:5a372b5a35bb 153 else if (attribute_id == ATTR_GPS_SPEED && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 154 {
KillingJacky 0:5a372b5a35bb 155 float v = gps_get_speed();
KillingJacky 0:5a372b5a35bb 156 uint16_t speed = (uint16_t)(v * 100);
KillingJacky 0:5a372b5a35bb 157 dbg_serial.printf("ATTR_GPS_SPEED: %f, %d\r\n", v,speed);
KillingJacky 0:5a372b5a35bb 158 memcpy(s_pebble_buffer, &speed, sizeof(speed));
KillingJacky 0:5a372b5a35bb 159 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(speed));
KillingJacky 0:5a372b5a35bb 160 }
KillingJacky 0:5a372b5a35bb 161 else if (attribute_id == ATTR_GPS_ALTITUDE && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 162 {
KillingJacky 0:5a372b5a35bb 163 float alt_f = gps_get_altitude();
KillingJacky 0:5a372b5a35bb 164 uint16_t alt = (uint16_t)(alt_f * 100);
KillingJacky 0:5a372b5a35bb 165 dbg_serial.printf("ATTR_GPS_ALTITUDE: %f, %d\r\n", alt_f,alt);
KillingJacky 0:5a372b5a35bb 166 memcpy(s_pebble_buffer, &alt, sizeof(alt));
KillingJacky 0:5a372b5a35bb 167 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(alt));
KillingJacky 0:5a372b5a35bb 168 }
KillingJacky 0:5a372b5a35bb 169 else if (attribute_id == ATTR_GPS_FIX_QUALITY && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 170 {
KillingJacky 0:5a372b5a35bb 171 uint8_t fixq = gps_get_position_fix();
KillingJacky 0:5a372b5a35bb 172 dbg_serial.printf("ATTR_GPS_FIX_QUALITY: %d\r\n", fixq);
KillingJacky 0:5a372b5a35bb 173 memcpy(s_pebble_buffer, &fixq, sizeof(fixq));
KillingJacky 0:5a372b5a35bb 174 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(fixq));
KillingJacky 0:5a372b5a35bb 175 }
KillingJacky 0:5a372b5a35bb 176 else if (attribute_id == ATTR_GPS_SATELLITES && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 177 {
KillingJacky 0:5a372b5a35bb 178 uint8_t sat = gps_get_sate_used();
KillingJacky 0:5a372b5a35bb 179 dbg_serial.printf("ATTR_GPS_SATELLITES: %d\r\n", sat);
KillingJacky 0:5a372b5a35bb 180 memcpy(s_pebble_buffer, &sat, sizeof(sat));
KillingJacky 0:5a372b5a35bb 181 mbedPebbleSerial::write(true, s_pebble_buffer, sizeof(sat));
KillingJacky 0:5a372b5a35bb 182 }else
KillingJacky 0:5a372b5a35bb 183 {
KillingJacky 0:5a372b5a35bb 184 mbedPebbleSerial::write(false, NULL, 0);
KillingJacky 0:5a372b5a35bb 185 }
KillingJacky 0:5a372b5a35bb 186 }
KillingJacky 0:5a372b5a35bb 187 else if (service_id == SERVICE_NFC)
KillingJacky 0:5a372b5a35bb 188 {
KillingJacky 0:5a372b5a35bb 189 if (attribute_id == ATTR_NFC_GET_UID && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 190 {
KillingJacky 0:5a372b5a35bb 191 /*uint8_t *uid = nfc_adapter_get_uid();
KillingJacky 0:5a372b5a35bb 192 uint8_t len = uid[1];
KillingJacky 0:5a372b5a35bb 193 dbg_serial.printf("GET_NFC_TAGID: ");
KillingJacky 0:5a372b5a35bb 194 for(int i=2; i<2+len; i++)
KillingJacky 0:5a372b5a35bb 195 {
KillingJacky 0:5a372b5a35bb 196 dbg_serial.printf("%02X ", uid[i]);
KillingJacky 0:5a372b5a35bb 197 }
KillingJacky 0:5a372b5a35bb 198 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 199 memcpy((char *)s_pebble_buffer, (char *)(uid+2), len);
KillingJacky 0:5a372b5a35bb 200 mbedPebbleSerial::write(true, s_pebble_buffer, len);*/
KillingJacky 0:5a372b5a35bb 201 dbg_serial.printf("GET_NFC_TAGID: ");
KillingJacky 0:5a372b5a35bb 202 for(int i=0; i<last_tagid_len; i++)
KillingJacky 0:5a372b5a35bb 203 {
KillingJacky 0:5a372b5a35bb 204 dbg_serial.printf("%02X ", last_tagid[i]);
KillingJacky 0:5a372b5a35bb 205 }
KillingJacky 0:5a372b5a35bb 206 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 207 memcpy((char *)s_pebble_buffer, (char *)last_tagid, last_tagid_len);
KillingJacky 0:5a372b5a35bb 208 mbedPebbleSerial::write(true, s_pebble_buffer, last_tagid_len);
KillingJacky 0:5a372b5a35bb 209 }
KillingJacky 0:5a372b5a35bb 210 else if (attribute_id == ATTR_NFC_READ_NDEF && type == RequestTypeRead)
KillingJacky 0:5a372b5a35bb 211 {
KillingJacky 0:5a372b5a35bb 212 memset(s_pebble_buffer, 0, sizeof(s_pebble_buffer));
KillingJacky 0:5a372b5a35bb 213 uint8_t *ndef = nfc_adapter_read();
KillingJacky 0:5a372b5a35bb 214 uint8_t len = ndef[1];
KillingJacky 0:5a372b5a35bb 215 len = min(len, BUFFER_SIZE);
KillingJacky 0:5a372b5a35bb 216 dbg_serial.printf("GET_NFC_NDEF: ");
KillingJacky 0:5a372b5a35bb 217 for(int i=2; i<2+len; i++)
KillingJacky 0:5a372b5a35bb 218 {
KillingJacky 0:5a372b5a35bb 219 dbg_serial.printf("%02X ", ndef[i]);
KillingJacky 0:5a372b5a35bb 220 }
KillingJacky 0:5a372b5a35bb 221 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 222 memcpy((char *)s_pebble_buffer, (char *)(ndef+2), len);
KillingJacky 0:5a372b5a35bb 223 mbedPebbleSerial::write(true, s_pebble_buffer, len);
KillingJacky 0:5a372b5a35bb 224 }
KillingJacky 0:5a372b5a35bb 225 else if((attribute_id == ATTR_NFC_WRITE_NDEF) && (type == RequestTypeWrite))
KillingJacky 0:5a372b5a35bb 226 {
KillingJacky 0:5a372b5a35bb 227 if (*(s_pebble_buffer + length) != '\0' && length < BUFFER_SIZE)
KillingJacky 0:5a372b5a35bb 228 *(s_pebble_buffer + length) = '\0';
KillingJacky 0:5a372b5a35bb 229 dbg_serial.printf("ATTR_NFC_WRITE_NDEF: ");
KillingJacky 0:5a372b5a35bb 230 for(int i=0; i<length; i++)
KillingJacky 0:5a372b5a35bb 231 {
KillingJacky 0:5a372b5a35bb 232 dbg_serial.printf("%02X ", s_pebble_buffer[i]);
KillingJacky 0:5a372b5a35bb 233 }
KillingJacky 0:5a372b5a35bb 234 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 235 nfc_adapter_write(s_pebble_buffer, length);
KillingJacky 0:5a372b5a35bb 236 mbedPebbleSerial::write(true, NULL, 0);
KillingJacky 0:5a372b5a35bb 237 }
KillingJacky 0:5a372b5a35bb 238 else if((attribute_id == ATTR_NFC_ERASE_NDEF) && (type == RequestTypeWrite))
KillingJacky 0:5a372b5a35bb 239 {
KillingJacky 0:5a372b5a35bb 240 dbg_serial.printf("ATTR_NFC_ERASE_NDEF\r\n");
KillingJacky 0:5a372b5a35bb 241 nfc_adapter_erase();
KillingJacky 0:5a372b5a35bb 242 mbedPebbleSerial::write(true, NULL, 0);
KillingJacky 0:5a372b5a35bb 243 }
KillingJacky 0:5a372b5a35bb 244 else if((attribute_id == ATTR_NFC_EMULATE_A_TAG) && (type == RequestTypeWrite))
KillingJacky 0:5a372b5a35bb 245 {
KillingJacky 0:5a372b5a35bb 246 dbg_serial.printf("ATTR_NFC_EMULATE_A_TAG: ");
KillingJacky 0:5a372b5a35bb 247 for(int i=0; i<length; i++)
KillingJacky 0:5a372b5a35bb 248 {
KillingJacky 0:5a372b5a35bb 249 dbg_serial.printf("%02X ", s_pebble_buffer[i]);
KillingJacky 0:5a372b5a35bb 250 }
KillingJacky 0:5a372b5a35bb 251 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 252 nfc_emulate_init(s_pebble_buffer); //this function will internally take only the first 3 bytes from buffer.
KillingJacky 0:5a372b5a35bb 253 mbedPebbleSerial::write(true, NULL, 0);
KillingJacky 0:5a372b5a35bb 254 } else
KillingJacky 0:5a372b5a35bb 255 {
KillingJacky 0:5a372b5a35bb 256 mbedPebbleSerial::write(false, NULL, 0);
KillingJacky 0:5a372b5a35bb 257 }
KillingJacky 0:5a372b5a35bb 258 }
KillingJacky 0:5a372b5a35bb 259 }
KillingJacky 0:5a372b5a35bb 260
KillingJacky 0:5a372b5a35bb 261 //check if nfc tagid changed
KillingJacky 0:5a372b5a35bb 262 if (timer.read_ms() > 1000 && nfc_online)
KillingJacky 0:5a372b5a35bb 263 {
KillingJacky 0:5a372b5a35bb 264 timer.reset();
KillingJacky 0:5a372b5a35bb 265
KillingJacky 0:5a372b5a35bb 266 uint8_t *uid = nfc_adapter_get_uid();
KillingJacky 0:5a372b5a35bb 267 uint8_t len = uid[1];
KillingJacky 0:5a372b5a35bb 268 dbg_serial.printf("Check NFC: ");
KillingJacky 0:5a372b5a35bb 269 if (len > 0)
KillingJacky 0:5a372b5a35bb 270 {
KillingJacky 0:5a372b5a35bb 271 for(int i=2; i<2+len; i++)
KillingJacky 0:5a372b5a35bb 272 {
KillingJacky 0:5a372b5a35bb 273 dbg_serial.printf("%02X ", uid[i]);
KillingJacky 0:5a372b5a35bb 274 }
KillingJacky 0:5a372b5a35bb 275 }
KillingJacky 0:5a372b5a35bb 276 dbg_serial.printf("\r\n");
KillingJacky 0:5a372b5a35bb 277 len = min(len, 10);
KillingJacky 0:5a372b5a35bb 278 if (memcmp(last_tagid, uid+2, len) != 0 || len != last_tagid_len)
KillingJacky 0:5a372b5a35bb 279 {
KillingJacky 0:5a372b5a35bb 280 //changed, notify
KillingJacky 0:5a372b5a35bb 281 mbedPebbleSerial::notify(SERVICE_NFC, ATTR_NFC_GET_UID);
KillingJacky 0:5a372b5a35bb 282 if (len == 0)
KillingJacky 0:5a372b5a35bb 283 {
KillingJacky 0:5a372b5a35bb 284 memset(last_tagid, 0, sizeof(last_tagid));
KillingJacky 0:5a372b5a35bb 285 }else
KillingJacky 0:5a372b5a35bb 286 {
KillingJacky 0:5a372b5a35bb 287 memcpy(last_tagid, uid+2, len);
KillingJacky 0:5a372b5a35bb 288 }
KillingJacky 0:5a372b5a35bb 289 last_tagid_len = len;
KillingJacky 0:5a372b5a35bb 290 }
KillingJacky 0:5a372b5a35bb 291 }
KillingJacky 0:5a372b5a35bb 292
KillingJacky 0:5a372b5a35bb 293 } //while 1
KillingJacky 0:5a372b5a35bb 294 }