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);
}
