Generic library for working with PN532-like chips
Fork of PN532 by
NdefMessage.cpp@11:5b8afec8bee6, 2015-02-04 (annotated)
- Committer:
- r4z0r7o3
- Date:
- Wed Feb 04 19:26:03 2015 +0000
- Revision:
- 11:5b8afec8bee6
- Parent:
- 10:f959b305a571
Fix missing space in tag print()
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
yihui | 3:4189a10038e6 | 1 | #include "NdefMessage.h" |
yihui | 3:4189a10038e6 | 2 | #include "PN532_debug.h" |
yihui | 3:4189a10038e6 | 3 | |
yihui | 3:4189a10038e6 | 4 | NdefMessage::NdefMessage(void) |
yihui | 3:4189a10038e6 | 5 | { |
yihui | 3:4189a10038e6 | 6 | _recordCount = 0; |
yihui | 3:4189a10038e6 | 7 | } |
yihui | 3:4189a10038e6 | 8 | |
yihui | 3:4189a10038e6 | 9 | NdefMessage::NdefMessage(const uint8_t * data, const int numuint8_ts) |
yihui | 3:4189a10038e6 | 10 | { |
yihui | 3:4189a10038e6 | 11 | #ifdef NDEF_DEBUG |
r4z0r7o3 | 10:f959b305a571 | 12 | DMSG("Decoding ");DMSG_INT(numuint8_ts);DMSG(" uint8_ts"); |
yihui | 3:4189a10038e6 | 13 | PrintHexChar(data, numuint8_ts); |
yihui | 3:4189a10038e6 | 14 | //DumpHex(data, numuint8_ts, 16); |
r4z0r7o3 | 10:f959b305a571 | 15 | DMSG("\n"); |
yihui | 3:4189a10038e6 | 16 | #endif |
yihui | 3:4189a10038e6 | 17 | |
yihui | 3:4189a10038e6 | 18 | _recordCount = 0; |
yihui | 3:4189a10038e6 | 19 | |
yihui | 3:4189a10038e6 | 20 | int index = 0; |
yihui | 3:4189a10038e6 | 21 | |
yihui | 3:4189a10038e6 | 22 | while (index <= numuint8_ts) |
yihui | 3:4189a10038e6 | 23 | { |
yihui | 3:4189a10038e6 | 24 | |
yihui | 3:4189a10038e6 | 25 | // decode tnf - first uint8_t is tnf with bit flags |
yihui | 3:4189a10038e6 | 26 | // see the NFDEF spec for more info |
yihui | 3:4189a10038e6 | 27 | uint8_t tnf_uint8_t = data[index]; |
screamer | 7:26c1b3b6c192 | 28 | //bool mb = (tnf_uint8_t & 0x80) != 0; |
yihui | 3:4189a10038e6 | 29 | bool me = (tnf_uint8_t & 0x40) != 0; |
screamer | 7:26c1b3b6c192 | 30 | //bool cf = (tnf_uint8_t & 0x20) != 0; |
yihui | 3:4189a10038e6 | 31 | bool sr = (tnf_uint8_t & 0x10) != 0; |
yihui | 3:4189a10038e6 | 32 | bool il = (tnf_uint8_t & 0x8) != 0; |
yihui | 3:4189a10038e6 | 33 | uint8_t tnf = (tnf_uint8_t & 0x7); |
yihui | 3:4189a10038e6 | 34 | |
yihui | 3:4189a10038e6 | 35 | NdefRecord record = NdefRecord(); |
yihui | 3:4189a10038e6 | 36 | record.setTnf(tnf); |
yihui | 3:4189a10038e6 | 37 | |
yihui | 3:4189a10038e6 | 38 | index++; |
yihui | 3:4189a10038e6 | 39 | int typeLength = data[index]; |
yihui | 3:4189a10038e6 | 40 | |
yihui | 3:4189a10038e6 | 41 | int payloadLength = 0; |
yihui | 3:4189a10038e6 | 42 | if (sr) |
yihui | 3:4189a10038e6 | 43 | { |
yihui | 3:4189a10038e6 | 44 | index++; |
yihui | 3:4189a10038e6 | 45 | payloadLength = data[index]; |
yihui | 3:4189a10038e6 | 46 | } |
yihui | 3:4189a10038e6 | 47 | else |
yihui | 3:4189a10038e6 | 48 | { |
yihui | 3:4189a10038e6 | 49 | payloadLength = ((0xFF & data[++index]) << 24) | ((0xFF & data[++index]) << 26) | |
yihui | 3:4189a10038e6 | 50 | ((0xFF & data[++index]) << 8) | (0xFF & data[++index]); |
yihui | 3:4189a10038e6 | 51 | } |
yihui | 3:4189a10038e6 | 52 | |
yihui | 3:4189a10038e6 | 53 | int idLength = 0; |
yihui | 3:4189a10038e6 | 54 | if (il) |
yihui | 3:4189a10038e6 | 55 | { |
yihui | 3:4189a10038e6 | 56 | index++; |
yihui | 3:4189a10038e6 | 57 | idLength = data[index]; |
yihui | 3:4189a10038e6 | 58 | } |
yihui | 3:4189a10038e6 | 59 | |
yihui | 3:4189a10038e6 | 60 | index++; |
yihui | 3:4189a10038e6 | 61 | record.setType(&data[index], typeLength); |
yihui | 3:4189a10038e6 | 62 | index += typeLength; |
yihui | 3:4189a10038e6 | 63 | |
yihui | 3:4189a10038e6 | 64 | if (il) |
yihui | 3:4189a10038e6 | 65 | { |
yihui | 3:4189a10038e6 | 66 | record.setId(&data[index], idLength); |
yihui | 3:4189a10038e6 | 67 | index += idLength; |
yihui | 3:4189a10038e6 | 68 | } |
yihui | 3:4189a10038e6 | 69 | |
yihui | 3:4189a10038e6 | 70 | record.setPayload(&data[index], payloadLength); |
yihui | 3:4189a10038e6 | 71 | index += payloadLength; |
yihui | 3:4189a10038e6 | 72 | |
yihui | 3:4189a10038e6 | 73 | addRecord(record); |
yihui | 3:4189a10038e6 | 74 | |
yihui | 3:4189a10038e6 | 75 | if (me) break; // last message |
yihui | 3:4189a10038e6 | 76 | } |
yihui | 3:4189a10038e6 | 77 | |
yihui | 3:4189a10038e6 | 78 | } |
yihui | 3:4189a10038e6 | 79 | |
yihui | 3:4189a10038e6 | 80 | NdefMessage::NdefMessage(const NdefMessage& rhs) |
yihui | 3:4189a10038e6 | 81 | { |
yihui | 3:4189a10038e6 | 82 | |
yihui | 3:4189a10038e6 | 83 | _recordCount = rhs._recordCount; |
yihui | 3:4189a10038e6 | 84 | for (int i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 85 | { |
yihui | 3:4189a10038e6 | 86 | _records[i] = rhs._records[i]; |
yihui | 3:4189a10038e6 | 87 | } |
yihui | 3:4189a10038e6 | 88 | |
yihui | 3:4189a10038e6 | 89 | } |
yihui | 3:4189a10038e6 | 90 | |
yihui | 3:4189a10038e6 | 91 | NdefMessage::~NdefMessage() |
yihui | 3:4189a10038e6 | 92 | { |
yihui | 3:4189a10038e6 | 93 | } |
yihui | 3:4189a10038e6 | 94 | |
yihui | 3:4189a10038e6 | 95 | NdefMessage& NdefMessage::operator=(const NdefMessage& rhs) |
yihui | 3:4189a10038e6 | 96 | { |
yihui | 3:4189a10038e6 | 97 | |
yihui | 3:4189a10038e6 | 98 | if (this != &rhs) |
yihui | 3:4189a10038e6 | 99 | { |
yihui | 3:4189a10038e6 | 100 | |
yihui | 3:4189a10038e6 | 101 | // delete existing records |
yihui | 3:4189a10038e6 | 102 | for (int i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 103 | { |
yihui | 3:4189a10038e6 | 104 | // TODO Dave: is this the right way to delete existing records? |
yihui | 3:4189a10038e6 | 105 | _records[i] = NdefRecord(); |
yihui | 3:4189a10038e6 | 106 | } |
yihui | 3:4189a10038e6 | 107 | |
yihui | 3:4189a10038e6 | 108 | _recordCount = rhs._recordCount; |
yihui | 3:4189a10038e6 | 109 | for (int i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 110 | { |
yihui | 3:4189a10038e6 | 111 | _records[i] = rhs._records[i]; |
yihui | 3:4189a10038e6 | 112 | } |
yihui | 3:4189a10038e6 | 113 | } |
yihui | 3:4189a10038e6 | 114 | return *this; |
yihui | 3:4189a10038e6 | 115 | } |
yihui | 3:4189a10038e6 | 116 | |
yihui | 3:4189a10038e6 | 117 | unsigned int NdefMessage::getRecordCount() |
yihui | 3:4189a10038e6 | 118 | { |
yihui | 3:4189a10038e6 | 119 | return _recordCount; |
yihui | 3:4189a10038e6 | 120 | } |
yihui | 3:4189a10038e6 | 121 | |
yihui | 3:4189a10038e6 | 122 | int NdefMessage::getEncodedSize() |
yihui | 3:4189a10038e6 | 123 | { |
yihui | 3:4189a10038e6 | 124 | int size = 0; |
yihui | 3:4189a10038e6 | 125 | for (int i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 126 | { |
yihui | 3:4189a10038e6 | 127 | size += _records[i].getEncodedSize(); |
yihui | 3:4189a10038e6 | 128 | } |
yihui | 3:4189a10038e6 | 129 | return size; |
yihui | 3:4189a10038e6 | 130 | } |
yihui | 3:4189a10038e6 | 131 | |
yihui | 3:4189a10038e6 | 132 | // TODO change this to return uint8_t* |
yihui | 3:4189a10038e6 | 133 | void NdefMessage::encode(uint8_t* data) |
yihui | 3:4189a10038e6 | 134 | { |
yihui | 3:4189a10038e6 | 135 | // assert sizeof(data) >= getEncodedSize() |
yihui | 3:4189a10038e6 | 136 | uint8_t* data_ptr = &data[0]; |
yihui | 3:4189a10038e6 | 137 | |
yihui | 3:4189a10038e6 | 138 | for (int i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 139 | { |
yihui | 3:4189a10038e6 | 140 | _records[i].encode(data_ptr, i == 0, (i + 1) == _recordCount); |
yihui | 3:4189a10038e6 | 141 | // TODO can NdefRecord.encode return the record size? |
yihui | 3:4189a10038e6 | 142 | data_ptr += _records[i].getEncodedSize(); |
yihui | 3:4189a10038e6 | 143 | } |
yihui | 3:4189a10038e6 | 144 | |
yihui | 3:4189a10038e6 | 145 | } |
yihui | 3:4189a10038e6 | 146 | |
yihui | 3:4189a10038e6 | 147 | bool NdefMessage::addRecord(NdefRecord& record) |
yihui | 3:4189a10038e6 | 148 | { |
yihui | 3:4189a10038e6 | 149 | |
yihui | 3:4189a10038e6 | 150 | if (_recordCount < MAX_NDEF_RECORDS) |
yihui | 3:4189a10038e6 | 151 | { |
yihui | 3:4189a10038e6 | 152 | _records[_recordCount] = record; |
yihui | 3:4189a10038e6 | 153 | _recordCount++; |
yihui | 3:4189a10038e6 | 154 | return true; |
yihui | 3:4189a10038e6 | 155 | } |
yihui | 3:4189a10038e6 | 156 | else |
yihui | 3:4189a10038e6 | 157 | { |
r4z0r7o3 | 10:f959b305a571 | 158 | DMSG("WARNING: Too many records. Increase MAX_NDEF_RECORDS.\n"); |
yihui | 3:4189a10038e6 | 159 | return false; |
yihui | 3:4189a10038e6 | 160 | } |
yihui | 3:4189a10038e6 | 161 | } |
yihui | 3:4189a10038e6 | 162 | |
yihui | 3:4189a10038e6 | 163 | void NdefMessage::addMimeMediaRecord(string mimeType, string payload) |
yihui | 3:4189a10038e6 | 164 | { |
yihui | 3:4189a10038e6 | 165 | |
yihui | 3:4189a10038e6 | 166 | uint8_t payloaduint8_ts[payload.length() + 1]; |
yihui | 3:4189a10038e6 | 167 | payload.copy((char*)payloaduint8_ts, sizeof(payloaduint8_ts)); |
yihui | 3:4189a10038e6 | 168 | |
yihui | 3:4189a10038e6 | 169 | addMimeMediaRecord(mimeType, payloaduint8_ts, payload.length()); |
yihui | 3:4189a10038e6 | 170 | } |
yihui | 3:4189a10038e6 | 171 | |
yihui | 3:4189a10038e6 | 172 | void NdefMessage::addMimeMediaRecord(string mimeType, uint8_t* payload, int payloadLength) |
yihui | 3:4189a10038e6 | 173 | { |
yihui | 3:4189a10038e6 | 174 | NdefRecord r = NdefRecord(); |
yihui | 3:4189a10038e6 | 175 | r.setTnf(TNF_MIME_MEDIA); |
yihui | 3:4189a10038e6 | 176 | |
yihui | 3:4189a10038e6 | 177 | uint8_t type[mimeType.length() + 1]; |
yihui | 3:4189a10038e6 | 178 | mimeType.copy((char*)type, sizeof(type)); |
yihui | 3:4189a10038e6 | 179 | r.setType(type, mimeType.length()); |
yihui | 3:4189a10038e6 | 180 | |
yihui | 3:4189a10038e6 | 181 | r.setPayload(payload, payloadLength); |
yihui | 3:4189a10038e6 | 182 | |
yihui | 3:4189a10038e6 | 183 | addRecord(r); |
yihui | 3:4189a10038e6 | 184 | } |
yihui | 3:4189a10038e6 | 185 | |
yihui | 3:4189a10038e6 | 186 | void NdefMessage::addTextRecord(string text) |
yihui | 3:4189a10038e6 | 187 | { |
yihui | 3:4189a10038e6 | 188 | addTextRecord(text, "en"); |
yihui | 3:4189a10038e6 | 189 | } |
yihui | 3:4189a10038e6 | 190 | |
yihui | 3:4189a10038e6 | 191 | void NdefMessage::addTextRecord(string text, string encoding) |
yihui | 3:4189a10038e6 | 192 | { |
yihui | 3:4189a10038e6 | 193 | NdefRecord r = NdefRecord(); |
yihui | 3:4189a10038e6 | 194 | r.setTnf(TNF_WELL_KNOWN); |
yihui | 3:4189a10038e6 | 195 | |
yihui | 3:4189a10038e6 | 196 | uint8_t RTD_TEXT[1] = { 0x54 }; // TODO this should be a constant or preprocessor |
yihui | 3:4189a10038e6 | 197 | r.setType(RTD_TEXT, sizeof(RTD_TEXT)); |
yihui | 3:4189a10038e6 | 198 | |
yihui | 3:4189a10038e6 | 199 | // X is a placeholder for encoding length |
yihui | 3:4189a10038e6 | 200 | // TODO is it more efficient to build w/o string concatenation? |
yihui | 3:4189a10038e6 | 201 | string payloadString = "X" + encoding + text; |
yihui | 3:4189a10038e6 | 202 | |
yihui | 3:4189a10038e6 | 203 | uint8_t payload[payloadString.length() + 1]; |
yihui | 3:4189a10038e6 | 204 | payloadString.copy((char*)payload, sizeof(payload)); |
yihui | 3:4189a10038e6 | 205 | |
yihui | 3:4189a10038e6 | 206 | // replace X with the real encoding length |
yihui | 3:4189a10038e6 | 207 | payload[0] = encoding.length(); |
yihui | 3:4189a10038e6 | 208 | |
yihui | 3:4189a10038e6 | 209 | r.setPayload(payload, payloadString.length()); |
yihui | 3:4189a10038e6 | 210 | |
yihui | 3:4189a10038e6 | 211 | addRecord(r); |
yihui | 3:4189a10038e6 | 212 | } |
yihui | 3:4189a10038e6 | 213 | |
yihui | 3:4189a10038e6 | 214 | void NdefMessage::addUriRecord(string uri) |
yihui | 3:4189a10038e6 | 215 | { |
yihui | 3:4189a10038e6 | 216 | NdefRecord* r = new NdefRecord(); |
yihui | 3:4189a10038e6 | 217 | r->setTnf(TNF_WELL_KNOWN); |
yihui | 3:4189a10038e6 | 218 | |
yihui | 3:4189a10038e6 | 219 | uint8_t RTD_URI[1] = { 0x55 }; // TODO this should be a constant or preprocessor |
yihui | 3:4189a10038e6 | 220 | r->setType(RTD_URI, sizeof(RTD_URI)); |
yihui | 3:4189a10038e6 | 221 | |
yihui | 3:4189a10038e6 | 222 | // X is a placeholder for identifier code |
yihui | 3:4189a10038e6 | 223 | string payloadString = "X" + uri; |
yihui | 3:4189a10038e6 | 224 | |
yihui | 3:4189a10038e6 | 225 | uint8_t payload[payloadString.length() + 1]; |
yihui | 3:4189a10038e6 | 226 | payloadString.copy((char*)payload, sizeof(payload)); |
yihui | 3:4189a10038e6 | 227 | |
yihui | 3:4189a10038e6 | 228 | // add identifier code 0x0, meaning no prefix substitution |
yihui | 3:4189a10038e6 | 229 | payload[0] = 0x0; |
yihui | 3:4189a10038e6 | 230 | |
yihui | 3:4189a10038e6 | 231 | r->setPayload(payload, payloadString.length()); |
yihui | 3:4189a10038e6 | 232 | |
yihui | 3:4189a10038e6 | 233 | addRecord(*r); |
yihui | 3:4189a10038e6 | 234 | delete(r); |
yihui | 3:4189a10038e6 | 235 | } |
yihui | 3:4189a10038e6 | 236 | |
yihui | 3:4189a10038e6 | 237 | void NdefMessage::addEmptyRecord() |
yihui | 3:4189a10038e6 | 238 | { |
yihui | 3:4189a10038e6 | 239 | NdefRecord* r = new NdefRecord(); |
yihui | 3:4189a10038e6 | 240 | r->setTnf(TNF_EMPTY); |
yihui | 3:4189a10038e6 | 241 | addRecord(*r); |
yihui | 3:4189a10038e6 | 242 | delete(r); |
yihui | 3:4189a10038e6 | 243 | } |
yihui | 3:4189a10038e6 | 244 | |
yihui | 3:4189a10038e6 | 245 | NdefRecord NdefMessage::getRecord(int index) |
yihui | 3:4189a10038e6 | 246 | { |
yihui | 3:4189a10038e6 | 247 | if (index > -1 && index < _recordCount) |
yihui | 3:4189a10038e6 | 248 | { |
yihui | 3:4189a10038e6 | 249 | return _records[index]; |
yihui | 3:4189a10038e6 | 250 | } |
yihui | 3:4189a10038e6 | 251 | else |
yihui | 3:4189a10038e6 | 252 | { |
yihui | 3:4189a10038e6 | 253 | return NdefRecord(); // would rather return NULL |
yihui | 3:4189a10038e6 | 254 | } |
yihui | 3:4189a10038e6 | 255 | } |
yihui | 3:4189a10038e6 | 256 | |
yihui | 3:4189a10038e6 | 257 | NdefRecord NdefMessage::operator[](int index) |
yihui | 3:4189a10038e6 | 258 | { |
yihui | 3:4189a10038e6 | 259 | return getRecord(index); |
yihui | 3:4189a10038e6 | 260 | } |
yihui | 3:4189a10038e6 | 261 | |
yihui | 3:4189a10038e6 | 262 | void NdefMessage::print() |
yihui | 3:4189a10038e6 | 263 | { |
r4z0r7o3 | 10:f959b305a571 | 264 | DMSG("NDEF Message "); |
yihui | 3:4189a10038e6 | 265 | DMSG_INT(_recordCount); |
yihui | 3:4189a10038e6 | 266 | DMSG(" record"); |
yihui | 3:4189a10038e6 | 267 | if (_recordCount == 1) { |
yihui | 3:4189a10038e6 | 268 | DMSG(", "); |
yihui | 3:4189a10038e6 | 269 | } else { |
yihui | 3:4189a10038e6 | 270 | DMSG("s, "); |
yihui | 3:4189a10038e6 | 271 | } |
yihui | 3:4189a10038e6 | 272 | DMSG_INT(getEncodedSize()); |
yihui | 3:4189a10038e6 | 273 | |
yihui | 3:4189a10038e6 | 274 | int i; |
yihui | 3:4189a10038e6 | 275 | for (i = 0; i < _recordCount; i++) |
yihui | 3:4189a10038e6 | 276 | { |
yihui | 3:4189a10038e6 | 277 | _records[i].print(); |
yihui | 3:4189a10038e6 | 278 | } |
r4z0r7o3 | 10:f959b305a571 | 279 | DMSG("\n"); |
yihui | 3:4189a10038e6 | 280 | } |