int test_04(struct llc_link *link) { if (activate_link(link) < 0) { fprintf(stderr, "Cannot activate link\n"); return 1; } struct llc_service *service; service = llc_service_new(NULL, test_03_service, NULL); int sap = llc_link_service_bind(link, service, 19); struct llc_connection *con = llc_outgoing_data_link_connection_new_by_uri(link, sap, "urn:nfc:sn:co-echo"); if (!con) return 1; if (llc_connection_connect(con) < 0) return 1; sleep(5); printf("===> Disconnecting\n"); if (llcp_disconnect(link) < 0) return 1; printf("===> Deactivating link\n"); llc_link_deactivate(link); return 0; }
int test_02(struct llc_link *link) { if (activate_link(link) < 0) { fprintf(stderr, "Cannot activate link\n"); return 1; } struct llc_service *service = llc_service_new(NULL, test_02_service, NULL); int sap = llc_link_service_bind(link, service, 16); uint8_t buffer[] = "Hello World!"; if (llc_link_send_data(link, sap, 16, buffer, sizeof(buffer)) < 0) return 1; sleep(1); printf("===> Disconnecting\n"); if (llcp_disconnect(link) < 0) return 1; printf("===> Deactivating link\n"); llc_link_deactivate(link); return 0; }
int snepClientThread :: init(nfc_device **device) { pnd = *device; if (llcp_init() < 0){ qDebug() << "llcp_init() failed."; return -1; } llc_link = llc_link_new(); if (!llc_link) { qDebug() << "Cannot allocate LLC link data structures"; } mac_link = mac_link_new(pnd, llc_link); if (!mac_link){ qDebug() << "Cannot create MAC link"; return -1; } struct llc_service *com_android_npp; if (!(com_android_npp = llc_service_new(NULL, snepService, NULL))){ qDebug() << "Cannot create com.android.npp service"; return -1; } llc_service_set_miu(com_android_npp, 512); llc_service_set_rw(com_android_npp, 2); int sap; if ((sap = llc_link_service_bind(llc_link, com_android_npp, 0x20)) < 0){ qDebug() << "Cannot create com.android.npp service"; return -1; } con = llc_outgoing_data_link_connection_new(llc_link, sap, LLCP_SNEP_SAP); if (!con){ qDebug() << "Connection created failed."; return -1; } qDebug() << "snep: flag set true"; flag = true; return 0; }
int snepServerThread :: init(nfc_device **device) { pnd = *device; if (llcp_init() < 0) { qDebug() << "llcp_init() failed."; return -1; } llc_link = llc_link_new(); if (!llc_link) { qDebug() << "Cannot allocate LLC link data structures"; return -1; } /** initial LLCP service struct */ struct llc_service *com_android_snep; if (!(com_android_snep = llc_service_new_with_uri(NULL, snepService, (char *)"urn:nfc:sn:snep", NULL))) { qDebug() << "Cannot create com.android.snep service"; } llc_service_set_miu(com_android_snep, 512); llc_service_set_rw(com_android_snep, 2); if (llc_link_service_bind(llc_link, com_android_snep, LLCP_SNEP_SAP) < 0) { qDebug() << "Cannot bind service"; } mac_link = mac_link_new(pnd, llc_link); if (!mac_link) { qDebug() << "Cannot create MAC link"; return -1; } qDebug() << "snep: flag set true"; flag = true; return 0; }
void test_llc_link_find_sap_by_uri(void) { struct llc_link *link; int res; link = llc_link_new(); cut_assert_not_null(link, cut_message("llc_link_new()")); struct llc_service *service = llc_service_new_with_uri(NULL, void_service, "urn:nfc:xsn:foo", NULL); res = llc_link_service_bind(link, service, -1); cut_assert_not_equal_int(-1, res, cut_message("llc_link_service_bind()")); uint8_t sap = llc_link_find_sap_by_uri(link, "urn:nfc:xsn:foo"); cut_assert_not_equal_int(0, sap, cut_message("llc_link_find_sap_by_uri()")); cut_assert_equal_int(res, sap, cut_message("Wrong SAP")); llc_link_service_unbind(link, service->sap); sap = llc_link_find_sap_by_uri(link, "urn:nfc:xsn:foo"); cut_assert_equal_int(0, sap, cut_message("llc_link_find_sap_by_uri()")); llc_service_free(service); llc_link_free(link); }
int main(int argc, char *argv[]) { (void)argc; (void)argv; nfc_context *context; nfc_init(&context); if (llcp_init() < 0) errx(EXIT_FAILURE, "llcp_init()"); signal(SIGINT, stop_mac_link); atexit(bye); if (!(device = nfc_open(context, NULL))) { errx(EXIT_FAILURE, "Cannot connect to NFC device"); } struct llc_link *llc_link = llc_link_new(); if (!llc_link) { errx(EXIT_FAILURE, "Cannot allocate LLC link data structures"); } mac_link = mac_link_new(device, llc_link); if (!mac_link){ errx(EXIT_FAILURE, "Cannot create MAC link"); } struct llc_service *com_android_npp; if (!(com_android_npp = llc_service_new(NULL, com_android_snep_service, NULL))){ errx(EXIT_FAILURE, "Cannot create com.android.npp service"); } llc_service_set_miu(com_android_npp, 512); llc_service_set_rw(com_android_npp, 2); int sap; if ((sap = llc_link_service_bind(llc_link, com_android_npp, 0x20)) < 0) errx(EXIT_FAILURE, "Cannot bind service"); // struct llc_connection *con = llc_outgoing_data_link_connection_new_by_uri(llc_link, sap, "urn:nfc:sn:snep"); struct llc_connection *con = llc_outgoing_data_link_connection_new(llc_link, sap, LLCP_SNEP_SAP); if (!con){ errx(EXIT_FAILURE, "Cannot create llc_connection"); } if (mac_link_activate_as_initiator(mac_link) < 0) { errx(EXIT_FAILURE, "Cannot activate MAC link"); } if (llc_connection_connect(con) < 0) errx(EXIT_FAILURE, "Cannot connect llc_connection"); llc_connection_wait(con, NULL); llc_link_deactivate(llc_link); mac_link_free(mac_link); llc_link_free(llc_link); nfc_close(device); device = NULL; llcp_fini(); nfc_exit(context); exit(EXIT_SUCCESS); }
int main (int argc, char *argv[]) { nfc_init(&context); if (context == NULL) { printf("Unable to init libnfc (malloc)"); exit(EXIT_FAILURE); } if (llcp_init () < 0) errx (EXIT_FAILURE, "llcp_init()"); llcp_log_log("[nfc-p2p-demo.c]", LLC_PRIORITY_WARN, "This is a test warning message"); llcp_log_log("[nfc-p2p-demo.c]", LLC_PRIORITY_FATAL, "This is a test fatal message"); llcp_log_log("[nfc-p2p-demo.c]", LLC_PRIORITY_TRACE, "This is a test trace message"); llcp_log_log("[nfc-p2p-demo.c]", LLC_PRIORITY_DEBUG, "This is a test debug message"); llcp_log_log("[nfc-p2p-demo.c]", LLC_PRIORITY_ERROR, "This is a test error message"); int res; //Auto probe for nfc device /* nfc_connstring device_connstring[1]; res = nfc_list_devices (NULL, device_connstring, 1); if (res < 1) errx (EXIT_FAILURE, "Sorry, no NFC device found"); //Create nfc_device nfc_device *device; if (!(device = nfc_open (NULL, device_connstring[0]))) { errx (EXIT_FAILURE, "Cannot connect to NFC device"); } */ //Create nfc_device nfc_device *device; //if (!(device = nfc_open (NULL, device_connstring[0]))) { //if (!(device = nfc_open (NULL, "pn532_uart:/dev/ttyUSB0:115200"))) { if (!(device = nfc_open (context, NULL))) { errx (EXIT_FAILURE, "Cannot connect to NFC device"); } //Create llc_link struct llc_link *my_llc_link = llc_link_new (); struct llc_service *snep_service; //Create receiving service! if (!(snep_service = llc_service_new_with_uri (NULL, snep_service_thread, LLCP_SNEP_URI, NULL))) errx (EXIT_FAILURE, "Cannot create snep service"); //Bind llc_service to llc_link if (llc_link_service_bind (my_llc_link, snep_service, LLCP_SNEP_SAP) < 0) { errx (EXIT_FAILURE, "llc_service_new_with_uri()"); } //Create mac_link struct mac_link *my_mac_link = mac_link_new (device, my_llc_link); if (!my_mac_link) errx (EXIT_FAILURE, "Cannot establish MAC link"); //Active mac_link as initiator res = mac_link_activate_as_initiator(my_mac_link); if (res <= 0) errx (EXIT_FAILURE, "Cannot activate link"); //Wait for mac_link to finish void *status; mac_link_wait (my_mac_link, &status); printf ("STATUS = %p\n", status); mac_link_free (my_mac_link); llc_link_free (my_llc_link); nfc_close (device); llcp_fini (); nfc_exit(context); exit(EXIT_SUCCESS); }
void dummy_mac_transport(struct llc_link *initiator, struct llc_link *target) { int n; char buffer[1024]; for (;;) { struct timespec ts = { .tv_sec = 0, .tv_nsec = 10000, }; n = mq_timedreceive(initiator->llc_down, buffer, sizeof(buffer), NULL, &ts); if (n < 0) { if (errno == ETIMEDOUT) { n = 2; buffer[0] = buffer[1] = 0x00; } else break; } pthread_testcancel(); n = mq_send(target->llc_up, buffer, n, 0); if (n < 0) break; pthread_testcancel(); n = mq_timedreceive(target->llc_down, buffer, sizeof(buffer), NULL, &ts); if (n < 0) { if (errno == ETIMEDOUT) { n = 2; buffer[0] = buffer[1] = 0x00; } else break; } pthread_testcancel(); n = mq_send(initiator->llc_up, buffer, n, 0); if (n < 0) break; pthread_testcancel(); } } void * dummy_mac_transport_thread(void *arg) { struct dummy_mac_transport_endpoints *eps = (struct dummy_mac_transport_endpoints *)arg; dummy_mac_transport(eps->initiator, eps->target); return NULL; } void test_dummy_mac_link(void) { int res; struct llc_link *initiator, *target; struct llc_service *service; struct mac_link mac_initiator, mac_target; initiator = llc_link_new(); cut_assert_not_null(initiator, cut_message("llc_link_new()")); target = llc_link_new(); cut_assert_not_null(target, cut_message("llc_link_new()")); initiator->cut_test_context = cut_get_current_test_context(); service = llc_service_new(NULL, echo_service, NULL); cut_assert_not_null(service, cut_message("llc_service_new()")); res = llc_link_service_bind(initiator, service, ECHO_SAP); cut_assert_equal_int(ECHO_SAP, res, cut_message("llc_link_service_bind()")); res = llc_link_activate(initiator, LLC_INITIATOR | LLC_PAX_PDU_PROHIBITED, NULL, 0); cut_assert_equal_int(0, res, cut_message("llc_link_activate()")); res = llc_link_activate(target, LLC_TARGET | LLC_PAX_PDU_PROHIBITED, NULL, 0); cut_assert_equal_int(0, res, cut_message("llc_link_activate()")); char buffer[1024]; pthread_t transport; struct dummy_mac_transport_endpoints eps = { .initiator = initiator, .target = target, }; pthread_create(&transport, NULL, dummy_mac_transport_thread, &eps); mac_initiator.exchange_pdus_thread = &transport; mac_target.exchange_pdus_thread = &transport; //initiator->mac_link = &mac_initiator; //target->mac_link = &mac_target; buffer[0] = ECHO_SAP << 2; buffer[1] = '\xC0'; buffer[2] = 'H'; buffer[3] = 'e'; buffer[4] = 'l'; buffer[5] = 'l'; buffer[6] = 'o'; res = mq_send(initiator->llc_up, buffer, 7, 0); cut_assert_equal_int(0, res, cut_message("mq_send")); struct timespec ts = { .tv_sec = time(NULL) + 2, .tv_nsec = 0, }; int old_cancelstate; pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, &old_cancelstate); res = sem_timedwait(sem_cutter, &ts); cut_assert_equal_int(0, res, cut_message("Message not received")); pthread_setcancelstate(old_cancelstate, NULL); pthread_cancel(transport); //pthread_kill (transport, SIGUSR1); pthread_join(transport, NULL); llc_link_deactivate(initiator); llc_link_deactivate(target); llc_link_free(initiator); llc_link_free(target); }