| File: | libcacard/vscclient.c |
| Location: | line 701, column 20 |
| Description: | Null pointer passed as an argument to a 'nonnull' parameter |
| 1 | /* | |||
| 2 | * Tester for VSCARD protocol, client side. | |||
| 3 | * | |||
| 4 | * Can be used with ccid-card-passthru. | |||
| 5 | * | |||
| 6 | * Copyright (c) 2011 Red Hat. | |||
| 7 | * Written by Alon Levy. | |||
| 8 | * | |||
| 9 | * This work is licensed under the terms of the GNU LGPL, version 2.1 or later. | |||
| 10 | * See the COPYING.LIB file in the top-level directory. | |||
| 11 | */ | |||
| 12 | ||||
| 13 | #ifndef _WIN32 | |||
| 14 | #include <netdb.h> | |||
| 15 | #endif | |||
| 16 | #include <glib.h> | |||
| 17 | ||||
| 18 | #include "qemu-common.h" | |||
| 19 | #include "qemu/thread.h" | |||
| 20 | #include "qemu/sockets.h" | |||
| 21 | ||||
| 22 | #include "vscard_common.h" | |||
| 23 | ||||
| 24 | #include "vreader.h" | |||
| 25 | #include "vcard_emul.h" | |||
| 26 | #include "vevent.h" | |||
| 27 | ||||
| 28 | static int verbose; | |||
| 29 | ||||
| 30 | static void | |||
| 31 | print_byte_array( | |||
| 32 | uint8_t *arrBytes, | |||
| 33 | unsigned int nSize | |||
| 34 | ) { | |||
| 35 | int i; | |||
| 36 | for (i = 0; i < nSize; i++) { | |||
| 37 | printf("%02X ", arrBytes[i]); | |||
| 38 | } | |||
| 39 | printf("\n"); | |||
| 40 | } | |||
| 41 | ||||
| 42 | static void | |||
| 43 | print_usage(void) { | |||
| 44 | printf("vscclient [-c <certname> .. -e <emul_args> -d <level>%s] " | |||
| 45 | "<host> <port>\n", | |||
| 46 | #ifdef USE_PASSTHRU | |||
| 47 | " -p"); | |||
| 48 | printf(" -p use passthrough mode\n"); | |||
| 49 | #else | |||
| 50 | ""); | |||
| 51 | #endif | |||
| 52 | vcard_emul_usage(); | |||
| 53 | } | |||
| 54 | ||||
| 55 | static GIOChannel *channel_socket; | |||
| 56 | static GByteArray *socket_to_send; | |||
| 57 | static QemuMutex socket_to_send_lock; | |||
| 58 | static guint socket_tag; | |||
| 59 | ||||
| 60 | static void | |||
| 61 | update_socket_watch(void); | |||
| 62 | ||||
| 63 | static gboolean | |||
| 64 | do_socket_send(GIOChannel *source, | |||
| 65 | GIOCondition condition, | |||
| 66 | gpointer data) | |||
| 67 | { | |||
| 68 | gsize bw; | |||
| 69 | GError *err = NULL((void*)0); | |||
| 70 | ||||
| 71 | g_return_val_if_fail(socket_to_send->len != 0, FALSE)do{ if (socket_to_send->len != 0) { } else { g_return_if_fail_warning (((gchar*) 0), __PRETTY_FUNCTION__, "socket_to_send->len != 0" ); return ((0)); }; }while (0); | |||
| 72 | g_return_val_if_fail(condition & G_IO_OUT, FALSE)do{ if (condition & G_IO_OUT) { } else { g_return_if_fail_warning (((gchar*) 0), __PRETTY_FUNCTION__, "condition & G_IO_OUT" ); return ((0)); }; }while (0); | |||
| 73 | ||||
| 74 | g_io_channel_write_chars(channel_socket, | |||
| 75 | (gchar *)socket_to_send->data, socket_to_send->len, &bw, &err); | |||
| 76 | if (err != NULL((void*)0)) { | |||
| 77 | g_error("Error while sending socket %s", err->message)do { g_log (((gchar*) 0), G_LOG_LEVEL_ERROR, "Error while sending socket %s" , err->message); for (;;) ; } while (0); | |||
| 78 | return FALSE(0); | |||
| 79 | } | |||
| 80 | g_byte_array_remove_range(socket_to_send, 0, bw); | |||
| 81 | ||||
| 82 | if (socket_to_send->len == 0) { | |||
| 83 | update_socket_watch(); | |||
| 84 | return FALSE(0); | |||
| 85 | } | |||
| 86 | return TRUE(!(0)); | |||
| 87 | } | |||
| 88 | ||||
| 89 | static gboolean | |||
| 90 | socket_prepare_sending(gpointer user_data) | |||
| 91 | { | |||
| 92 | update_socket_watch(); | |||
| 93 | ||||
| 94 | return FALSE(0); | |||
| 95 | } | |||
| 96 | ||||
| 97 | static int | |||
| 98 | send_msg( | |||
| 99 | VSCMsgType type, | |||
| 100 | uint32_t reader_id, | |||
| 101 | const void *msg, | |||
| 102 | unsigned int length | |||
| 103 | ) { | |||
| 104 | VSCMsgHeader mhHeader; | |||
| 105 | ||||
| 106 | qemu_mutex_lock(&socket_to_send_lock); | |||
| 107 | ||||
| 108 | if (verbose > 10) { | |||
| 109 | printf("sending type=%d id=%u, len =%u (0x%x)\n", | |||
| 110 | type, reader_id, length, length); | |||
| 111 | } | |||
| 112 | ||||
| 113 | mhHeader.type = htonl(type); | |||
| 114 | mhHeader.reader_id = 0; | |||
| 115 | mhHeader.length = htonl(length); | |||
| 116 | g_byte_array_append(socket_to_send, (guint8 *)&mhHeader, sizeof(mhHeader)); | |||
| 117 | g_byte_array_append(socket_to_send, (guint8 *)msg, length); | |||
| 118 | g_idle_add(socket_prepare_sending, NULL((void*)0)); | |||
| 119 | ||||
| 120 | qemu_mutex_unlock(&socket_to_send_lock); | |||
| 121 | ||||
| 122 | return 0; | |||
| 123 | } | |||
| 124 | ||||
| 125 | static VReader *pending_reader; | |||
| 126 | static QemuMutex pending_reader_lock; | |||
| 127 | static QemuCond pending_reader_condition; | |||
| 128 | ||||
| 129 | #define MAX_ATR_LEN40 40 | |||
| 130 | static void * | |||
| 131 | event_thread(void *arg) | |||
| 132 | { | |||
| 133 | unsigned char atr[MAX_ATR_LEN40]; | |||
| 134 | int atr_len = MAX_ATR_LEN40; | |||
| 135 | VEvent *event = NULL((void*)0); | |||
| 136 | unsigned int reader_id; | |||
| 137 | ||||
| 138 | ||||
| 139 | while (1) { | |||
| 140 | const char *reader_name; | |||
| 141 | ||||
| 142 | event = vevent_wait_next_vevent(); | |||
| 143 | if (event == NULL((void*)0)) { | |||
| 144 | break; | |||
| 145 | } | |||
| 146 | reader_id = vreader_get_id(event->reader); | |||
| 147 | if (reader_id == VSCARD_UNDEFINED_READER_ID0xffffffff && | |||
| 148 | event->type != VEVENT_READER_INSERT) { | |||
| 149 | /* ignore events from readers qemu has rejected */ | |||
| 150 | /* if qemu is still deciding on this reader, wait to see if need to | |||
| 151 | * forward this event */ | |||
| 152 | qemu_mutex_lock(&pending_reader_lock); | |||
| 153 | if (!pending_reader || (pending_reader != event->reader)) { | |||
| 154 | /* wasn't for a pending reader, this reader has already been | |||
| 155 | * rejected by qemu */ | |||
| 156 | qemu_mutex_unlock(&pending_reader_lock); | |||
| 157 | vevent_delete(event); | |||
| 158 | continue; | |||
| 159 | } | |||
| 160 | /* this reader hasn't been told its status from qemu yet, wait for | |||
| 161 | * that status */ | |||
| 162 | while (pending_reader != NULL((void*)0)) { | |||
| 163 | qemu_cond_wait(&pending_reader_condition, &pending_reader_lock); | |||
| 164 | } | |||
| 165 | qemu_mutex_unlock(&pending_reader_lock); | |||
| 166 | /* now recheck the id */ | |||
| 167 | reader_id = vreader_get_id(event->reader); | |||
| 168 | if (reader_id == VSCARD_UNDEFINED_READER_ID0xffffffff) { | |||
| 169 | /* this reader was rejected */ | |||
| 170 | vevent_delete(event); | |||
| 171 | continue; | |||
| 172 | } | |||
| 173 | /* reader was accepted, now forward the event */ | |||
| 174 | } | |||
| 175 | switch (event->type) { | |||
| 176 | case VEVENT_READER_INSERT: | |||
| 177 | /* tell qemu to insert a new CCID reader */ | |||
| 178 | /* wait until qemu has responded to our first reader insert | |||
| 179 | * before we send a second. That way we won't confuse the responses | |||
| 180 | * */ | |||
| 181 | qemu_mutex_lock(&pending_reader_lock); | |||
| 182 | while (pending_reader != NULL((void*)0)) { | |||
| 183 | qemu_cond_wait(&pending_reader_condition, &pending_reader_lock); | |||
| 184 | } | |||
| 185 | pending_reader = vreader_reference(event->reader); | |||
| 186 | qemu_mutex_unlock(&pending_reader_lock); | |||
| 187 | reader_name = vreader_get_name(event->reader); | |||
| 188 | if (verbose > 10) { | |||
| 189 | printf(" READER INSERT: %s\n", reader_name); | |||
| 190 | } | |||
| 191 | send_msg(VSC_ReaderAdd, | |||
| 192 | reader_id, /* currerntly VSCARD_UNDEFINED_READER_ID */ | |||
| 193 | NULL((void*)0), 0 /* TODO reader_name, strlen(reader_name) */); | |||
| 194 | break; | |||
| 195 | case VEVENT_READER_REMOVE: | |||
| 196 | /* future, tell qemu that an old CCID reader has been removed */ | |||
| 197 | if (verbose > 10) { | |||
| 198 | printf(" READER REMOVE: %u\n", reader_id); | |||
| 199 | } | |||
| 200 | send_msg(VSC_ReaderRemove, reader_id, NULL((void*)0), 0); | |||
| 201 | break; | |||
| 202 | case VEVENT_CARD_INSERT: | |||
| 203 | /* get the ATR (intended as a response to a power on from the | |||
| 204 | * reader */ | |||
| 205 | atr_len = MAX_ATR_LEN40; | |||
| 206 | vreader_power_on(event->reader, atr, &atr_len); | |||
| 207 | /* ATR call functions as a Card Insert event */ | |||
| 208 | if (verbose > 10) { | |||
| 209 | printf(" CARD INSERT %u: ", reader_id); | |||
| 210 | print_byte_array(atr, atr_len); | |||
| 211 | } | |||
| 212 | send_msg(VSC_ATR, reader_id, atr, atr_len); | |||
| 213 | break; | |||
| 214 | case VEVENT_CARD_REMOVE: | |||
| 215 | /* Card removed */ | |||
| 216 | if (verbose > 10) { | |||
| 217 | printf(" CARD REMOVE %u:\n", reader_id); | |||
| 218 | } | |||
| 219 | send_msg(VSC_CardRemove, reader_id, NULL((void*)0), 0); | |||
| 220 | break; | |||
| 221 | default: | |||
| 222 | break; | |||
| 223 | } | |||
| 224 | vevent_delete(event); | |||
| 225 | } | |||
| 226 | return NULL((void*)0); | |||
| 227 | } | |||
| 228 | ||||
| 229 | ||||
| 230 | static unsigned int | |||
| 231 | get_id_from_string(char *string, unsigned int default_id) | |||
| 232 | { | |||
| 233 | unsigned int id = atoi(string); | |||
| 234 | ||||
| 235 | /* don't accidentally swith to zero because no numbers have been supplied */ | |||
| 236 | if ((id == 0) && *string != '0') { | |||
| 237 | return default_id; | |||
| 238 | } | |||
| 239 | return id; | |||
| 240 | } | |||
| 241 | ||||
| 242 | static int | |||
| 243 | on_host_init(VSCMsgHeader *mhHeader, VSCMsgInit *incoming) | |||
| 244 | { | |||
| 245 | uint32_t *capabilities = (incoming->capabilities); | |||
| 246 | int num_capabilities = | |||
| 247 | 1 + ((mhHeader->length - sizeof(VSCMsgInit)) / sizeof(uint32_t)); | |||
| 248 | int i; | |||
| 249 | QemuThread thread_id; | |||
| 250 | ||||
| 251 | incoming->version = ntohl(incoming->version); | |||
| 252 | if (incoming->version != VSCARD_VERSION((0 << (10 + 11)) | (0 << 10) | (2))) { | |||
| 253 | if (verbose > 0) { | |||
| 254 | printf("warning: host has version %d, we have %d\n", | |||
| 255 | verbose, VSCARD_VERSION((0 << (10 + 11)) | (0 << 10) | (2))); | |||
| 256 | } | |||
| 257 | } | |||
| 258 | if (incoming->magic != VSCARD_MAGIC(*(uint32_t *)"VSCD")) { | |||
| 259 | printf("unexpected magic: got %d, expected %d\n", | |||
| 260 | incoming->magic, VSCARD_MAGIC(*(uint32_t *)"VSCD")); | |||
| 261 | return -1; | |||
| 262 | } | |||
| 263 | for (i = 0 ; i < num_capabilities; ++i) { | |||
| 264 | capabilities[i] = ntohl(capabilities[i]); | |||
| 265 | } | |||
| 266 | /* Future: check capabilities */ | |||
| 267 | /* remove whatever reader might be left in qemu, | |||
| 268 | * in case of an unclean previous exit. */ | |||
| 269 | send_msg(VSC_ReaderRemove, VSCARD_MINIMAL_READER_ID0, NULL((void*)0), 0); | |||
| 270 | /* launch the event_thread. This will trigger reader adds for all the | |||
| 271 | * existing readers */ | |||
| 272 | qemu_thread_create(&thread_id, event_thread, NULL((void*)0), 0); | |||
| 273 | return 0; | |||
| 274 | } | |||
| 275 | ||||
| 276 | ||||
| 277 | enum { | |||
| 278 | STATE_HEADER, | |||
| 279 | STATE_MESSAGE, | |||
| 280 | }; | |||
| 281 | ||||
| 282 | #define APDUBufSize270 270 | |||
| 283 | ||||
| 284 | static gboolean | |||
| 285 | do_socket_read(GIOChannel *source, | |||
| 286 | GIOCondition condition, | |||
| 287 | gpointer data) | |||
| 288 | { | |||
| 289 | int rv; | |||
| 290 | int dwSendLength; | |||
| 291 | int dwRecvLength; | |||
| 292 | uint8_t pbRecvBuffer[APDUBufSize270]; | |||
| 293 | static uint8_t pbSendBuffer[APDUBufSize270]; | |||
| 294 | VReaderStatus reader_status; | |||
| 295 | VReader *reader = NULL((void*)0); | |||
| 296 | static VSCMsgHeader mhHeader; | |||
| 297 | VSCMsgError *error_msg; | |||
| 298 | GError *err = NULL((void*)0); | |||
| 299 | ||||
| 300 | static gchar *buf; | |||
| 301 | static gsize br, to_read; | |||
| 302 | static int state = STATE_HEADER; | |||
| 303 | ||||
| 304 | if (state == STATE_HEADER && to_read == 0) { | |||
| 305 | buf = (gchar *)&mhHeader; | |||
| 306 | to_read = sizeof(mhHeader); | |||
| 307 | } | |||
| 308 | ||||
| 309 | if (to_read > 0) { | |||
| 310 | g_io_channel_read_chars(source, (gchar *)buf, to_read, &br, &err); | |||
| 311 | if (err != NULL((void*)0)) { | |||
| 312 | g_error("error while reading: %s", err->message)do { g_log (((gchar*) 0), G_LOG_LEVEL_ERROR, "error while reading: %s" , err->message); for (;;) ; } while (0); | |||
| 313 | } | |||
| 314 | buf += br; | |||
| 315 | to_read -= br; | |||
| 316 | if (to_read != 0) { | |||
| 317 | return TRUE(!(0)); | |||
| 318 | } | |||
| 319 | } | |||
| 320 | ||||
| 321 | if (state == STATE_HEADER) { | |||
| 322 | mhHeader.type = ntohl(mhHeader.type); | |||
| 323 | mhHeader.reader_id = ntohl(mhHeader.reader_id); | |||
| 324 | mhHeader.length = ntohl(mhHeader.length); | |||
| 325 | if (verbose) { | |||
| 326 | printf("Header: type=%d, reader_id=%u length=%d (0x%x)\n", | |||
| 327 | mhHeader.type, mhHeader.reader_id, mhHeader.length, | |||
| 328 | mhHeader.length); | |||
| 329 | } | |||
| 330 | switch (mhHeader.type) { | |||
| 331 | case VSC_APDU: | |||
| 332 | case VSC_Flush: | |||
| 333 | case VSC_Error: | |||
| 334 | case VSC_Init: | |||
| 335 | buf = (gchar *)pbSendBuffer; | |||
| 336 | to_read = mhHeader.length; | |||
| 337 | state = STATE_MESSAGE; | |||
| 338 | return TRUE(!(0)); | |||
| 339 | default: | |||
| 340 | fprintf(stderrstderr, "Unexpected message of type 0x%X\n", mhHeader.type); | |||
| 341 | return FALSE(0); | |||
| 342 | } | |||
| 343 | } | |||
| 344 | ||||
| 345 | if (state == STATE_MESSAGE) { | |||
| 346 | switch (mhHeader.type) { | |||
| 347 | case VSC_APDU: | |||
| 348 | if (verbose) { | |||
| 349 | printf(" recv APDU: "); | |||
| 350 | print_byte_array(pbSendBuffer, mhHeader.length); | |||
| 351 | } | |||
| 352 | /* Transmit received APDU */ | |||
| 353 | dwSendLength = mhHeader.length; | |||
| 354 | dwRecvLength = sizeof(pbRecvBuffer); | |||
| 355 | reader = vreader_get_reader_by_id(mhHeader.reader_id); | |||
| 356 | reader_status = vreader_xfr_bytes(reader, | |||
| 357 | pbSendBuffer, dwSendLength, | |||
| 358 | pbRecvBuffer, &dwRecvLength); | |||
| 359 | if (reader_status == VREADER_OK) { | |||
| 360 | mhHeader.length = dwRecvLength; | |||
| 361 | if (verbose) { | |||
| 362 | printf(" send response: "); | |||
| 363 | print_byte_array(pbRecvBuffer, mhHeader.length); | |||
| 364 | } | |||
| 365 | send_msg(VSC_APDU, mhHeader.reader_id, | |||
| 366 | pbRecvBuffer, dwRecvLength); | |||
| 367 | } else { | |||
| 368 | rv = reader_status; /* warning: not meaningful */ | |||
| 369 | send_msg(VSC_Error, mhHeader.reader_id, &rv, sizeof(uint32_t)); | |||
| 370 | } | |||
| 371 | vreader_free(reader); | |||
| 372 | reader = NULL((void*)0); /* we've freed it, don't use it by accident | |||
| 373 | again */ | |||
| 374 | break; | |||
| 375 | case VSC_Flush: | |||
| 376 | /* TODO: actually flush */ | |||
| 377 | send_msg(VSC_FlushComplete, mhHeader.reader_id, NULL((void*)0), 0); | |||
| 378 | break; | |||
| 379 | case VSC_Error: | |||
| 380 | error_msg = (VSCMsgError *) pbSendBuffer; | |||
| 381 | if (error_msg->code == VSC_SUCCESS) { | |||
| 382 | qemu_mutex_lock(&pending_reader_lock); | |||
| 383 | if (pending_reader) { | |||
| 384 | vreader_set_id(pending_reader, mhHeader.reader_id); | |||
| 385 | vreader_free(pending_reader); | |||
| 386 | pending_reader = NULL((void*)0); | |||
| 387 | qemu_cond_signal(&pending_reader_condition); | |||
| 388 | } | |||
| 389 | qemu_mutex_unlock(&pending_reader_lock); | |||
| 390 | break; | |||
| 391 | } | |||
| 392 | printf("warning: qemu refused to add reader\n"); | |||
| 393 | if (error_msg->code == VSC_CANNOT_ADD_MORE_READERS) { | |||
| 394 | /* clear pending reader, qemu can't handle any more */ | |||
| 395 | qemu_mutex_lock(&pending_reader_lock); | |||
| 396 | if (pending_reader) { | |||
| 397 | pending_reader = NULL((void*)0); | |||
| 398 | /* make sure the event loop doesn't hang */ | |||
| 399 | qemu_cond_signal(&pending_reader_condition); | |||
| 400 | } | |||
| 401 | qemu_mutex_unlock(&pending_reader_lock); | |||
| 402 | } | |||
| 403 | break; | |||
| 404 | case VSC_Init: | |||
| 405 | if (on_host_init(&mhHeader, (VSCMsgInit *)pbSendBuffer) < 0) { | |||
| 406 | return FALSE(0); | |||
| 407 | } | |||
| 408 | break; | |||
| 409 | default: | |||
| 410 | g_assert_not_reached()do { g_assertion_message (((gchar*) 0), "/home/stefan/src/qemu/qemu.org/qemu/libcacard/vscclient.c" , 410, ((const char*) (__PRETTY_FUNCTION__)), ((void*)0)); } while (0); | |||
| 411 | return FALSE(0); | |||
| 412 | } | |||
| 413 | ||||
| 414 | state = STATE_HEADER; | |||
| 415 | } | |||
| 416 | ||||
| 417 | ||||
| 418 | return TRUE(!(0)); | |||
| 419 | } | |||
| 420 | ||||
| 421 | static gboolean | |||
| 422 | do_socket(GIOChannel *source, | |||
| 423 | GIOCondition condition, | |||
| 424 | gpointer data) | |||
| 425 | { | |||
| 426 | /* not sure if two watches work well with a single win32 sources */ | |||
| 427 | if (condition & G_IO_OUT) { | |||
| 428 | if (!do_socket_send(source, condition, data)) { | |||
| 429 | return FALSE(0); | |||
| 430 | } | |||
| 431 | } | |||
| 432 | ||||
| 433 | if (condition & G_IO_IN) { | |||
| 434 | if (!do_socket_read(source, condition, data)) { | |||
| 435 | return FALSE(0); | |||
| 436 | } | |||
| 437 | } | |||
| 438 | ||||
| 439 | return TRUE(!(0)); | |||
| 440 | } | |||
| 441 | ||||
| 442 | static void | |||
| 443 | update_socket_watch(void) | |||
| 444 | { | |||
| 445 | gboolean out = socket_to_send->len > 0; | |||
| 446 | ||||
| 447 | if (socket_tag != 0) { | |||
| 448 | g_source_remove(socket_tag); | |||
| 449 | } | |||
| 450 | ||||
| 451 | socket_tag = g_io_add_watch(channel_socket, | |||
| 452 | G_IO_IN | (out ? G_IO_OUT : 0), do_socket, NULL((void*)0)); | |||
| 453 | } | |||
| 454 | ||||
| 455 | static gboolean | |||
| 456 | do_command(GIOChannel *source, | |||
| 457 | GIOCondition condition, | |||
| 458 | gpointer data) | |||
| 459 | { | |||
| 460 | char *string; | |||
| 461 | VCardEmulError error; | |||
| 462 | static unsigned int default_reader_id; | |||
| 463 | unsigned int reader_id; | |||
| 464 | VReader *reader = NULL((void*)0); | |||
| 465 | GError *err = NULL((void*)0); | |||
| 466 | ||||
| 467 | g_assert(condition & G_IO_IN)do { if (condition & G_IO_IN) ; else g_assertion_message_expr (((gchar*) 0), "/home/stefan/src/qemu/qemu.org/qemu/libcacard/vscclient.c" , 467, ((const char*) (__PRETTY_FUNCTION__)), "condition & G_IO_IN" ); } while (0); | |||
| 468 | ||||
| 469 | reader_id = default_reader_id; | |||
| 470 | g_io_channel_read_line(source, &string, NULL((void*)0), NULL((void*)0), &err); | |||
| 471 | if (err != NULL((void*)0)) { | |||
| 472 | g_error("Error while reading command: %s", err->message)do { g_log (((gchar*) 0), G_LOG_LEVEL_ERROR, "Error while reading command: %s" , err->message); for (;;) ; } while (0); | |||
| 473 | } | |||
| 474 | ||||
| 475 | if (string != NULL((void*)0)) { | |||
| 476 | if (strncmp(string, "exit", 4) == 0) { | |||
| 477 | /* remove all the readers */ | |||
| 478 | VReaderList *list = vreader_get_reader_list(); | |||
| 479 | VReaderListEntry *reader_entry; | |||
| 480 | printf("Active Readers:\n"); | |||
| 481 | for (reader_entry = vreader_list_get_first(list); reader_entry; | |||
| 482 | reader_entry = vreader_list_get_next(reader_entry)) { | |||
| 483 | VReader *reader = vreader_list_get_reader(reader_entry); | |||
| 484 | vreader_id_t reader_id; | |||
| 485 | reader_id = vreader_get_id(reader); | |||
| 486 | if (reader_id == -1) { | |||
| 487 | continue; | |||
| 488 | } | |||
| 489 | /* be nice and signal card removal first (qemu probably should | |||
| 490 | * do this itself) */ | |||
| 491 | if (vreader_card_is_present(reader) == VREADER_OK) { | |||
| 492 | send_msg(VSC_CardRemove, reader_id, NULL((void*)0), 0); | |||
| 493 | } | |||
| 494 | send_msg(VSC_ReaderRemove, reader_id, NULL((void*)0), 0); | |||
| 495 | } | |||
| 496 | exit(0); | |||
| 497 | } else if (strncmp(string, "insert", 6) == 0) { | |||
| 498 | if (string[6] == ' ') { | |||
| 499 | reader_id = get_id_from_string(&string[7], reader_id); | |||
| 500 | } | |||
| 501 | reader = vreader_get_reader_by_id(reader_id); | |||
| 502 | if (reader != NULL((void*)0)) { | |||
| 503 | error = vcard_emul_force_card_insert(reader); | |||
| 504 | printf("insert %s, returned %d\n", | |||
| 505 | reader ? vreader_get_name(reader) | |||
| 506 | : "invalid reader", error); | |||
| 507 | } else { | |||
| 508 | printf("no reader by id %u found\n", reader_id); | |||
| 509 | } | |||
| 510 | } else if (strncmp(string, "remove", 6) == 0) { | |||
| 511 | if (string[6] == ' ') { | |||
| 512 | reader_id = get_id_from_string(&string[7], reader_id); | |||
| 513 | } | |||
| 514 | reader = vreader_get_reader_by_id(reader_id); | |||
| 515 | if (reader != NULL((void*)0)) { | |||
| 516 | error = vcard_emul_force_card_remove(reader); | |||
| 517 | printf("remove %s, returned %d\n", | |||
| 518 | reader ? vreader_get_name(reader) | |||
| 519 | : "invalid reader", error); | |||
| 520 | } else { | |||
| 521 | printf("no reader by id %u found\n", reader_id); | |||
| 522 | } | |||
| 523 | } else if (strncmp(string, "select", 6) == 0) { | |||
| 524 | if (string[6] == ' ') { | |||
| 525 | reader_id = get_id_from_string(&string[7], | |||
| 526 | VSCARD_UNDEFINED_READER_ID0xffffffff); | |||
| 527 | } | |||
| 528 | if (reader_id != VSCARD_UNDEFINED_READER_ID0xffffffff) { | |||
| 529 | reader = vreader_get_reader_by_id(reader_id); | |||
| 530 | } | |||
| 531 | if (reader) { | |||
| 532 | printf("Selecting reader %u, %s\n", reader_id, | |||
| 533 | vreader_get_name(reader)); | |||
| 534 | default_reader_id = reader_id; | |||
| 535 | } else { | |||
| 536 | printf("Reader with id %u not found\n", reader_id); | |||
| 537 | } | |||
| 538 | } else if (strncmp(string, "debug", 5) == 0) { | |||
| 539 | if (string[5] == ' ') { | |||
| 540 | verbose = get_id_from_string(&string[6], 0); | |||
| 541 | } | |||
| 542 | printf("debug level = %d\n", verbose); | |||
| 543 | } else if (strncmp(string, "list", 4) == 0) { | |||
| 544 | VReaderList *list = vreader_get_reader_list(); | |||
| 545 | VReaderListEntry *reader_entry; | |||
| 546 | printf("Active Readers:\n"); | |||
| 547 | for (reader_entry = vreader_list_get_first(list); reader_entry; | |||
| 548 | reader_entry = vreader_list_get_next(reader_entry)) { | |||
| 549 | VReader *reader = vreader_list_get_reader(reader_entry); | |||
| 550 | vreader_id_t reader_id; | |||
| 551 | reader_id = vreader_get_id(reader); | |||
| 552 | if (reader_id == -1) { | |||
| 553 | continue; | |||
| 554 | } | |||
| 555 | printf("%3u %s %s\n", reader_id, | |||
| 556 | vreader_card_is_present(reader) == VREADER_OK ? | |||
| 557 | "CARD_PRESENT" : " ", | |||
| 558 | vreader_get_name(reader)); | |||
| 559 | } | |||
| 560 | printf("Inactive Readers:\n"); | |||
| 561 | for (reader_entry = vreader_list_get_first(list); reader_entry; | |||
| 562 | reader_entry = vreader_list_get_next(reader_entry)) { | |||
| 563 | VReader *reader = vreader_list_get_reader(reader_entry); | |||
| 564 | vreader_id_t reader_id; | |||
| 565 | reader_id = vreader_get_id(reader); | |||
| 566 | if (reader_id != -1) { | |||
| 567 | continue; | |||
| 568 | } | |||
| 569 | ||||
| 570 | printf("INA %s %s\n", | |||
| 571 | vreader_card_is_present(reader) == VREADER_OK ? | |||
| 572 | "CARD_PRESENT" : " ", | |||
| 573 | vreader_get_name(reader)); | |||
| 574 | } | |||
| 575 | } else if (*string != 0) { | |||
| 576 | printf("valid commands:\n"); | |||
| 577 | printf("insert [reader_id]\n"); | |||
| 578 | printf("remove [reader_id]\n"); | |||
| 579 | printf("select reader_id\n"); | |||
| 580 | printf("list\n"); | |||
| 581 | printf("debug [level]\n"); | |||
| 582 | printf("exit\n"); | |||
| 583 | } | |||
| 584 | } | |||
| 585 | vreader_free(reader); | |||
| 586 | printf("> "); | |||
| 587 | fflush(stdoutstdout); | |||
| 588 | ||||
| 589 | return TRUE(!(0)); | |||
| 590 | } | |||
| 591 | ||||
| 592 | ||||
| 593 | /* just for ease of parsing command line arguments. */ | |||
| 594 | #define MAX_CERTS100 100 | |||
| 595 | ||||
| 596 | static int | |||
| 597 | connect_to_qemu( | |||
| 598 | const char *host, | |||
| 599 | const char *port | |||
| 600 | ) { | |||
| 601 | struct addrinfo hints; | |||
| 602 | struct addrinfo *server; | |||
| 603 | int ret, sock; | |||
| 604 | ||||
| 605 | sock = qemu_socket(AF_INET2, SOCK_STREAMSOCK_STREAM, 0); | |||
| 606 | if (sock < 0) { | |||
| 607 | /* Error */ | |||
| 608 | fprintf(stderrstderr, "Error opening socket!\n"); | |||
| 609 | return -1; | |||
| 610 | } | |||
| 611 | ||||
| 612 | memset(&hints, 0, sizeof(struct addrinfo)); | |||
| 613 | hints.ai_family = AF_UNSPEC0; | |||
| 614 | hints.ai_socktype = SOCK_STREAMSOCK_STREAM; | |||
| 615 | hints.ai_flags = 0; | |||
| 616 | hints.ai_protocol = 0; /* Any protocol */ | |||
| 617 | ||||
| 618 | ret = getaddrinfo(host, port, &hints, &server); | |||
| 619 | ||||
| 620 | if (ret != 0) { | |||
| 621 | /* Error */ | |||
| 622 | fprintf(stderrstderr, "getaddrinfo failed\n"); | |||
| 623 | goto cleanup_socket; | |||
| 624 | } | |||
| 625 | ||||
| 626 | if (connect(sock, server->ai_addr, server->ai_addrlen) < 0) { | |||
| 627 | /* Error */ | |||
| 628 | fprintf(stderrstderr, "Could not connect\n"); | |||
| 629 | goto cleanup_socket; | |||
| 630 | } | |||
| 631 | if (verbose) { | |||
| 632 | printf("Connected (sizeof Header=%zd)!\n", sizeof(VSCMsgHeader)); | |||
| 633 | } | |||
| 634 | return sock; | |||
| 635 | ||||
| 636 | cleanup_socket: | |||
| 637 | closesocket(sock)close(sock); | |||
| 638 | return -1; | |||
| 639 | } | |||
| 640 | ||||
| 641 | int | |||
| 642 | main( | |||
| 643 | int argc, | |||
| 644 | char *argv[] | |||
| 645 | ) { | |||
| 646 | GMainLoop *loop; | |||
| 647 | GIOChannel *channel_stdin; | |||
| 648 | char *qemu_host; | |||
| 649 | char *qemu_port; | |||
| 650 | ||||
| 651 | VCardEmulOptions *command_line_options = NULL((void*)0); | |||
| 652 | ||||
| 653 | char *cert_names[MAX_CERTS100]; | |||
| 654 | char *emul_args = NULL((void*)0); | |||
| 655 | int cert_count = 0; | |||
| 656 | int c, sock; | |||
| 657 | ||||
| 658 | if (socket_init() != 0) | |||
| ||||
| 659 | return 1; | |||
| 660 | ||||
| 661 | while ((c = getopt(argc, argv, "c:e:pd:")) != -1) { | |||
| 662 | switch (c) { | |||
| 663 | case 'c': | |||
| 664 | if (cert_count >= MAX_CERTS100) { | |||
| 665 | printf("too many certificates (max = %d)\n", MAX_CERTS100); | |||
| 666 | exit(5); | |||
| 667 | } | |||
| 668 | cert_names[cert_count++] = optarg; | |||
| 669 | break; | |||
| 670 | case 'e': | |||
| 671 | emul_args = optarg; | |||
| 672 | break; | |||
| 673 | case 'p': | |||
| 674 | print_usage(); | |||
| 675 | exit(4); | |||
| 676 | break; | |||
| 677 | case 'd': | |||
| 678 | verbose = get_id_from_string(optarg, 1); | |||
| 679 | break; | |||
| 680 | } | |||
| 681 | } | |||
| 682 | ||||
| 683 | if (argc - optind != 2) { | |||
| 684 | print_usage(); | |||
| 685 | exit(4); | |||
| 686 | } | |||
| 687 | ||||
| 688 | if (cert_count > 0) { | |||
| 689 | char *new_args; | |||
| 690 | int len, i; | |||
| 691 | /* if we've given some -c options, we clearly we want do so some | |||
| 692 | * software emulation. add that emulation now. this is NSS Emulator | |||
| 693 | * specific */ | |||
| 694 | if (emul_args == NULL((void*)0)) { | |||
| 695 | emul_args = (char *)"db=\"/etc/pki/nssdb\""; | |||
| 696 | } | |||
| 697 | #define SOFT_STRING",soft=(,Virtual Reader,CAC,," ",soft=(,Virtual Reader,CAC,," | |||
| 698 | /* 2 == close paren & null */ | |||
| 699 | len = strlen(emul_args) + strlen(SOFT_STRING",soft=(,Virtual Reader,CAC,,") + 2; | |||
| 700 | for (i = 0; i < cert_count; i++) { | |||
| 701 | len += strlen(cert_names[i])+1; /* 1 == comma */ | |||
| ||||
| 702 | } | |||
| 703 | new_args = g_malloc(len); | |||
| 704 | strcpy(new_args, emul_args); | |||
| 705 | strcat(new_args, SOFT_STRING",soft=(,Virtual Reader,CAC,,"); | |||
| 706 | for (i = 0; i < cert_count; i++) { | |||
| 707 | strcat(new_args, cert_names[i]); | |||
| 708 | strcat(new_args, ","); | |||
| 709 | } | |||
| 710 | strcat(new_args, ")"); | |||
| 711 | emul_args = new_args; | |||
| 712 | } | |||
| 713 | if (emul_args) { | |||
| 714 | command_line_options = vcard_emul_options(emul_args); | |||
| 715 | } | |||
| 716 | ||||
| 717 | qemu_host = g_strdup(argv[argc - 2]); | |||
| 718 | qemu_port = g_strdup(argv[argc - 1]); | |||
| 719 | sock = connect_to_qemu(qemu_host, qemu_port); | |||
| 720 | if (sock == -1) { | |||
| 721 | fprintf(stderrstderr, "error opening socket, exiting.\n"); | |||
| 722 | exit(5); | |||
| 723 | } | |||
| 724 | ||||
| 725 | socket_to_send = g_byte_array_new(); | |||
| 726 | qemu_mutex_init(&socket_to_send_lock); | |||
| 727 | qemu_mutex_init(&pending_reader_lock); | |||
| 728 | qemu_cond_init(&pending_reader_condition); | |||
| 729 | ||||
| 730 | vcard_emul_init(command_line_options); | |||
| 731 | ||||
| 732 | loop = g_main_loop_new(NULL((void*)0), true1); | |||
| 733 | ||||
| 734 | printf("> "); | |||
| 735 | fflush(stdoutstdout); | |||
| 736 | ||||
| 737 | #ifdef _WIN32 | |||
| 738 | channel_stdin = g_io_channel_win32_new_fd(STDIN_FILENO0); | |||
| 739 | #else | |||
| 740 | channel_stdin = g_io_channel_unix_new(STDIN_FILENO0); | |||
| 741 | #endif | |||
| 742 | g_io_add_watch(channel_stdin, G_IO_IN, do_command, NULL((void*)0)); | |||
| 743 | #ifdef _WIN32 | |||
| 744 | channel_socket = g_io_channel_win32_new_socket(sock); | |||
| 745 | #else | |||
| 746 | channel_socket = g_io_channel_unix_new(sock); | |||
| 747 | #endif | |||
| 748 | g_io_channel_set_encoding(channel_socket, NULL((void*)0), NULL((void*)0)); | |||
| 749 | /* we buffer ourself for thread safety reasons */ | |||
| 750 | g_io_channel_set_buffered(channel_socket, FALSE(0)); | |||
| 751 | ||||
| 752 | /* Send init message, Host responds (and then we send reader attachments) */ | |||
| 753 | VSCMsgInit init = { | |||
| 754 | .version = htonl(VSCARD_VERSION((0 << (10 + 11)) | (0 << 10) | (2))), | |||
| 755 | .magic = VSCARD_MAGIC(*(uint32_t *)"VSCD"), | |||
| 756 | .capabilities = {0} | |||
| 757 | }; | |||
| 758 | send_msg(VSC_Init, 0, &init, sizeof(init)); | |||
| 759 | ||||
| 760 | g_main_loop_run(loop); | |||
| 761 | g_main_loop_unref(loop); | |||
| 762 | ||||
| 763 | g_io_channel_unref(channel_stdin); | |||
| 764 | g_io_channel_unref(channel_socket); | |||
| 765 | g_byte_array_free(socket_to_send, TRUE(!(0))); | |||
| 766 | ||||
| 767 | closesocket(sock)close(sock); | |||
| 768 | return 0; | |||
| 769 | } |