the firmware for xadow smartstrap for pebble

Dependencies:   BufferedSerial USBDevice XadowGPS XadowNFC mbed mbedPebbleSerial IAP

Committer:
KillingJacky
Date:
Thu Nov 05 04:04:40 2015 +0000
Revision:
1:8d2e8f504ba3
Parent:
0:5a372b5a35bb
Child:
2:281fa9ce92c0
**added satellites in view; **store charge configure over power down

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