libfreefare/examples/mifare-desfire-access.c

#include <err.h>
#include <errno.h>
#include <stdlib.h>
#include <string.h>

#include <nfc/nfc.h>

#include <freefare.h>

uint8_t key_data_null[8]  = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };

int
main(int argc, char *argv[])
{
    int error = EXIT_SUCCESS;
    nfc_device *device = NULL;
    FreefareTag *tags = NULL;

    if (argc > 1)
	errx(EXIT_FAILURE, "usage: %s", argv[0]);

    nfc_connstring devices[8];
    size_t device_count;

    nfc_context *context;
    nfc_init(&context);
    if (context == NULL)
	errx(EXIT_FAILURE, "Unable to init libnfc (malloc)");

    device_count = nfc_list_devices(context, devices, 8);
    if (device_count <= 0)
	errx(EXIT_FAILURE, "No NFC device found.");

    for (size_t d = 0; d < device_count; d++) {
	device = nfc_open(context, devices[d]);
	if (!device) {
	    warnx("nfc_open() failed.");
	    error = EXIT_FAILURE;
	    continue;
	}

	tags = freefare_get_tags(device);
	if (!tags) {
	    nfc_close(device);
	    errx(EXIT_FAILURE, "Error listing tags.");
	}

	for (int i = 0; (!error) && tags[i]; i++) {
	    if (MIFARE_DESFIRE != freefare_get_tag_type(tags[i]))
		continue;

	    int res;
	    char *tag_uid = freefare_get_tag_uid(tags[i]);

	    res = mifare_desfire_connect(tags[i]);
	    if (res < 0) {
		warnx("Can't connect to Mifare DESFire target.");
		error = EXIT_FAILURE;
		break;
	    }


	    MifareDESFireKey key = mifare_desfire_des_key_new_with_version(key_data_null);
	    res = mifare_desfire_authenticate(tags[i], 0, key);
	    if (res < 0)
		errx(EXIT_FAILURE, "Authentication on master application failed");

	    MadAid mad_aid = { 0x12, 0x34 };
	    MifareDESFireAID aid = mifare_desfire_aid_new_with_mad_aid(mad_aid, 0x5);
	    res = mifare_desfire_create_application(tags[i], aid, 0xFF, 0x1);
	    if (res < 0)
		errx(EXIT_FAILURE, "Application creation failed");

	    res = mifare_desfire_select_application(tags[i], aid);
	    if (res < 0)
		errx(EXIT_FAILURE, "Application selection failed");

	    res = mifare_desfire_authenticate(tags[i], 0, key);
	    if (res < 0)
		errx(EXIT_FAILURE, "Authentication on application failed");

	    res = mifare_desfire_create_std_data_file(tags[i], 1, MDCM_ENCIPHERED, 0x0000, 20);
	    if (res < 0)
		errx(EXIT_FAILURE, "File creation failed");

	    const char *s = "Hello World";
	    res = mifare_desfire_write_data(tags[i], 1, 0, strlen(s), s);
	    if (res < 0)
		errx(EXIT_FAILURE, "File write failed");

	    char buffer[20];
	    res = mifare_desfire_read_data(tags[i], 1, 0, 0, buffer);
	    if (res < 0)
		errx(EXIT_FAILURE, "File read failed");

	    res = mifare_desfire_select_application(tags[i], NULL);
	    if (res < 0)
		errx(EXIT_FAILURE, "Master application selection failed");

	    res = mifare_desfire_authenticate(tags[i], 0, key);
	    if (res < 0)
		errx(EXIT_FAILURE, "Authentication on master application failed");

	    res = mifare_desfire_format_picc(tags[i]);
	    if (res < 0)
		errx(EXIT_FAILURE, "PICC format failed");

	    mifare_desfire_key_free(key);
	    free(tag_uid);
	    free(aid);

	    mifare_desfire_disconnect(tags[i]);
	}

	freefare_free_tags(tags);
	nfc_close(device);
    }
    nfc_exit(context);
    exit(error);
} /* main() */