129 lines
3.8 KiB
C
129 lines
3.8 KiB
C
/*-
|
|
* 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);
|
|
}
|