123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128 |
- /*-
- * Free/Libre Near Field Communication (NFC) library
- *
- * Libnfc historical contributors:
- * Copyright (C) 2009 Roel Verdult
- * Copyright (C) 2009-2013 Romuald Conty
- * Copyright (C) 2010-2012 Romain Tartière
- * Copyright (C) 2010-2013 Philippe Teuwen
- * Copyright (C) 2012-2013 Ludovic Rousseau
- * Additional contributors of this file:
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- * 1) Redistributions of source code must retain the above copyright notice,
- * this list of conditions and the following disclaimer.
- * 2 )Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
- * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
- * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
- * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
- * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
- * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
- * POSSIBILITY OF SUCH DAMAGE.
- *
- * Note that this license only applies on the examples, NFC library itself is under LGPL
- *
- */
- /**
- * @file nfc-utils.c
- * @brief Provide some examples shared functions like print, parity calculation, options parsing.
- */
- #include <nfc/nfc.h>
- #include <err.h>
-
- #include "nfc-utils.h"
-
- uint8_t
- oddparity(const uint8_t bt)
- {
- // cf http://graphics.stanford.edu/~seander/bithacks.html#ParityParallel
- return (0x9669 >> ((bt ^(bt >> 4)) & 0xF)) & 1;
- }
-
- void
- oddparity_bytes_ts(const uint8_t *pbtData, const size_t szLen, uint8_t *pbtPar)
- {
- size_t szByteNr;
- // Calculate the parity bits for the command
- for (szByteNr = 0; szByteNr < szLen; szByteNr++) {
- pbtPar[szByteNr] = oddparity(pbtData[szByteNr]);
- }
- }
-
- void
- print_hex(const uint8_t *pbtData, const size_t szBytes)
- {
- size_t szPos;
-
- for (szPos = 0; szPos < szBytes; szPos++) {
- printf("%02x ", pbtData[szPos]);
- }
- printf("\n");
- }
-
- void
- print_hex_bits(const uint8_t *pbtData, const size_t szBits)
- {
- uint8_t uRemainder;
- size_t szPos;
- size_t szBytes = szBits / 8;
-
- for (szPos = 0; szPos < szBytes; szPos++) {
- printf("%02x ", pbtData[szPos]);
- }
-
- uRemainder = szBits % 8;
- // Print the rest bits
- if (uRemainder != 0) {
- if (uRemainder < 5)
- printf("%01x (%d bits)", pbtData[szBytes], uRemainder);
- else
- printf("%02x (%d bits)", pbtData[szBytes], uRemainder);
- }
- printf("\n");
- }
-
- void
- print_hex_par(const uint8_t *pbtData, const size_t szBits, const uint8_t *pbtDataPar)
- {
- uint8_t uRemainder;
- size_t szPos;
- size_t szBytes = szBits / 8;
-
- for (szPos = 0; szPos < szBytes; szPos++) {
- printf("%02x", pbtData[szPos]);
- if (oddparity(pbtData[szPos]) != pbtDataPar[szPos]) {
- printf("! ");
- } else {
- printf(" ");
- }
- }
-
- uRemainder = szBits % 8;
- // Print the rest bits, these cannot have parity bit
- if (uRemainder != 0) {
- if (uRemainder < 5)
- printf("%01x (%d bits)", pbtData[szBytes], uRemainder);
- else
- printf("%02x (%d bits)", pbtData[szBytes], uRemainder);
- }
- printf("\n");
- }
-
- void
- print_nfc_target(const nfc_target *pnt, bool verbose)
- {
- char *s;
- str_nfc_target(&s, pnt, verbose);
- printf("%s", s);
- nfc_free(s);
- }
|