the firmware for xadow smartstrap for pebble
Dependencies: BufferedSerial USBDevice XadowGPS XadowNFC mbed mbedPebbleSerial IAP
main.cpp@1:8d2e8f504ba3, 2015-11-05 (annotated)
- 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?
User | Revision | Line number | New 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 | } |