root/drivers/virt/nitro_enclaves/ne_pci_dev.c
// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright 2020-2021 Amazon.com, Inc. or its affiliates. All Rights Reserved.
 */

/**
 * DOC: Nitro Enclaves (NE) PCI device driver.
 */

#include <linux/delay.h>
#include <linux/device.h>
#include <linux/list.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/nitro_enclaves.h>
#include <linux/pci.h>
#include <linux/types.h>
#include <linux/wait.h>

#include "ne_misc_dev.h"
#include "ne_pci_dev.h"

/**
 * NE_DEFAULT_TIMEOUT_MSECS - Default timeout to wait for a reply from
 *                            the NE PCI device.
 */
#define NE_DEFAULT_TIMEOUT_MSECS        (120000) /* 120 sec */

static const struct pci_device_id ne_pci_ids[] = {
        { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, PCI_DEVICE_ID_NE) },
        { 0, }
};

MODULE_DEVICE_TABLE(pci, ne_pci_ids);

/**
 * ne_submit_request() - Submit command request to the PCI device based on the
 *                       command type.
 * @pdev:               PCI device to send the command to.
 * @cmd_type:           Command type of the request sent to the PCI device.
 * @cmd_request:        Command request payload.
 * @cmd_request_size:   Size of the command request payload.
 *
 * Context: Process context. This function is called with the ne_pci_dev mutex held.
 */
static void ne_submit_request(struct pci_dev *pdev, enum ne_pci_dev_cmd_type cmd_type,
                              void *cmd_request, size_t cmd_request_size)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        memcpy_toio(ne_pci_dev->iomem_base + NE_SEND_DATA, cmd_request, cmd_request_size);

        iowrite32(cmd_type, ne_pci_dev->iomem_base + NE_COMMAND);
}

/**
 * ne_retrieve_reply() - Retrieve reply from the PCI device.
 * @pdev:               PCI device to receive the reply from.
 * @cmd_reply:          Command reply payload.
 * @cmd_reply_size:     Size of the command reply payload.
 *
 * Context: Process context. This function is called with the ne_pci_dev mutex held.
 */
static void ne_retrieve_reply(struct pci_dev *pdev, struct ne_pci_dev_cmd_reply *cmd_reply,
                              size_t cmd_reply_size)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        memcpy_fromio(cmd_reply, ne_pci_dev->iomem_base + NE_RECV_DATA, cmd_reply_size);
}

/**
 * ne_wait_for_reply() - Wait for a reply of a PCI device command.
 * @pdev:       PCI device for which a reply is waited.
 *
 * Context: Process context. This function is called with the ne_pci_dev mutex held.
 * Return:
 * * 0 on success.
 * * Negative return value on failure.
 */
static int ne_wait_for_reply(struct pci_dev *pdev)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);
        int rc = -EINVAL;

        /*
         * TODO: Update to _interruptible and handle interrupted wait event
         * e.g. -ERESTARTSYS, incoming signals + update timeout, if needed.
         */
        rc = wait_event_timeout(ne_pci_dev->cmd_reply_wait_q,
                                atomic_read(&ne_pci_dev->cmd_reply_avail) != 0,
                                msecs_to_jiffies(NE_DEFAULT_TIMEOUT_MSECS));
        if (!rc)
                return -ETIMEDOUT;

        return 0;
}

int ne_do_request(struct pci_dev *pdev, enum ne_pci_dev_cmd_type cmd_type,
                  void *cmd_request, size_t cmd_request_size,
                  struct ne_pci_dev_cmd_reply *cmd_reply, size_t cmd_reply_size)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);
        int rc = -EINVAL;

        if (cmd_type <= INVALID_CMD || cmd_type >= MAX_CMD) {
                dev_err_ratelimited(&pdev->dev, "Invalid cmd type=%u\n", cmd_type);

                return -EINVAL;
        }

        if (!cmd_request) {
                dev_err_ratelimited(&pdev->dev, "Null cmd request for cmd type=%u\n",
                                    cmd_type);

                return -EINVAL;
        }

        if (cmd_request_size > NE_SEND_DATA_SIZE) {
                dev_err_ratelimited(&pdev->dev, "Invalid req size=%zu for cmd type=%u\n",
                                    cmd_request_size, cmd_type);

                return -EINVAL;
        }

        if (!cmd_reply) {
                dev_err_ratelimited(&pdev->dev, "Null cmd reply for cmd type=%u\n",
                                    cmd_type);

                return -EINVAL;
        }

        if (cmd_reply_size > NE_RECV_DATA_SIZE) {
                dev_err_ratelimited(&pdev->dev, "Invalid reply size=%zu for cmd type=%u\n",
                                    cmd_reply_size, cmd_type);

                return -EINVAL;
        }

        /*
         * Use this mutex so that the PCI device handles one command request at
         * a time.
         */
        mutex_lock(&ne_pci_dev->pci_dev_mutex);

        atomic_set(&ne_pci_dev->cmd_reply_avail, 0);

        ne_submit_request(pdev, cmd_type, cmd_request, cmd_request_size);

        rc = ne_wait_for_reply(pdev);
        if (rc < 0) {
                dev_err_ratelimited(&pdev->dev, "Error in wait for reply for cmd type=%u [rc=%d]\n",
                                    cmd_type, rc);

                goto unlock_mutex;
        }

        ne_retrieve_reply(pdev, cmd_reply, cmd_reply_size);

        atomic_set(&ne_pci_dev->cmd_reply_avail, 0);

        if (cmd_reply->rc < 0) {
                rc = cmd_reply->rc;

                dev_err_ratelimited(&pdev->dev, "Error in cmd process logic, cmd type=%u [rc=%d]\n",
                                    cmd_type, rc);

                goto unlock_mutex;
        }

        rc = 0;

unlock_mutex:
        mutex_unlock(&ne_pci_dev->pci_dev_mutex);

        return rc;
}

/**
 * ne_reply_handler() - Interrupt handler for retrieving a reply matching a
 *                      request sent to the PCI device for enclave lifetime
 *                      management.
 * @irq:        Received interrupt for a reply sent by the PCI device.
 * @args:       PCI device private data structure.
 *
 * Context: Interrupt context.
 * Return:
 * * IRQ_HANDLED on handled interrupt.
 */
static irqreturn_t ne_reply_handler(int irq, void *args)
{
        struct ne_pci_dev *ne_pci_dev = (struct ne_pci_dev *)args;

        atomic_set(&ne_pci_dev->cmd_reply_avail, 1);

        /* TODO: Update to _interruptible. */
        wake_up(&ne_pci_dev->cmd_reply_wait_q);

        return IRQ_HANDLED;
}

/**
 * ne_event_work_handler() - Work queue handler for notifying enclaves on a
 *                           state change received by the event interrupt
 *                           handler.
 * @work:       Item containing the NE PCI device for which an out-of-band event
 *              was issued.
 *
 * An out-of-band event is being issued by the Nitro Hypervisor when at least
 * one enclave is changing state without client interaction.
 *
 * Context: Work queue context.
 */
static void ne_event_work_handler(struct work_struct *work)
{
        struct ne_pci_dev_cmd_reply cmd_reply = {};
        struct ne_enclave *ne_enclave = NULL;
        struct ne_pci_dev *ne_pci_dev =
                container_of(work, struct ne_pci_dev, notify_work);
        struct pci_dev *pdev = ne_pci_dev->pdev;
        int rc = -EINVAL;
        struct slot_info_req slot_info_req = {};

        mutex_lock(&ne_pci_dev->enclaves_list_mutex);

        /*
         * Iterate over all enclaves registered for the Nitro Enclaves
         * PCI device and determine for which enclave(s) the out-of-band event
         * is corresponding to.
         */
        list_for_each_entry(ne_enclave, &ne_pci_dev->enclaves_list, enclave_list_entry) {
                mutex_lock(&ne_enclave->enclave_info_mutex);

                /*
                 * Enclaves that were never started cannot receive out-of-band
                 * events.
                 */
                if (ne_enclave->state != NE_STATE_RUNNING)
                        goto unlock;

                slot_info_req.slot_uid = ne_enclave->slot_uid;

                rc = ne_do_request(pdev, SLOT_INFO,
                                   &slot_info_req, sizeof(slot_info_req),
                                   &cmd_reply, sizeof(cmd_reply));
                if (rc < 0)
                        dev_err(&pdev->dev, "Error in slot info [rc=%d]\n", rc);

                /* Notify enclave process that the enclave state changed. */
                if (ne_enclave->state != cmd_reply.state) {
                        ne_enclave->state = cmd_reply.state;

                        ne_enclave->has_event = true;

                        wake_up_interruptible(&ne_enclave->eventq);
                }

unlock:
                 mutex_unlock(&ne_enclave->enclave_info_mutex);
        }

        mutex_unlock(&ne_pci_dev->enclaves_list_mutex);
}

/**
 * ne_event_handler() - Interrupt handler for PCI device out-of-band events.
 *                      This interrupt does not supply any data in the MMIO
 *                      region. It notifies a change in the state of any of
 *                      the launched enclaves.
 * @irq:        Received interrupt for an out-of-band event.
 * @args:       PCI device private data structure.
 *
 * Context: Interrupt context.
 * Return:
 * * IRQ_HANDLED on handled interrupt.
 */
static irqreturn_t ne_event_handler(int irq, void *args)
{
        struct ne_pci_dev *ne_pci_dev = (struct ne_pci_dev *)args;

        queue_work(ne_pci_dev->event_wq, &ne_pci_dev->notify_work);

        return IRQ_HANDLED;
}

/**
 * ne_setup_msix() - Setup MSI-X vectors for the PCI device.
 * @pdev:       PCI device to setup the MSI-X for.
 *
 * Context: Process context.
 * Return:
 * * 0 on success.
 * * Negative return value on failure.
 */
static int ne_setup_msix(struct pci_dev *pdev)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);
        int nr_vecs = 0;
        int rc = -EINVAL;

        nr_vecs = pci_msix_vec_count(pdev);
        if (nr_vecs < 0) {
                rc = nr_vecs;

                dev_err(&pdev->dev, "Error in getting vec count [rc=%d]\n", rc);

                return rc;
        }

        rc = pci_alloc_irq_vectors(pdev, nr_vecs, nr_vecs, PCI_IRQ_MSIX);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in alloc MSI-X vecs [rc=%d]\n", rc);

                return rc;
        }

        /*
         * This IRQ gets triggered every time the PCI device responds to a
         * command request. The reply is then retrieved, reading from the MMIO
         * space of the PCI device.
         */
        rc = request_irq(pci_irq_vector(pdev, NE_VEC_REPLY), ne_reply_handler,
                         0, "enclave_cmd", ne_pci_dev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in request irq reply [rc=%d]\n", rc);

                goto free_irq_vectors;
        }

        ne_pci_dev->event_wq = create_singlethread_workqueue("ne_pci_dev_wq");
        if (!ne_pci_dev->event_wq) {
                rc = -ENOMEM;

                dev_err(&pdev->dev, "Cannot get wq for dev events [rc=%d]\n", rc);

                goto free_reply_irq_vec;
        }

        INIT_WORK(&ne_pci_dev->notify_work, ne_event_work_handler);

        /*
         * This IRQ gets triggered every time any enclave's state changes. Its
         * handler then scans for the changes and propagates them to the user
         * space.
         */
        rc = request_irq(pci_irq_vector(pdev, NE_VEC_EVENT), ne_event_handler,
                         0, "enclave_evt", ne_pci_dev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in request irq event [rc=%d]\n", rc);

                goto destroy_wq;
        }

        return 0;

destroy_wq:
        destroy_workqueue(ne_pci_dev->event_wq);
free_reply_irq_vec:
        free_irq(pci_irq_vector(pdev, NE_VEC_REPLY), ne_pci_dev);
free_irq_vectors:
        pci_free_irq_vectors(pdev);

        return rc;
}

/**
 * ne_teardown_msix() - Teardown MSI-X vectors for the PCI device.
 * @pdev:       PCI device to teardown the MSI-X for.
 *
 * Context: Process context.
 */
static void ne_teardown_msix(struct pci_dev *pdev)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        free_irq(pci_irq_vector(pdev, NE_VEC_EVENT), ne_pci_dev);

        flush_work(&ne_pci_dev->notify_work);
        destroy_workqueue(ne_pci_dev->event_wq);

        free_irq(pci_irq_vector(pdev, NE_VEC_REPLY), ne_pci_dev);

        pci_free_irq_vectors(pdev);
}

/**
 * ne_pci_dev_enable() - Select the PCI device version and enable it.
 * @pdev:       PCI device to select version for and then enable.
 *
 * Context: Process context.
 * Return:
 * * 0 on success.
 * * Negative return value on failure.
 */
static int ne_pci_dev_enable(struct pci_dev *pdev)
{
        u8 dev_enable_reply = 0;
        u16 dev_version_reply = 0;
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        iowrite16(NE_VERSION_MAX, ne_pci_dev->iomem_base + NE_VERSION);

        dev_version_reply = ioread16(ne_pci_dev->iomem_base + NE_VERSION);
        if (dev_version_reply != NE_VERSION_MAX) {
                dev_err(&pdev->dev, "Error in pci dev version cmd\n");

                return -EIO;
        }

        iowrite8(NE_ENABLE_ON, ne_pci_dev->iomem_base + NE_ENABLE);

        dev_enable_reply = ioread8(ne_pci_dev->iomem_base + NE_ENABLE);
        if (dev_enable_reply != NE_ENABLE_ON) {
                dev_err(&pdev->dev, "Error in pci dev enable cmd\n");

                return -EIO;
        }

        return 0;
}

/**
 * ne_pci_dev_disable() - Disable the PCI device.
 * @pdev:       PCI device to disable.
 *
 * Context: Process context.
 */
static void ne_pci_dev_disable(struct pci_dev *pdev)
{
        u8 dev_disable_reply = 0;
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);
        const unsigned int sleep_time = 10; /* 10 ms */
        unsigned int sleep_time_count = 0;

        iowrite8(NE_ENABLE_OFF, ne_pci_dev->iomem_base + NE_ENABLE);

        /*
         * Check for NE_ENABLE_OFF in a loop, to handle cases when the device
         * state is not immediately set to disabled and going through a
         * transitory state of disabling.
         */
        while (sleep_time_count < NE_DEFAULT_TIMEOUT_MSECS) {
                dev_disable_reply = ioread8(ne_pci_dev->iomem_base + NE_ENABLE);
                if (dev_disable_reply == NE_ENABLE_OFF)
                        return;

                msleep_interruptible(sleep_time);
                sleep_time_count += sleep_time;
        }

        dev_disable_reply = ioread8(ne_pci_dev->iomem_base + NE_ENABLE);
        if (dev_disable_reply != NE_ENABLE_OFF)
                dev_err(&pdev->dev, "Error in pci dev disable cmd\n");
}

/**
 * ne_pci_probe() - Probe function for the NE PCI device.
 * @pdev:       PCI device to match with the NE PCI driver.
 * @id :        PCI device id table associated with the NE PCI driver.
 *
 * Context: Process context.
 * Return:
 * * 0 on success.
 * * Negative return value on failure.
 */
static int ne_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
{
        struct ne_pci_dev *ne_pci_dev = NULL;
        int rc = -EINVAL;

        ne_pci_dev = kzalloc_obj(*ne_pci_dev);
        if (!ne_pci_dev)
                return -ENOMEM;

        rc = pci_enable_device(pdev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in pci dev enable [rc=%d]\n", rc);

                goto free_ne_pci_dev;
        }

        pci_set_master(pdev);

        rc = pci_request_regions_exclusive(pdev, "nitro_enclaves");
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in pci request regions [rc=%d]\n", rc);

                goto disable_pci_dev;
        }

        ne_pci_dev->iomem_base = pci_iomap(pdev, PCI_BAR_NE, 0);
        if (!ne_pci_dev->iomem_base) {
                rc = -ENOMEM;

                dev_err(&pdev->dev, "Error in pci iomap [rc=%d]\n", rc);

                goto release_pci_regions;
        }

        pci_set_drvdata(pdev, ne_pci_dev);

        rc = ne_setup_msix(pdev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in pci dev msix setup [rc=%d]\n", rc);

                goto iounmap_pci_bar;
        }

        ne_pci_dev_disable(pdev);

        rc = ne_pci_dev_enable(pdev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in ne_pci_dev enable [rc=%d]\n", rc);

                goto teardown_msix;
        }

        atomic_set(&ne_pci_dev->cmd_reply_avail, 0);
        init_waitqueue_head(&ne_pci_dev->cmd_reply_wait_q);
        INIT_LIST_HEAD(&ne_pci_dev->enclaves_list);
        mutex_init(&ne_pci_dev->enclaves_list_mutex);
        mutex_init(&ne_pci_dev->pci_dev_mutex);
        ne_pci_dev->pdev = pdev;

        ne_devs.ne_pci_dev = ne_pci_dev;

        rc = misc_register(ne_devs.ne_misc_dev);
        if (rc < 0) {
                dev_err(&pdev->dev, "Error in misc dev register [rc=%d]\n", rc);

                goto disable_ne_pci_dev;
        }

        return 0;

disable_ne_pci_dev:
        ne_devs.ne_pci_dev = NULL;
        ne_pci_dev_disable(pdev);
teardown_msix:
        ne_teardown_msix(pdev);
iounmap_pci_bar:
        pci_set_drvdata(pdev, NULL);
        pci_iounmap(pdev, ne_pci_dev->iomem_base);
release_pci_regions:
        pci_release_regions(pdev);
disable_pci_dev:
        pci_disable_device(pdev);
free_ne_pci_dev:
        kfree(ne_pci_dev);

        return rc;
}

/**
 * ne_pci_remove() - Remove function for the NE PCI device.
 * @pdev:       PCI device associated with the NE PCI driver.
 *
 * Context: Process context.
 */
static void ne_pci_remove(struct pci_dev *pdev)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        misc_deregister(ne_devs.ne_misc_dev);

        ne_devs.ne_pci_dev = NULL;

        ne_pci_dev_disable(pdev);

        ne_teardown_msix(pdev);

        pci_set_drvdata(pdev, NULL);

        pci_iounmap(pdev, ne_pci_dev->iomem_base);

        pci_release_regions(pdev);

        pci_disable_device(pdev);

        kfree(ne_pci_dev);
}

/**
 * ne_pci_shutdown() - Shutdown function for the NE PCI device.
 * @pdev:       PCI device associated with the NE PCI driver.
 *
 * Context: Process context.
 */
static void ne_pci_shutdown(struct pci_dev *pdev)
{
        struct ne_pci_dev *ne_pci_dev = pci_get_drvdata(pdev);

        if (!ne_pci_dev)
                return;

        misc_deregister(ne_devs.ne_misc_dev);

        ne_devs.ne_pci_dev = NULL;

        ne_pci_dev_disable(pdev);

        ne_teardown_msix(pdev);

        pci_set_drvdata(pdev, NULL);

        pci_iounmap(pdev, ne_pci_dev->iomem_base);

        pci_release_regions(pdev);

        pci_disable_device(pdev);

        kfree(ne_pci_dev);
}

/*
 * TODO: Add suspend / resume functions for power management w/ CONFIG_PM, if
 * needed.
 */
/* NE PCI device driver. */
struct pci_driver ne_pci_driver = {
        .name           = "nitro_enclaves",
        .id_table       = ne_pci_ids,
        .probe          = ne_pci_probe,
        .remove         = ne_pci_remove,
        .shutdown       = ne_pci_shutdown,
};