VRPMB-BE: create virtio rpmb backend VBS-U

This patch implements virtio rpmb backend VBS-U component,
it includes the basic module interface with DM. This
component will work with vRPMB FE driver together to
provide one communication channel between UOS and SOS.

Signed-off-by: weideng <wei.a.deng@intel.com>
Signed-off-by: yingbinx <yingbinx.zeng@intel.com>
Acked-by: Zhu Bing <bing.zhu@intel.com>
This commit is contained in:
yingbinx 2018-05-16 10:41:33 +08:00 committed by lijinxia
parent 91f7391ad8
commit 6c4ebe3f26
2 changed files with 213 additions and 0 deletions

View File

@ -80,6 +80,7 @@ SRCS += hw/pci/virtio/virtio_net.c
SRCS += hw/pci/virtio/virtio_rnd.c
SRCS += hw/pci/virtio/virtio_hyper_dmabuf.c
SRCS += hw/pci/virtio/virtio_heci.c
SRCS += hw/pci/virtio/virtio_rpmb.c
SRCS += hw/pci/irq.c
SRCS += hw/pci/uart.c
SRCS += hw/pci/gvt.c

View File

@ -0,0 +1,212 @@
/*
* Virtio Rpmb backend.
*
* Copyright (C) 2018 Intel Corporation
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer
* in this position and unchanged.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* Contact Information: weideng <wei.a.deng@intel.com>
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* Create virtio rpmb backend VBS-U. This component will work with RPMB FE
* driver to provide one communication channel between UOS and SOS.
* The message from RPMB daemon in Android will be transferred over the
* channel and finally arrived RPMB physical driver on SOS kernel.
*
*/
#include <sys/cdefs.h>
#include <sys/param.h>
#include <sys/uio.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <assert.h>
#include <pthread.h>
#include <sysexits.h>
#include "dm.h"
#include "pci_core.h"
#include "virtio.h"
#include "vmmapi.h"
#include <fcntl.h>
#include <sys/ioctl.h>
#include <linux/types.h>
#define VIRTIO_RPMB_RINGSZ 64
static int virtio_rpmb_debug;
#define DPRINTF(params) do { if (virtio_rpmb_debug) printf params; } while (0)
#define WPRINTF(params) (printf params)
/*
* virtio-rpmb struct
*/
struct virtio_rpmb {
struct virtio_base base;
struct virtio_vq_info vq;
pthread_mutex_t mtx;
/*
* Different UOS (with vmid) will access physical rpmb area
* with different offsets.
*/
int vmid;
};
static void
virtio_rpmb_notify(void *base, struct virtio_vq_info *vq)
{
struct iovec iov;
int len;
uint16_t idx;
while (vq_has_descs(vq)) {
vq_getchain(vq, &idx, &iov, 1, NULL);
len = iov.iov_len;
assert(len > 0);
/*
* Release this chain and handle more
*/
vq_relchain(vq, idx, len);
}
vq_endchains(vq, 1); /* Generate interrupt if appropriate. */
}
static void
virtio_rpmb_reset(void *base)
{
struct virtio_rpmb *rpmb;
if (!base) {
DPRINTF(("error, invalid args!\n"));
return;
}
rpmb = base;
DPRINTF(("virtio_rpmb: device reset requested !\n"));
virtio_reset_dev(&rpmb->base);
}
static struct virtio_ops virtio_rpmb_ops = {
"virtio_rpmb", /* our name */
1, /* we support 1 virtqueue */
0, /* config reg size */
virtio_rpmb_reset, /* reset */
virtio_rpmb_notify, /* device-wide qnotify */
NULL, /* read virtio config */
NULL, /* write virtio config */
NULL, /* apply negotiated features */
NULL, /* called on guest set status */
0, /* our capabilities */
};
static int
virtio_rpmb_init(struct vmctx *ctx, struct pci_vdev *dev, char *opts)
{
struct virtio_rpmb *rpmb;
pthread_mutexattr_t attr;
int rc;
rpmb = calloc(1, sizeof(struct virtio_rpmb));
if (!rpmb) {
DPRINTF(("error, unable to calloc rpmb buffer!\n"));
return -1;
}
/* init mutex attribute properly */
rc = pthread_mutexattr_init(&attr);
if (rc) {
DPRINTF(("mutexattr init failed with error %d!\n", rc));
goto out;
}
if (virtio_uses_msix()) {
rc = pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_DEFAULT);
if (rc) {
DPRINTF(("settype(DEFAULT) failed %d!\n", rc));
goto out;
}
} else {
rc = pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_RECURSIVE);
if (rc) {
DPRINTF(("settype(RESURSIVE) failed %d!\n", rc));
goto out;
}
}
rc = pthread_mutex_init(&rpmb->mtx, &attr);
if (rc) {
DPRINTF(("mutex init failed with error %d!\n", rc));
goto out;
}
virtio_linkup(&rpmb->base, &virtio_rpmb_ops, rpmb, dev, &rpmb->vq);
rpmb->base.mtx = &rpmb->mtx;
rpmb->vq.qsize = VIRTIO_RPMB_RINGSZ;
rpmb->vmid = ctx->vmid;
/* initialize config space */
pci_set_cfgdata16(dev, PCIR_DEVICE, VIRTIO_DEV_RPMB);
pci_set_cfgdata16(dev, PCIR_VENDOR, INTEL_VENDOR_ID);
pci_set_cfgdata8(dev, PCIR_CLASS, PCIC_OTHER);
pci_set_cfgdata16(dev, PCIR_SUBDEV_0, VIRTIO_TYPE_RPMB);
pci_set_cfgdata16(dev, PCIR_SUBVEND_0, INTEL_VENDOR_ID);
rc = virtio_interrupt_init(&rpmb->base, virtio_uses_msix());
if (rc) {
DPRINTF(("virtio_interrupt_init failed (%d)!\n", rc));
goto out;
}
virtio_set_io_bar(&rpmb->base, 0);
return 0;
out:
free(rpmb);
return rc;
}
static void
virtio_rpmb_deinit(struct vmctx *ctx, struct pci_vdev *dev, char *opts)
{
if (dev->arg) {
DPRINTF(("virtio_rpmb_be_deinit: free struct virtio_rpmb!\n"));
free((struct virtio_rpmb *)dev->arg);
}
}
struct pci_vdev_ops pci_ops_virtio_rpmb = {
.class_name = "virtio-rpmb",
.vdev_init = virtio_rpmb_init,
.vdev_deinit = virtio_rpmb_deinit,
.vdev_barwrite = virtio_pci_write,
.vdev_barread = virtio_pci_read
};
DEFINE_PCI_DEVTYPE(pci_ops_virtio_rpmb);