New connstring_decode() fix cppcheck warning "Non reentrant function 'strtok' called"
This commit is contained in:
parent
59271d27e9
commit
cc03f84636
8 changed files with 140 additions and 290 deletions
|
@ -191,49 +191,14 @@ acr122_pcsc_scan(const nfc_context *context, nfc_connstring connstrings[], const
|
||||||
}
|
}
|
||||||
|
|
||||||
struct acr122_pcsc_descriptor {
|
struct acr122_pcsc_descriptor {
|
||||||
char pcsc_device_name[512];
|
char *pcsc_device_name;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
acr122_pcsc_connstring_decode(const nfc_connstring connstring, struct acr122_pcsc_descriptor *desc)
|
|
||||||
{
|
|
||||||
char *cs = malloc(strlen(connstring) + 1);
|
|
||||||
if (!cs) {
|
|
||||||
perror("malloc");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
strcpy(cs, connstring);
|
|
||||||
const char *driver_name = strtok(cs, ":");
|
|
||||||
if (!driver_name) {
|
|
||||||
// Parse error
|
|
||||||
free(cs);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (0 != strcmp(driver_name, ACR122_PCSC_DRIVER_NAME)) {
|
|
||||||
// Driver name does not match.
|
|
||||||
free(cs);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
const char *device_name = strtok(NULL, ":");
|
|
||||||
if (!device_name) {
|
|
||||||
// Only driver name was specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
strncpy(desc->pcsc_device_name, device_name, sizeof(desc->pcsc_device_name) - 1);
|
|
||||||
desc->pcsc_device_name[sizeof(desc->pcsc_device_name) - 1] = '\0';
|
|
||||||
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
|
|
||||||
static nfc_device *
|
static nfc_device *
|
||||||
acr122_pcsc_open(const nfc_context *context, const nfc_connstring connstring)
|
acr122_pcsc_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
{
|
{
|
||||||
struct acr122_pcsc_descriptor ndd;
|
struct acr122_pcsc_descriptor ndd;
|
||||||
int connstring_decode_level = acr122_pcsc_connstring_decode(connstring, &ndd);
|
int connstring_decode_level = connstring_decode(connstring, ACR122_PCSC_DRIVER_NAME, "pcsc", &ndd.pcsc_device_name, NULL);
|
||||||
|
|
||||||
if (connstring_decode_level < 1) {
|
if (connstring_decode_level < 1) {
|
||||||
return NULL;
|
return NULL;
|
||||||
|
@ -245,7 +210,7 @@ acr122_pcsc_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
size_t szDeviceFound = acr122_pcsc_scan(context, &fullconnstring, 1);
|
size_t szDeviceFound = acr122_pcsc_scan(context, &fullconnstring, 1);
|
||||||
if (szDeviceFound < 1)
|
if (szDeviceFound < 1)
|
||||||
return NULL;
|
return NULL;
|
||||||
connstring_decode_level = acr122_pcsc_connstring_decode(fullconnstring, &ndd);
|
connstring_decode_level = connstring_decode(fullconnstring, ACR122_PCSC_DRIVER_NAME, "pcsc", &ndd.pcsc_device_name, NULL);
|
||||||
if (connstring_decode_level < 2) {
|
if (connstring_decode_level < 2) {
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
@ -255,23 +220,29 @@ acr122_pcsc_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
if (strlen(ndd.pcsc_device_name) < 5) { // We can assume it's a reader ID as pcsc_name always ends with "NN NN"
|
if (strlen(ndd.pcsc_device_name) < 5) { // We can assume it's a reader ID as pcsc_name always ends with "NN NN"
|
||||||
// Device was not specified, only ID, retrieve it
|
// Device was not specified, only ID, retrieve it
|
||||||
size_t index;
|
size_t index;
|
||||||
if (sscanf(ndd.pcsc_device_name, "%4" SCNuPTR, &index) != 1)
|
if (sscanf(ndd.pcsc_device_name, "%4" SCNuPTR, &index) != 1) {
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
return NULL;
|
return NULL;
|
||||||
|
}
|
||||||
nfc_connstring *ncs = malloc(sizeof(nfc_connstring) * (index + 1));
|
nfc_connstring *ncs = malloc(sizeof(nfc_connstring) * (index + 1));
|
||||||
if (!ncs) {
|
if (!ncs) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
size_t szDeviceFound = acr122_pcsc_scan(context, ncs, index + 1);
|
size_t szDeviceFound = acr122_pcsc_scan(context, ncs, index + 1);
|
||||||
if (szDeviceFound < index + 1) {
|
if (szDeviceFound < index + 1) {
|
||||||
free(ncs);
|
free(ncs);
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
strncpy(fullconnstring, ncs[index], sizeof(nfc_connstring));
|
strncpy(fullconnstring, ncs[index], sizeof(nfc_connstring));
|
||||||
fullconnstring[sizeof(nfc_connstring) - 1] = '\0';
|
fullconnstring[sizeof(nfc_connstring) - 1] = '\0';
|
||||||
free(ncs);
|
free(ncs);
|
||||||
connstring_decode_level = acr122_pcsc_connstring_decode(fullconnstring, &ndd);
|
connstring_decode_level = connstring_decode(fullconnstring, ACR122_PCSC_DRIVER_NAME, "pcsc", &ndd.pcsc_device_name, NULL);
|
||||||
|
|
||||||
if (connstring_decode_level < 2) {
|
if (connstring_decode_level < 2) {
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -324,12 +295,13 @@ acr122_pcsc_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
|
|
||||||
pn53x_init(pnd);
|
pn53x_init(pnd);
|
||||||
|
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
return pnd;
|
return pnd;
|
||||||
}
|
}
|
||||||
|
|
||||||
error:
|
error:
|
||||||
|
free(ndd.pcsc_device_name);
|
||||||
nfc_device_free(pnd);
|
nfc_device_free(pnd);
|
||||||
|
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -347,50 +347,6 @@ struct acr122_usb_descriptor {
|
||||||
char *filename;
|
char *filename;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
acr122_usb_connstring_decode(const nfc_connstring connstring, struct acr122_usb_descriptor *desc)
|
|
||||||
{
|
|
||||||
int n = strlen(connstring) + 1;
|
|
||||||
char *driver_name = malloc(n);
|
|
||||||
if (!driver_name) {
|
|
||||||
perror("malloc");
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
char *dirname = malloc(n);
|
|
||||||
if (!dirname) {
|
|
||||||
perror("malloc");
|
|
||||||
free(driver_name);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
char *filename = malloc(n);
|
|
||||||
if (!filename) {
|
|
||||||
perror("malloc");
|
|
||||||
free(driver_name);
|
|
||||||
free(dirname);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
driver_name[0] = '\0';
|
|
||||||
|
|
||||||
char format[32];
|
|
||||||
snprintf(format, sizeof(format), "%%%i[^:]:%%%i[^:]:%%%i[^:]", n - 1, n - 1, n - 1);
|
|
||||||
int res = sscanf(connstring, format, driver_name, dirname, filename);
|
|
||||||
|
|
||||||
if (!res || ((0 != strcmp(driver_name, ACR122_USB_DRIVER_NAME)) && (0 != strcmp(driver_name, "usb")))) {
|
|
||||||
// Driver name does not match.
|
|
||||||
res = 0;
|
|
||||||
} else {
|
|
||||||
desc->dirname = strdup(dirname);
|
|
||||||
desc->filename = strdup(filename);
|
|
||||||
}
|
|
||||||
|
|
||||||
free(driver_name);
|
|
||||||
free(dirname);
|
|
||||||
free(filename);
|
|
||||||
|
|
||||||
return res;
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool
|
static bool
|
||||||
acr122_usb_get_usb_device_name(struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len)
|
acr122_usb_get_usb_device_name(struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len)
|
||||||
{
|
{
|
||||||
|
@ -424,7 +380,7 @@ acr122_usb_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
{
|
{
|
||||||
nfc_device *pnd = NULL;
|
nfc_device *pnd = NULL;
|
||||||
struct acr122_usb_descriptor desc = { NULL, NULL };
|
struct acr122_usb_descriptor desc = { NULL, NULL };
|
||||||
int connstring_decode_level = acr122_usb_connstring_decode(connstring, &desc);
|
int connstring_decode_level = connstring_decode(connstring, ACR122_USB_DRIVER_NAME, "usb", &desc.dirname, &desc.filename);
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_DEBUG, "%d element(s) have been decoded from \"%s\"", connstring_decode_level, connstring);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_DEBUG, "%d element(s) have been decoded from \"%s\"", connstring_decode_level, connstring);
|
||||||
if (connstring_decode_level < 1) {
|
if (connstring_decode_level < 1) {
|
||||||
goto free_mem;
|
goto free_mem;
|
||||||
|
|
|
@ -396,59 +396,10 @@ acr122s_get_firmware_version(nfc_device *pnd, char *version, size_t length)
|
||||||
}
|
}
|
||||||
|
|
||||||
struct acr122s_descriptor {
|
struct acr122s_descriptor {
|
||||||
char port[128];
|
char *port;
|
||||||
uint32_t speed;
|
uint32_t speed;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
acr122s_connstring_decode(const nfc_connstring connstring, struct acr122s_descriptor *desc)
|
|
||||||
{
|
|
||||||
char *cs = malloc(strlen(connstring) + 1);
|
|
||||||
if (!cs) {
|
|
||||||
perror("malloc");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
strcpy(cs, connstring);
|
|
||||||
const char *driver_name = strtok(cs, ":");
|
|
||||||
if (!driver_name) {
|
|
||||||
// Parse error
|
|
||||||
free(cs);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (0 != strcmp(driver_name, ACR122S_DRIVER_NAME)) {
|
|
||||||
// Driver name does not match.
|
|
||||||
free(cs);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
const char *port = strtok(NULL, ":");
|
|
||||||
if (!port) {
|
|
||||||
// Only driver name was specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
strncpy(desc->port, port, sizeof(desc->port) - 1);
|
|
||||||
desc->port[sizeof(desc->port) - 1] = '\0';
|
|
||||||
|
|
||||||
const char *speed_s = strtok(NULL, ":");
|
|
||||||
if (!speed_s) {
|
|
||||||
// speed not specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
unsigned long speed;
|
|
||||||
if (sscanf(speed_s, "%10lu", &speed) != 1) {
|
|
||||||
// speed_s is not a number
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
desc->speed = speed;
|
|
||||||
|
|
||||||
free(cs);
|
|
||||||
return 3;
|
|
||||||
}
|
|
||||||
|
|
||||||
static size_t
|
static size_t
|
||||||
acr122s_scan(const nfc_context *context, nfc_connstring connstrings[], const size_t connstrings_len)
|
acr122s_scan(const nfc_context *context, nfc_connstring connstrings[], const size_t connstrings_len)
|
||||||
{
|
{
|
||||||
|
@ -540,6 +491,7 @@ acr122s_close(nfc_device *pnd)
|
||||||
close(DRIVER_DATA(pnd)->abort_fds[1]);
|
close(DRIVER_DATA(pnd)->abort_fds[1]);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
free(DRIVER_DATA(pnd)->port);
|
||||||
pn53x_data_free(pnd);
|
pn53x_data_free(pnd);
|
||||||
nfc_device_free(pnd);
|
nfc_device_free(pnd);
|
||||||
}
|
}
|
||||||
|
@ -550,8 +502,18 @@ acr122s_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
serial_port sp;
|
serial_port sp;
|
||||||
nfc_device *pnd;
|
nfc_device *pnd;
|
||||||
struct acr122s_descriptor ndd;
|
struct acr122s_descriptor ndd;
|
||||||
int connstring_decode_level = acr122s_connstring_decode(connstring, &ndd);
|
char *speed_s;
|
||||||
|
int connstring_decode_level = connstring_decode(connstring, ACR122S_DRIVER_NAME, NULL, &ndd.port, &speed_s);
|
||||||
|
if (connstring_decode_level == 3) {
|
||||||
|
ndd.speed = 0;
|
||||||
|
if (sscanf(speed_s, "%10"PRIu32, &ndd.speed) != 1) {
|
||||||
|
// speed_s is not a number
|
||||||
|
free(ndd.port);
|
||||||
|
free(speed_s);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
free(speed_s);
|
||||||
|
}
|
||||||
if (connstring_decode_level < 2) {
|
if (connstring_decode_level < 2) {
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
@ -566,11 +528,13 @@ acr122s_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
if (sp == INVALID_SERIAL_PORT) {
|
if (sp == INVALID_SERIAL_PORT) {
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR,
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR,
|
||||||
"Invalid serial port: %s", ndd.port);
|
"Invalid serial port: %s", ndd.port);
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
if (sp == CLAIMED_SERIAL_PORT) {
|
if (sp == CLAIMED_SERIAL_PORT) {
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR,
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR,
|
||||||
"Serial port already claimed: %s", ndd.port);
|
"Serial port already claimed: %s", ndd.port);
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -580,6 +544,7 @@ acr122s_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
pnd = nfc_device_new(context, connstring);
|
pnd = nfc_device_new(context, connstring);
|
||||||
if (!pnd) {
|
if (!pnd) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
acr122s_close(pnd);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
pnd->driver = &acr122s_driver;
|
pnd->driver = &acr122s_driver;
|
||||||
|
@ -597,6 +562,7 @@ acr122s_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
|
|
||||||
#ifndef WIN32
|
#ifndef WIN32
|
||||||
if (pipe(DRIVER_DATA(pnd)->abort_fds) < 0) {
|
if (pipe(DRIVER_DATA(pnd)->abort_fds) < 0) {
|
||||||
|
acr122s_close(pnd);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
|
|
|
@ -165,59 +165,10 @@ arygon_scan(const nfc_context *context, nfc_connstring connstrings[], const size
|
||||||
}
|
}
|
||||||
|
|
||||||
struct arygon_descriptor {
|
struct arygon_descriptor {
|
||||||
char port[128];
|
char *port;
|
||||||
uint32_t speed;
|
uint32_t speed;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
arygon_connstring_decode(const nfc_connstring connstring, struct arygon_descriptor *desc)
|
|
||||||
{
|
|
||||||
char *cs = malloc(strlen(connstring) + 1);
|
|
||||||
if (!cs) {
|
|
||||||
perror("malloc");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
strcpy(cs, connstring);
|
|
||||||
const char *driver_name = strtok(cs, ":");
|
|
||||||
if (!driver_name) {
|
|
||||||
// Parse error
|
|
||||||
free(cs);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (0 != strcmp(driver_name, ARYGON_DRIVER_NAME)) {
|
|
||||||
// Driver name does not match.
|
|
||||||
free(cs);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
const char *port = strtok(NULL, ":");
|
|
||||||
if (!port) {
|
|
||||||
// Only driver name was specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
strncpy(desc->port, port, sizeof(desc->port) - 1);
|
|
||||||
desc->port[sizeof(desc->port) - 1] = '\0';
|
|
||||||
|
|
||||||
const char *speed_s = strtok(NULL, ":");
|
|
||||||
if (!speed_s) {
|
|
||||||
// speed not specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
unsigned long speed;
|
|
||||||
if (sscanf(speed_s, "%10lu", &speed) != 1) {
|
|
||||||
// speed_s is not a number
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
desc->speed = speed;
|
|
||||||
|
|
||||||
free(cs);
|
|
||||||
return 3;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
static void
|
||||||
arygon_close(nfc_device *pnd)
|
arygon_close(nfc_device *pnd)
|
||||||
{
|
{
|
||||||
|
@ -232,6 +183,7 @@ arygon_close(nfc_device *pnd)
|
||||||
close(DRIVER_DATA(pnd)->iAbortFds[1]);
|
close(DRIVER_DATA(pnd)->iAbortFds[1]);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
free(DRIVER_DATA(pnd)->port);
|
||||||
pn53x_data_free(pnd);
|
pn53x_data_free(pnd);
|
||||||
nfc_device_free(pnd);
|
nfc_device_free(pnd);
|
||||||
}
|
}
|
||||||
|
@ -240,8 +192,18 @@ static nfc_device *
|
||||||
arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
{
|
{
|
||||||
struct arygon_descriptor ndd;
|
struct arygon_descriptor ndd;
|
||||||
int connstring_decode_level = arygon_connstring_decode(connstring, &ndd);
|
char *speed_s;
|
||||||
|
int connstring_decode_level = connstring_decode(connstring, ARYGON_DRIVER_NAME, NULL, &ndd.port, &speed_s);
|
||||||
|
if (connstring_decode_level == 3) {
|
||||||
|
ndd.speed = 0;
|
||||||
|
if (sscanf(speed_s, "%10"PRIu32, &ndd.speed) != 1) {
|
||||||
|
// speed_s is not a number
|
||||||
|
free(ndd.port);
|
||||||
|
free(speed_s);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
free(speed_s);
|
||||||
|
}
|
||||||
if (connstring_decode_level < 2) {
|
if (connstring_decode_level < 2) {
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
@ -258,8 +220,10 @@ arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Invalid serial port: %s", ndd.port);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Invalid serial port: %s", ndd.port);
|
||||||
if (sp == CLAIMED_SERIAL_PORT)
|
if (sp == CLAIMED_SERIAL_PORT)
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Serial port already claimed: %s", ndd.port);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Serial port already claimed: %s", ndd.port);
|
||||||
if ((sp == CLAIMED_SERIAL_PORT) || (sp == INVALID_SERIAL_PORT))
|
if ((sp == CLAIMED_SERIAL_PORT) || (sp == INVALID_SERIAL_PORT)) {
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
// We need to flush input to be sure first reply does not comes from older byte transceive
|
// We need to flush input to be sure first reply does not comes from older byte transceive
|
||||||
uart_flush_input(sp);
|
uart_flush_input(sp);
|
||||||
|
@ -269,6 +233,7 @@ arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
pnd = nfc_device_new(context, connstring);
|
pnd = nfc_device_new(context, connstring);
|
||||||
if (!pnd) {
|
if (!pnd) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
snprintf(pnd->name, sizeof(pnd->name), "%s:%s", ARYGON_DRIVER_NAME, ndd.port);
|
snprintf(pnd->name, sizeof(pnd->name), "%s:%s", ARYGON_DRIVER_NAME, ndd.port);
|
||||||
|
@ -276,6 +241,7 @@ arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
pnd->driver_data = malloc(sizeof(struct arygon_data));
|
pnd->driver_data = malloc(sizeof(struct arygon_data));
|
||||||
if (!pnd->driver_data) {
|
if (!pnd->driver_data) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
DRIVER_DATA(pnd)->port = sp;
|
DRIVER_DATA(pnd)->port = sp;
|
||||||
|
@ -293,6 +259,7 @@ arygon_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
#ifndef WIN32
|
#ifndef WIN32
|
||||||
// pipe-based abort mecanism
|
// pipe-based abort mecanism
|
||||||
if (pipe(DRIVER_DATA(pnd)->iAbortFds) < 0) {
|
if (pipe(DRIVER_DATA(pnd)->iAbortFds) < 0) {
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
|
|
|
@ -142,59 +142,10 @@ pn532_uart_scan(const nfc_context *context, nfc_connstring connstrings[], const
|
||||||
}
|
}
|
||||||
|
|
||||||
struct pn532_uart_descriptor {
|
struct pn532_uart_descriptor {
|
||||||
char port[128];
|
char *port;
|
||||||
uint32_t speed;
|
uint32_t speed;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
pn532_connstring_decode(const nfc_connstring connstring, struct pn532_uart_descriptor *desc)
|
|
||||||
{
|
|
||||||
char *cs = malloc(strlen(connstring) + 1);
|
|
||||||
if (!cs) {
|
|
||||||
perror("malloc");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
strcpy(cs, connstring);
|
|
||||||
const char *driver_name = strtok(cs, ":");
|
|
||||||
if (!driver_name) {
|
|
||||||
// Parse error
|
|
||||||
free(cs);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (0 != strcmp(driver_name, PN532_UART_DRIVER_NAME)) {
|
|
||||||
// Driver name does not match.
|
|
||||||
free(cs);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
const char *port = strtok(NULL, ":");
|
|
||||||
if (!port) {
|
|
||||||
// Only driver name was specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
strncpy(desc->port, port, sizeof(desc->port) - 1);
|
|
||||||
desc->port[sizeof(desc->port) - 1] = '\0';
|
|
||||||
|
|
||||||
const char *speed_s = strtok(NULL, ":");
|
|
||||||
if (!speed_s) {
|
|
||||||
// speed not specified (or parsing error)
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
unsigned long speed;
|
|
||||||
if (sscanf(speed_s, "%10lu", &speed) != 1) {
|
|
||||||
// speed_s is not a number
|
|
||||||
free(cs);
|
|
||||||
return 2;
|
|
||||||
}
|
|
||||||
desc->speed = speed;
|
|
||||||
|
|
||||||
free(cs);
|
|
||||||
return 3;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
static void
|
||||||
pn532_uart_close(nfc_device *pnd)
|
pn532_uart_close(nfc_device *pnd)
|
||||||
{
|
{
|
||||||
|
@ -209,6 +160,7 @@ pn532_uart_close(nfc_device *pnd)
|
||||||
close(DRIVER_DATA(pnd)->iAbortFds[1]);
|
close(DRIVER_DATA(pnd)->iAbortFds[1]);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
free(DRIVER_DATA(pnd)->port);
|
||||||
pn53x_data_free(pnd);
|
pn53x_data_free(pnd);
|
||||||
nfc_device_free(pnd);
|
nfc_device_free(pnd);
|
||||||
}
|
}
|
||||||
|
@ -217,8 +169,18 @@ static nfc_device *
|
||||||
pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
{
|
{
|
||||||
struct pn532_uart_descriptor ndd;
|
struct pn532_uart_descriptor ndd;
|
||||||
int connstring_decode_level = pn532_connstring_decode(connstring, &ndd);
|
char *speed_s;
|
||||||
|
int connstring_decode_level = connstring_decode(connstring, PN532_UART_DRIVER_NAME, NULL, &ndd.port, &speed_s);
|
||||||
|
if (connstring_decode_level == 3) {
|
||||||
|
ndd.speed = 0;
|
||||||
|
if (sscanf(speed_s, "%10"PRIu32, &ndd.speed) != 1) {
|
||||||
|
// speed_s is not a number
|
||||||
|
free(ndd.port);
|
||||||
|
free(speed_s);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
free(speed_s);
|
||||||
|
}
|
||||||
if (connstring_decode_level < 2) {
|
if (connstring_decode_level < 2) {
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
@ -235,9 +197,10 @@ pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Invalid serial port: %s", ndd.port);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Invalid serial port: %s", ndd.port);
|
||||||
if (sp == CLAIMED_SERIAL_PORT)
|
if (sp == CLAIMED_SERIAL_PORT)
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Serial port already claimed: %s", ndd.port);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_ERROR, "Serial port already claimed: %s", ndd.port);
|
||||||
if ((sp == CLAIMED_SERIAL_PORT) || (sp == INVALID_SERIAL_PORT))
|
if ((sp == CLAIMED_SERIAL_PORT) || (sp == INVALID_SERIAL_PORT)) {
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
|
}
|
||||||
// We need to flush input to be sure first reply does not comes from older byte transceive
|
// We need to flush input to be sure first reply does not comes from older byte transceive
|
||||||
uart_flush_input(sp);
|
uart_flush_input(sp);
|
||||||
uart_set_speed(sp, ndd.speed);
|
uart_set_speed(sp, ndd.speed);
|
||||||
|
@ -246,6 +209,7 @@ pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
pnd = nfc_device_new(context, connstring);
|
pnd = nfc_device_new(context, connstring);
|
||||||
if (!pnd) {
|
if (!pnd) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
snprintf(pnd->name, sizeof(pnd->name), "%s:%s", PN532_UART_DRIVER_NAME, ndd.port);
|
snprintf(pnd->name, sizeof(pnd->name), "%s:%s", PN532_UART_DRIVER_NAME, ndd.port);
|
||||||
|
@ -253,6 +217,7 @@ pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
pnd->driver_data = malloc(sizeof(struct pn532_uart_data));
|
pnd->driver_data = malloc(sizeof(struct pn532_uart_data));
|
||||||
if (!pnd->driver_data) {
|
if (!pnd->driver_data) {
|
||||||
perror("malloc");
|
perror("malloc");
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
DRIVER_DATA(pnd)->port = sp;
|
DRIVER_DATA(pnd)->port = sp;
|
||||||
|
@ -271,6 +236,7 @@ pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
#ifndef WIN32
|
#ifndef WIN32
|
||||||
// pipe-based abort mecanism
|
// pipe-based abort mecanism
|
||||||
if (pipe(DRIVER_DATA(pnd)->iAbortFds) < 0) {
|
if (pipe(DRIVER_DATA(pnd)->iAbortFds) < 0) {
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
|
@ -281,6 +247,7 @@ pn532_uart_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
if (pn53x_check_communication(pnd) < 0) {
|
if (pn53x_check_communication(pnd) < 0) {
|
||||||
nfc_perror(pnd, "pn53x_check_communication");
|
nfc_perror(pnd, "pn53x_check_communication");
|
||||||
pn532_uart_close(pnd);
|
pn532_uart_close(pnd);
|
||||||
|
free(ndd.port);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -232,50 +232,6 @@ struct pn53x_usb_descriptor {
|
||||||
char *filename;
|
char *filename;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int
|
|
||||||
pn53x_usb_connstring_decode(const nfc_connstring connstring, struct pn53x_usb_descriptor *desc)
|
|
||||||
{
|
|
||||||
int n = strlen(connstring) + 1;
|
|
||||||
char *driver_name = malloc(n);
|
|
||||||
if (!driver_name) {
|
|
||||||
perror("malloc");
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
char *dirname = malloc(n);
|
|
||||||
if (!dirname) {
|
|
||||||
perror("malloc");
|
|
||||||
free(driver_name);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
char *filename = malloc(n);
|
|
||||||
if (!filename) {
|
|
||||||
perror("malloc");
|
|
||||||
free(driver_name);
|
|
||||||
free(dirname);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
driver_name[0] = '\0';
|
|
||||||
|
|
||||||
char format[32];
|
|
||||||
snprintf(format, sizeof(format), "%%%i[^:]:%%%i[^:]:%%%i[^:]", n - 1, n - 1, n - 1);
|
|
||||||
int res = sscanf(connstring, format, driver_name, dirname, filename);
|
|
||||||
|
|
||||||
if (!res || ((0 != strcmp(driver_name, PN53X_USB_DRIVER_NAME)) && (0 != strcmp(driver_name, "usb")))) {
|
|
||||||
// Driver name does not match.
|
|
||||||
res = 0;
|
|
||||||
} else {
|
|
||||||
desc->dirname = strdup(dirname);
|
|
||||||
desc->filename = strdup(filename);
|
|
||||||
}
|
|
||||||
|
|
||||||
free(driver_name);
|
|
||||||
free(dirname);
|
|
||||||
free(filename);
|
|
||||||
|
|
||||||
return res;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool
|
bool
|
||||||
pn53x_usb_get_usb_device_name(struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len)
|
pn53x_usb_get_usb_device_name(struct usb_device *dev, usb_dev_handle *udev, char *buffer, size_t len)
|
||||||
{
|
{
|
||||||
|
@ -309,7 +265,7 @@ pn53x_usb_open(const nfc_context *context, const nfc_connstring connstring)
|
||||||
{
|
{
|
||||||
nfc_device *pnd = NULL;
|
nfc_device *pnd = NULL;
|
||||||
struct pn53x_usb_descriptor desc = { NULL, NULL };
|
struct pn53x_usb_descriptor desc = { NULL, NULL };
|
||||||
int connstring_decode_level = pn53x_usb_connstring_decode(connstring, &desc);
|
int connstring_decode_level = connstring_decode(connstring, PN53X_USB_DRIVER_NAME, "usb", &desc.dirname, &desc.filename);
|
||||||
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_DEBUG, "%d element(s) have been decoded from \"%s\"", connstring_decode_level, connstring);
|
log_put(LOG_GROUP, LOG_CATEGORY, NFC_LOG_PRIORITY_DEBUG, "%d element(s) have been decoded from \"%s\"", connstring_decode_level, connstring);
|
||||||
if (connstring_decode_level < 1) {
|
if (connstring_decode_level < 1) {
|
||||||
goto free_mem;
|
goto free_mem;
|
||||||
|
|
|
@ -185,3 +185,67 @@ prepare_initiator_data(const nfc_modulation nm, uint8_t **ppbtInitiatorData, siz
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
connstring_decode(const nfc_connstring connstring, const char *driver_name, const char *bus_name, char **pparam1, char **pparam2)
|
||||||
|
{
|
||||||
|
if (driver_name == NULL) {
|
||||||
|
driver_name = "";
|
||||||
|
}
|
||||||
|
if (bus_name == NULL) {
|
||||||
|
bus_name = "";
|
||||||
|
}
|
||||||
|
int n = strlen(connstring) + 1;
|
||||||
|
char *param0 = malloc(n);
|
||||||
|
if (param0 == NULL) {
|
||||||
|
perror("malloc");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
char *param1 = malloc(n);
|
||||||
|
if (param1 == NULL) {
|
||||||
|
perror("malloc");
|
||||||
|
free(param0);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
char *param2 = malloc(n);
|
||||||
|
if (param2 == NULL) {
|
||||||
|
perror("malloc");
|
||||||
|
free(param0);
|
||||||
|
free(param1);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
char format[32];
|
||||||
|
snprintf(format, sizeof(format), "%%%i[^:]:%%%i[^:]:%%%i[^:]", n - 1, n - 1, n - 1);
|
||||||
|
int res = sscanf(connstring, format, param0, param1, param2);
|
||||||
|
|
||||||
|
if (res < 1 || ((0 != strcmp(param0, driver_name)) &&
|
||||||
|
(bus_name != NULL) &&
|
||||||
|
(0 != strcmp(param0, bus_name)))) {
|
||||||
|
// Driver name does not match.
|
||||||
|
res = 0;
|
||||||
|
}
|
||||||
|
if (pparam1 != NULL) {
|
||||||
|
if (res < 2) {
|
||||||
|
free(param1);
|
||||||
|
*pparam1 = NULL;
|
||||||
|
} else {
|
||||||
|
*pparam1 = param1;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
free(param1);
|
||||||
|
}
|
||||||
|
if (pparam2 != NULL) {
|
||||||
|
if (res < 3) {
|
||||||
|
free(param2);
|
||||||
|
*pparam2 = NULL;
|
||||||
|
} else {
|
||||||
|
*pparam2 = param2;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
free(param2);
|
||||||
|
}
|
||||||
|
free(param0);
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
|
@ -215,4 +215,6 @@ void iso14443_cascade_uid(const uint8_t abtUID[], const size_t szUID, uint8_t *p
|
||||||
|
|
||||||
void prepare_initiator_data(const nfc_modulation nm, uint8_t **ppbtInitiatorData, size_t *pszInitiatorData);
|
void prepare_initiator_data(const nfc_modulation nm, uint8_t **ppbtInitiatorData, size_t *pszInitiatorData);
|
||||||
|
|
||||||
|
int connstring_decode(const nfc_connstring connstring, const char *driver_name, const char *bus_name, char **pparam1, char **pparam2);
|
||||||
|
|
||||||
#endif // __NFC_INTERNAL_H__
|
#endif // __NFC_INTERNAL_H__
|
||||||
|
|
Loading…
Add table
Reference in a new issue