qemu-e2k/hw/usb/u2f-emulated.c

406 lines
11 KiB
C
Raw Normal View History

/*
* U2F USB Emulated device.
*
* Copyright (c) 2020 César Belley <cesar.belley@lse.epita.fr>
* Written by César Belley <cesar.belley@lse.epita.fr>
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include "qemu/osdep.h"
#include "qemu/module.h"
#include "qemu/thread.h"
#include "qemu/main-loop.h"
#include "qapi/error.h"
#include "hw/usb.h"
#include "hw/qdev-properties.h"
#include <u2f-emu/u2f-emu.h>
#include "u2f.h"
/* Counter which sync with a file */
struct synced_counter {
/* Emulated device counter */
struct u2f_emu_vdev_counter vdev_counter;
/* Private attributes */
uint32_t value;
FILE *fp;
};
static void counter_increment(struct u2f_emu_vdev_counter *vdev_counter)
{
struct synced_counter *counter = (struct synced_counter *)vdev_counter;
++counter->value;
/* Write back */
if (fseek(counter->fp, 0, SEEK_SET) == -1) {
return;
}
fprintf(counter->fp, "%u\n", counter->value);
}
static uint32_t counter_read(struct u2f_emu_vdev_counter *vdev_counter)
{
struct synced_counter *counter = (struct synced_counter *)vdev_counter;
return counter->value;
}
typedef struct U2FEmulatedState U2FEmulatedState;
#define PENDING_OUT_NUM 32
struct U2FEmulatedState {
U2FKeyState base;
/* U2F virtual emulated device */
u2f_emu_vdev *vdev;
QemuMutex vdev_mutex;
/* Properties */
char *dir;
char *cert;
char *privkey;
char *entropy;
char *counter;
struct synced_counter synced_counter;
/* Pending packets received from the guest */
uint8_t pending_out[PENDING_OUT_NUM][U2FHID_PACKET_SIZE];
uint8_t pending_out_start;
uint8_t pending_out_end;
uint8_t pending_out_num;
QemuMutex pending_out_mutex;
/* Emulation thread and sync */
QemuCond key_cond;
QemuMutex key_mutex;
QemuThread key_thread;
bool stop_thread;
EventNotifier notifier;
};
#define TYPE_U2F_EMULATED "u2f-emulated"
#define EMULATED_U2F_KEY(obj) \
OBJECT_CHECK(U2FEmulatedState, (obj), TYPE_U2F_EMULATED)
static void u2f_emulated_reset(U2FEmulatedState *key)
{
key->pending_out_start = 0;
key->pending_out_end = 0;
key->pending_out_num = 0;
}
static void u2f_pending_out_add(U2FEmulatedState *key,
const uint8_t packet[U2FHID_PACKET_SIZE])
{
int index;
if (key->pending_out_num >= PENDING_OUT_NUM) {
return;
}
index = key->pending_out_end;
key->pending_out_end = (index + 1) % PENDING_OUT_NUM;
++key->pending_out_num;
memcpy(&key->pending_out[index], packet, U2FHID_PACKET_SIZE);
}
static uint8_t *u2f_pending_out_get(U2FEmulatedState *key)
{
int index;
if (key->pending_out_num == 0) {
return NULL;
}
index = key->pending_out_start;
key->pending_out_start = (index + 1) % PENDING_OUT_NUM;
--key->pending_out_num;
return key->pending_out[index];
}
static void u2f_emulated_recv_from_guest(U2FKeyState *base,
const uint8_t packet[U2FHID_PACKET_SIZE])
{
U2FEmulatedState *key = EMULATED_U2F_KEY(base);
qemu_mutex_lock(&key->pending_out_mutex);
u2f_pending_out_add(key, packet);
qemu_mutex_unlock(&key->pending_out_mutex);
qemu_mutex_lock(&key->key_mutex);
qemu_cond_signal(&key->key_cond);
qemu_mutex_unlock(&key->key_mutex);
}
static void *u2f_emulated_thread(void* arg)
{
U2FEmulatedState *key = arg;
uint8_t packet[U2FHID_PACKET_SIZE];
uint8_t *packet_out = NULL;
while (true) {
/* Wait signal */
qemu_mutex_lock(&key->key_mutex);
qemu_cond_wait(&key->key_cond, &key->key_mutex);
qemu_mutex_unlock(&key->key_mutex);
/* Exit thread check */
if (key->stop_thread) {
key->stop_thread = false;
break;
}
qemu_mutex_lock(&key->pending_out_mutex);
packet_out = u2f_pending_out_get(key);
if (packet_out == NULL) {
qemu_mutex_unlock(&key->pending_out_mutex);
continue;
}
memcpy(packet, packet_out, U2FHID_PACKET_SIZE);
qemu_mutex_unlock(&key->pending_out_mutex);
qemu_mutex_lock(&key->vdev_mutex);
u2f_emu_vdev_send(key->vdev, U2F_EMU_USB, packet,
U2FHID_PACKET_SIZE);
/* Notify response */
if (u2f_emu_vdev_has_response(key->vdev, U2F_EMU_USB)) {
event_notifier_set(&key->notifier);
}
qemu_mutex_unlock(&key->vdev_mutex);
}
return NULL;
}
static ssize_t u2f_emulated_read(const char *path, char *buffer,
size_t buffer_len)
{
int fd;
ssize_t ret;
fd = qemu_open_old(path, O_RDONLY);
if (fd < 0) {
return -1;
}
ret = read(fd, buffer, buffer_len);
close(fd);
return ret;
}
static bool u2f_emulated_setup_counter(const char *path,
struct synced_counter *counter)
{
int fd, ret;
FILE *fp;
fd = qemu_open_old(path, O_RDWR);
if (fd < 0) {
return false;
}
fp = fdopen(fd, "r+");
if (fp == NULL) {
close(fd);
return false;
}
ret = fscanf(fp, "%u", &counter->value);
if (ret == EOF) {
fclose(fp);
return false;
}
counter->fp = fp;
counter->vdev_counter.counter_increment = counter_increment;
counter->vdev_counter.counter_read = counter_read;
return true;
}
static u2f_emu_rc u2f_emulated_setup_vdev_manualy(U2FEmulatedState *key)
{
ssize_t ret;
char cert_pem[4096], privkey_pem[2048];
struct u2f_emu_vdev_setup setup_info;
/* Certificate */
ret = u2f_emulated_read(key->cert, cert_pem, sizeof(cert_pem));
if (ret < 0) {
return -1;
}
/* Private key */
ret = u2f_emulated_read(key->privkey, privkey_pem, sizeof(privkey_pem));
if (ret < 0) {
return -1;
}
/* Entropy */
ret = u2f_emulated_read(key->entropy, (char *)&setup_info.entropy,
sizeof(setup_info.entropy));
if (ret < 0) {
return -1;
}
/* Counter */
if (!u2f_emulated_setup_counter(key->counter, &key->synced_counter)) {
return -1;
}
/* Setup */
setup_info.certificate = cert_pem;
setup_info.private_key = privkey_pem;
setup_info.counter = (struct u2f_emu_vdev_counter *)&key->synced_counter;
return u2f_emu_vdev_new(&key->vdev, &setup_info);
}
static void u2f_emulated_event_handler(EventNotifier *notifier)
{
U2FEmulatedState *key = container_of(notifier, U2FEmulatedState, notifier);
size_t packet_size;
uint8_t *packet_in = NULL;
event_notifier_test_and_clear(&key->notifier);
qemu_mutex_lock(&key->vdev_mutex);
while (u2f_emu_vdev_has_response(key->vdev, U2F_EMU_USB)) {
packet_size = u2f_emu_vdev_get_response(key->vdev, U2F_EMU_USB,
&packet_in);
if (packet_size == U2FHID_PACKET_SIZE) {
u2f_send_to_guest(&key->base, packet_in);
}
u2f_emu_vdev_free_response(packet_in);
}
qemu_mutex_unlock(&key->vdev_mutex);
}
static void u2f_emulated_realize(U2FKeyState *base, Error **errp)
{
U2FEmulatedState *key = EMULATED_U2F_KEY(base);
u2f_emu_rc rc;
if (key->cert != NULL || key->privkey != NULL || key->entropy != NULL
|| key->counter != NULL) {
if (key->cert != NULL && key->privkey != NULL
&& key->entropy != NULL && key->counter != NULL) {
rc = u2f_emulated_setup_vdev_manualy(key);
} else {
error_setg(errp, "%s: cert, priv, entropy and counter "
"parameters must be provided to manualy configure "
"the emulated device", TYPE_U2F_EMULATED);
return;
}
} else if (key->dir != NULL) {
rc = u2f_emu_vdev_new_from_dir(&key->vdev, key->dir);
} else {
rc = u2f_emu_vdev_new_ephemeral(&key->vdev);
}
if (rc != U2F_EMU_OK) {
error_setg(errp, "%s: Failed to setup the key", TYPE_U2F_EMULATED);
return;
}
if (event_notifier_init(&key->notifier, false) < 0) {
error_setg(errp, "%s: Failed to initialize notifier",
TYPE_U2F_EMULATED);
return;
}
/* Notifier */
event_notifier_set_handler(&key->notifier, u2f_emulated_event_handler);
/* Synchronization */
qemu_cond_init(&key->key_cond);
qemu_mutex_init(&key->vdev_mutex);
qemu_mutex_init(&key->pending_out_mutex);
qemu_mutex_init(&key->key_mutex);
u2f_emulated_reset(key);
/* Thread */
key->stop_thread = false;
qemu_thread_create(&key->key_thread, "u2f-key", u2f_emulated_thread,
key, QEMU_THREAD_JOINABLE);
}
static void u2f_emulated_unrealize(U2FKeyState *base)
{
U2FEmulatedState *key = EMULATED_U2F_KEY(base);
/* Thread */
key->stop_thread = true;
qemu_cond_signal(&key->key_cond);
qemu_thread_join(&key->key_thread);
/* Notifier */
event_notifier_set_handler(&key->notifier, NULL);
event_notifier_cleanup(&key->notifier);
/* Synchronization */
qemu_cond_destroy(&key->key_cond);
qemu_mutex_destroy(&key->vdev_mutex);
qemu_mutex_destroy(&key->key_mutex);
qemu_mutex_destroy(&key->pending_out_mutex);
/* Vdev */
u2f_emu_vdev_free(key->vdev);
if (key->synced_counter.fp != NULL) {
fclose(key->synced_counter.fp);
}
}
static Property u2f_emulated_properties[] = {
DEFINE_PROP_STRING("dir", U2FEmulatedState, dir),
DEFINE_PROP_STRING("cert", U2FEmulatedState, cert),
DEFINE_PROP_STRING("privkey", U2FEmulatedState, privkey),
DEFINE_PROP_STRING("entropy", U2FEmulatedState, entropy),
DEFINE_PROP_STRING("counter", U2FEmulatedState, counter),
DEFINE_PROP_END_OF_LIST(),
};
static void u2f_emulated_class_init(ObjectClass *klass, void *data)
{
DeviceClass *dc = DEVICE_CLASS(klass);
U2FKeyClass *kc = U2F_KEY_CLASS(klass);
kc->realize = u2f_emulated_realize;
kc->unrealize = u2f_emulated_unrealize;
kc->recv_from_guest = u2f_emulated_recv_from_guest;
dc->desc = "QEMU U2F emulated key";
device_class_set_props(dc, u2f_emulated_properties);
}
static const TypeInfo u2f_key_emulated_info = {
.name = TYPE_U2F_EMULATED,
.parent = TYPE_U2F_KEY,
.instance_size = sizeof(U2FEmulatedState),
.class_init = u2f_emulated_class_init
};
static void u2f_key_emulated_register_types(void)
{
type_register_static(&u2f_key_emulated_info);
}
type_init(u2f_key_emulated_register_types)