Quelle  nd_virtio.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * virtio_pmem.c: Virtio pmem Driver
 *
 * Discovers persistent memory range information
 * from host and provides a virtio based flushing
 * interface.
 */
#include "virtio_pmem.h"
#include "nd.h"

 /* The interrupt handler */
void virtio_pmem_host_ack(struct virtqueue *vq)
{
 struct virtio_pmem *vpmem = vq->vdev->priv;
 struct virtio_pmem_request *req_data, *req_buf;
 unsigned long flags;
 unsigned int len;

 spin_lock_irqsave(&vpmem->pmem_lock, flags);
 while ((req_data = virtqueue_get_buf(vq, &len)) != NULL) {
  req_data->done = true;
  wake_up(&req_data->host_acked);

  if (!list_empty(&vpmem->req_list)) {
   req_buf = list_first_entry(&vpmem->req_list,
     struct virtio_pmem_request, list);
   req_buf->wq_buf_avail = true;
   wake_up(&req_buf->wq_buf);
   list_del(&req_buf->list);
  }
 }
 spin_unlock_irqrestore(&vpmem->pmem_lock, flags);
}
EXPORT_SYMBOL_GPL(virtio_pmem_host_ack);

 /* The request submission function */
static int virtio_pmem_flush(struct nd_region *nd_region)
{
 struct virtio_device *vdev = nd_region->provider_data;
 struct virtio_pmem *vpmem  = vdev->priv;
 struct virtio_pmem_request *req_data;
 struct scatterlist *sgs[2], sg, ret;
 unsigned long flags;
 int err, err1;

 /*
 * Don't bother to submit the request to the device if the device is
 * not activated.
 */
 if (vdev->config->get_status(vdev) & VIRTIO_CONFIG_S_NEEDS_RESET) {
  dev_info(&vdev->dev, "virtio pmem device needs a reset\n");
  return -EIO;
 }

 might_sleep();
 req_data = kmalloc(sizeof(*req_data), GFP_KERNEL);
 if (!req_data)
  return -ENOMEM;

 req_data->done = false;
 init_waitqueue_head(&req_data->host_acked);
 init_waitqueue_head(&req_data->wq_buf);
 INIT_LIST_HEAD(&req_data->list);
 req_data->req.type = cpu_to_le32(VIRTIO_PMEM_REQ_TYPE_FLUSH);
 sg_init_one(&sg, &req_data->req, sizeof(req_data->req));
 sgs[0] = &sg;
 sg_init_one(&ret, &req_data->resp.ret, sizeof(req_data->resp));
 sgs[1] = &ret;

 spin_lock_irqsave(&vpmem->pmem_lock, flags);
  /*
  * If virtqueue_add_sgs returns -ENOSPC then req_vq virtual
  * queue does not have free descriptor. We add the request
  * to req_list and wait for host_ack to wake us up when free
  * slots are available.
  */
 while ((err = virtqueue_add_sgs(vpmem->req_vq, sgs, 1, 1, req_data,
     GFP_ATOMIC)) == -ENOSPC) {

  dev_info(&vdev->dev, "failed to send command to virtio pmem device, no free slots in the virtqueue\n");
  req_data->wq_buf_avail = false;
  list_add_tail(&req_data->list, &vpmem->req_list);
  spin_unlock_irqrestore(&vpmem->pmem_lock, flags);

  /* A host response results in "host_ack" getting called */
  wait_event(req_data->wq_buf, req_data->wq_buf_avail);
  spin_lock_irqsave(&vpmem->pmem_lock, flags);
 }
 err1 = virtqueue_kick(vpmem->req_vq);
 spin_unlock_irqrestore(&vpmem->pmem_lock, flags);
 /*
 * virtqueue_add_sgs failed with error different than -ENOSPC, we can't
 * do anything about that.
 */
 if (err || !err1) {
  dev_info(&vdev->dev, "failed to send command to virtio pmem device\n");
  err = -EIO;
 } else {
  /* A host response results in "host_ack" getting called */
  wait_event(req_data->host_acked, req_data->done);
  err = le32_to_cpu(req_data->resp.ret);
 }

 kfree(req_data);
 return err;
};

/* The asynchronous flush callback function */
int async_pmem_flush(struct nd_region *nd_region, struct bio *bio)
{
 /*
 * Create child bio for asynchronous flush and chain with
 * parent bio. Otherwise directly call nd_region flush.
 */
 if (bio && bio->bi_iter.bi_sector != -1) {
  struct bio *child = bio_alloc(bio->bi_bdev, 0,
           REQ_OP_WRITE | REQ_PREFLUSH,
           GFP_ATOMIC);

  if (!child)
   return -ENOMEM;
  bio_clone_blkg_association(child, bio);
  child->bi_iter.bi_sector = -1;
  bio_chain(child, bio);
  submit_bio(child);
  return 0;
 }
 if (virtio_pmem_flush(nd_region))
  return -EIO;

 return 0;
};
EXPORT_SYMBOL_GPL(async_pmem_flush);
MODULE_DESCRIPTION("Virtio Persistent Memory Driver");
MODULE_LICENSE("GPL");