Home | History | Annotate | Line # | Download | only in pci
ld_virtio.c revision 1.18
      1  1.18  jakllsch /*	$NetBSD: ld_virtio.c,v 1.18 2018/06/03 19:47:35 jakllsch Exp $	*/
      2   1.1   hannken 
      3   1.1   hannken /*
      4   1.1   hannken  * Copyright (c) 2010 Minoura Makoto.
      5   1.1   hannken  * All rights reserved.
      6   1.1   hannken  *
      7   1.1   hannken  * Redistribution and use in source and binary forms, with or without
      8   1.1   hannken  * modification, are permitted provided that the following conditions
      9   1.1   hannken  * are met:
     10   1.1   hannken  * 1. Redistributions of source code must retain the above copyright
     11   1.1   hannken  *    notice, this list of conditions and the following disclaimer.
     12   1.1   hannken  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1   hannken  *    notice, this list of conditions and the following disclaimer in the
     14   1.1   hannken  *    documentation and/or other materials provided with the distribution.
     15   1.1   hannken  *
     16   1.1   hannken  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17   1.1   hannken  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18   1.1   hannken  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19   1.1   hannken  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20   1.1   hannken  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21   1.1   hannken  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22   1.1   hannken  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23   1.1   hannken  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24   1.1   hannken  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25   1.1   hannken  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26   1.1   hannken  */
     27   1.1   hannken 
     28   1.1   hannken #include <sys/cdefs.h>
     29  1.18  jakllsch __KERNEL_RCSID(0, "$NetBSD: ld_virtio.c,v 1.18 2018/06/03 19:47:35 jakllsch Exp $");
     30   1.1   hannken 
     31   1.1   hannken #include <sys/param.h>
     32   1.1   hannken #include <sys/systm.h>
     33   1.1   hannken #include <sys/kernel.h>
     34   1.1   hannken #include <sys/buf.h>
     35  1.11  jdolecek #include <sys/bufq.h>
     36   1.1   hannken #include <sys/bus.h>
     37   1.1   hannken #include <sys/device.h>
     38   1.1   hannken #include <sys/disk.h>
     39   1.1   hannken #include <sys/mutex.h>
     40  1.12  pgoyette #include <sys/module.h>
     41   1.1   hannken 
     42   1.1   hannken #include <dev/pci/pcidevs.h>
     43   1.1   hannken #include <dev/pci/pcireg.h>
     44   1.1   hannken #include <dev/pci/pcivar.h>
     45   1.1   hannken 
     46   1.1   hannken #include <dev/ldvar.h>
     47   1.1   hannken #include <dev/pci/virtioreg.h>
     48   1.1   hannken #include <dev/pci/virtiovar.h>
     49   1.1   hannken 
     50  1.12  pgoyette #include "ioconf.h"
     51  1.12  pgoyette 
     52   1.1   hannken /*
     53   1.1   hannken  * ld_virtioreg:
     54   1.1   hannken  */
     55   1.1   hannken /* Configuration registers */
     56   1.1   hannken #define VIRTIO_BLK_CONFIG_CAPACITY	0 /* 64bit */
     57   1.1   hannken #define VIRTIO_BLK_CONFIG_SIZE_MAX	8 /* 32bit */
     58   1.1   hannken #define VIRTIO_BLK_CONFIG_SEG_MAX	12 /* 32bit */
     59   1.1   hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_C	16 /* 16bit */
     60   1.1   hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_H	18 /* 8bit */
     61   1.1   hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_S	19 /* 8bit */
     62   1.1   hannken #define VIRTIO_BLK_CONFIG_BLK_SIZE	20 /* 32bit */
     63  1.18  jakllsch #define VIRTIO_BLK_CONFIG_WRITEBACK	32 /* 8bit */
     64   1.1   hannken 
     65   1.1   hannken /* Feature bits */
     66   1.1   hannken #define VIRTIO_BLK_F_BARRIER	(1<<0)
     67   1.1   hannken #define VIRTIO_BLK_F_SIZE_MAX	(1<<1)
     68   1.1   hannken #define VIRTIO_BLK_F_SEG_MAX	(1<<2)
     69   1.1   hannken #define VIRTIO_BLK_F_GEOMETRY	(1<<4)
     70   1.1   hannken #define VIRTIO_BLK_F_RO		(1<<5)
     71   1.1   hannken #define VIRTIO_BLK_F_BLK_SIZE	(1<<6)
     72   1.1   hannken #define VIRTIO_BLK_F_SCSI	(1<<7)
     73   1.1   hannken #define VIRTIO_BLK_F_FLUSH	(1<<9)
     74  1.18  jakllsch #define VIRTIO_BLK_F_TOPOLOGY	(1<<10)
     75  1.18  jakllsch #define VIRTIO_BLK_F_CONFIG_WCE	(1<<11)
     76   1.1   hannken 
     77  1.17  jakllsch /*
     78   1.9  christos  * Each block request uses at least two segments - one for the header
     79   1.9  christos  * and one for the status.
     80  1.17  jakllsch */
     81   1.9  christos #define	VIRTIO_BLK_MIN_SEGMENTS	2
     82   1.9  christos 
     83   1.9  christos #define VIRTIO_BLK_FLAG_BITS \
     84   1.9  christos 	VIRTIO_COMMON_FLAG_BITS \
     85  1.18  jakllsch 	"\x0c""CONFIG_WCE" \
     86  1.18  jakllsch 	"\x0b""TOPOLOGY" \
     87   1.9  christos 	"\x0a""FLUSH" \
     88   1.9  christos 	"\x08""SCSI" \
     89   1.9  christos 	"\x07""BLK_SIZE" \
     90   1.9  christos 	"\x06""RO" \
     91   1.9  christos 	"\x05""GEOMETRY" \
     92   1.9  christos 	"\x03""SEG_MAX" \
     93   1.9  christos 	"\x02""SIZE_MAX" \
     94   1.9  christos 	"\x01""BARRIER"
     95   1.9  christos 
     96   1.1   hannken /* Command */
     97   1.1   hannken #define VIRTIO_BLK_T_IN		0
     98   1.1   hannken #define VIRTIO_BLK_T_OUT	1
     99  1.18  jakllsch #define VIRTIO_BLK_T_FLUSH	4
    100   1.1   hannken #define VIRTIO_BLK_T_BARRIER	0x80000000
    101   1.1   hannken 
    102   1.1   hannken /* Status */
    103   1.1   hannken #define VIRTIO_BLK_S_OK		0
    104   1.1   hannken #define VIRTIO_BLK_S_IOERR	1
    105  1.18  jakllsch #define VIRTIO_BLK_S_UNSUPP	2
    106   1.1   hannken 
    107   1.1   hannken /* Request header structure */
    108   1.1   hannken struct virtio_blk_req_hdr {
    109   1.1   hannken 	uint32_t	type;	/* VIRTIO_BLK_T_* */
    110   1.1   hannken 	uint32_t	ioprio;
    111   1.1   hannken 	uint64_t	sector;
    112   1.1   hannken } __packed;
    113   1.1   hannken /* 512*virtio_blk_req_hdr.sector byte payload and 1 byte status follows */
    114   1.1   hannken 
    115   1.1   hannken 
    116   1.1   hannken /*
    117   1.1   hannken  * ld_virtiovar:
    118   1.1   hannken  */
    119   1.1   hannken struct virtio_blk_req {
    120   1.1   hannken 	struct virtio_blk_req_hdr	vr_hdr;
    121   1.1   hannken 	uint8_t				vr_status;
    122   1.1   hannken 	struct buf			*vr_bp;
    123   1.1   hannken 	bus_dmamap_t			vr_cmdsts;
    124   1.1   hannken 	bus_dmamap_t			vr_payload;
    125   1.1   hannken };
    126   1.1   hannken 
    127   1.1   hannken struct ld_virtio_softc {
    128   1.1   hannken 	struct ld_softc		sc_ld;
    129   1.1   hannken 	device_t		sc_dev;
    130   1.1   hannken 
    131   1.1   hannken 	struct virtio_softc	*sc_virtio;
    132   1.9  christos 	struct virtqueue	sc_vq;
    133   1.1   hannken 
    134   1.1   hannken 	struct virtio_blk_req	*sc_reqs;
    135   1.9  christos 	bus_dma_segment_t	sc_reqs_seg;
    136   1.1   hannken 
    137   1.1   hannken 	int			sc_readonly;
    138   1.1   hannken };
    139   1.1   hannken 
    140   1.1   hannken static int	ld_virtio_match(device_t, cfdata_t, void *);
    141   1.1   hannken static void	ld_virtio_attach(device_t, device_t, void *);
    142   1.1   hannken static int	ld_virtio_detach(device_t, int);
    143   1.1   hannken 
    144   1.1   hannken CFATTACH_DECL_NEW(ld_virtio, sizeof(struct ld_virtio_softc),
    145   1.1   hannken     ld_virtio_match, ld_virtio_attach, ld_virtio_detach, NULL);
    146   1.1   hannken 
    147   1.1   hannken static int
    148   1.1   hannken ld_virtio_match(device_t parent, cfdata_t match, void *aux)
    149   1.1   hannken {
    150  1.15  jdolecek 	struct virtio_attach_args *va = aux;
    151   1.1   hannken 
    152   1.1   hannken 	if (va->sc_childdevid == PCI_PRODUCT_VIRTIO_BLOCK)
    153   1.1   hannken 		return 1;
    154   1.1   hannken 
    155   1.1   hannken 	return 0;
    156   1.1   hannken }
    157   1.1   hannken 
    158   1.1   hannken static int ld_virtio_vq_done(struct virtqueue *);
    159   1.1   hannken static int ld_virtio_dump(struct ld_softc *, void *, int, int);
    160   1.1   hannken static int ld_virtio_start(struct ld_softc *, struct buf *);
    161   1.1   hannken 
    162   1.1   hannken static int
    163   1.1   hannken ld_virtio_alloc_reqs(struct ld_virtio_softc *sc, int qsize)
    164   1.1   hannken {
    165   1.1   hannken 	int allocsize, r, rsegs, i;
    166   1.1   hannken 	struct ld_softc *ld = &sc->sc_ld;
    167   1.1   hannken 	void *vaddr;
    168   1.1   hannken 
    169   1.1   hannken 	allocsize = sizeof(struct virtio_blk_req) * qsize;
    170  1.15  jdolecek 	r = bus_dmamem_alloc(virtio_dmat(sc->sc_virtio), allocsize, 0, 0,
    171   1.9  christos 			     &sc->sc_reqs_seg, 1, &rsegs, BUS_DMA_NOWAIT);
    172   1.1   hannken 	if (r != 0) {
    173   1.1   hannken 		aprint_error_dev(sc->sc_dev,
    174   1.1   hannken 				 "DMA memory allocation failed, size %d, "
    175   1.1   hannken 				 "error code %d\n", allocsize, r);
    176   1.1   hannken 		goto err_none;
    177   1.1   hannken 	}
    178  1.15  jdolecek 	r = bus_dmamem_map(virtio_dmat(sc->sc_virtio),
    179   1.9  christos 			   &sc->sc_reqs_seg, 1, allocsize,
    180   1.1   hannken 			   &vaddr, BUS_DMA_NOWAIT);
    181   1.1   hannken 	if (r != 0) {
    182   1.1   hannken 		aprint_error_dev(sc->sc_dev,
    183   1.1   hannken 				 "DMA memory map failed, "
    184   1.1   hannken 				 "error code %d\n", r);
    185   1.1   hannken 		goto err_dmamem_alloc;
    186   1.1   hannken 	}
    187   1.1   hannken 	sc->sc_reqs = vaddr;
    188   1.1   hannken 	memset(vaddr, 0, allocsize);
    189   1.1   hannken 	for (i = 0; i < qsize; i++) {
    190   1.1   hannken 		struct virtio_blk_req *vr = &sc->sc_reqs[i];
    191  1.15  jdolecek 		r = bus_dmamap_create(virtio_dmat(sc->sc_virtio),
    192   1.1   hannken 				      offsetof(struct virtio_blk_req, vr_bp),
    193   1.1   hannken 				      1,
    194   1.1   hannken 				      offsetof(struct virtio_blk_req, vr_bp),
    195   1.1   hannken 				      0,
    196   1.1   hannken 				      BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
    197   1.1   hannken 				      &vr->vr_cmdsts);
    198   1.1   hannken 		if (r != 0) {
    199   1.1   hannken 			aprint_error_dev(sc->sc_dev,
    200   1.1   hannken 					 "command dmamap creation failed, "
    201   1.1   hannken 					 "error code %d\n", r);
    202   1.1   hannken 			goto err_reqs;
    203   1.1   hannken 		}
    204  1.15  jdolecek 		r = bus_dmamap_load(virtio_dmat(sc->sc_virtio), vr->vr_cmdsts,
    205   1.1   hannken 				    &vr->vr_hdr,
    206   1.1   hannken 				    offsetof(struct virtio_blk_req, vr_bp),
    207   1.1   hannken 				    NULL, BUS_DMA_NOWAIT);
    208   1.1   hannken 		if (r != 0) {
    209   1.1   hannken 			aprint_error_dev(sc->sc_dev,
    210   1.1   hannken 					 "command dmamap load failed, "
    211   1.1   hannken 					 "error code %d\n", r);
    212   1.1   hannken 			goto err_reqs;
    213   1.1   hannken 		}
    214  1.15  jdolecek 		r = bus_dmamap_create(virtio_dmat(sc->sc_virtio),
    215   1.1   hannken 				      ld->sc_maxxfer,
    216   1.9  christos 				      (ld->sc_maxxfer / NBPG) +
    217   1.9  christos 				      VIRTIO_BLK_MIN_SEGMENTS,
    218   1.2   hannken 				      ld->sc_maxxfer,
    219   1.1   hannken 				      0,
    220   1.1   hannken 				      BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
    221   1.1   hannken 				      &vr->vr_payload);
    222   1.1   hannken 		if (r != 0) {
    223   1.1   hannken 			aprint_error_dev(sc->sc_dev,
    224   1.1   hannken 					 "payload dmamap creation failed, "
    225   1.1   hannken 					 "error code %d\n", r);
    226   1.1   hannken 			goto err_reqs;
    227   1.1   hannken 		}
    228   1.1   hannken 	}
    229   1.1   hannken 	return 0;
    230   1.1   hannken 
    231   1.1   hannken err_reqs:
    232   1.1   hannken 	for (i = 0; i < qsize; i++) {
    233   1.1   hannken 		struct virtio_blk_req *vr = &sc->sc_reqs[i];
    234   1.1   hannken 		if (vr->vr_cmdsts) {
    235  1.15  jdolecek 			bus_dmamap_destroy(virtio_dmat(sc->sc_virtio),
    236   1.1   hannken 					   vr->vr_cmdsts);
    237   1.1   hannken 			vr->vr_cmdsts = 0;
    238   1.1   hannken 		}
    239   1.1   hannken 		if (vr->vr_payload) {
    240  1.15  jdolecek 			bus_dmamap_destroy(virtio_dmat(sc->sc_virtio),
    241   1.1   hannken 					   vr->vr_payload);
    242   1.1   hannken 			vr->vr_payload = 0;
    243   1.1   hannken 		}
    244   1.1   hannken 	}
    245  1.15  jdolecek 	bus_dmamem_unmap(virtio_dmat(sc->sc_virtio), sc->sc_reqs, allocsize);
    246   1.1   hannken err_dmamem_alloc:
    247  1.15  jdolecek 	bus_dmamem_free(virtio_dmat(sc->sc_virtio), &sc->sc_reqs_seg, 1);
    248   1.1   hannken err_none:
    249   1.1   hannken 	return -1;
    250   1.1   hannken }
    251   1.1   hannken 
    252   1.1   hannken static void
    253   1.1   hannken ld_virtio_attach(device_t parent, device_t self, void *aux)
    254   1.1   hannken {
    255   1.1   hannken 	struct ld_virtio_softc *sc = device_private(self);
    256   1.1   hannken 	struct ld_softc *ld = &sc->sc_ld;
    257   1.1   hannken 	struct virtio_softc *vsc = device_private(parent);
    258   1.1   hannken 	uint32_t features;
    259   1.9  christos 	int qsize, maxxfersize, maxnsegs;
    260   1.1   hannken 
    261  1.15  jdolecek 	if (virtio_child(vsc) != NULL) {
    262   1.1   hannken 		aprint_normal(": child already attached for %s; "
    263  1.10   msaitoh 			      "something wrong...\n", device_xname(parent));
    264   1.1   hannken 		return;
    265   1.1   hannken 	}
    266   1.1   hannken 
    267   1.1   hannken 	sc->sc_dev = self;
    268   1.1   hannken 	sc->sc_virtio = vsc;
    269   1.1   hannken 
    270  1.15  jdolecek 	virtio_child_attach_start(vsc, self, IPL_BIO, &sc->sc_vq,
    271  1.15  jdolecek 	    NULL, virtio_vq_intr, 0,
    272  1.15  jdolecek 	    (VIRTIO_BLK_F_SIZE_MAX | VIRTIO_BLK_F_SEG_MAX |
    273  1.15  jdolecek 	     VIRTIO_BLK_F_GEOMETRY | VIRTIO_BLK_F_RO | VIRTIO_BLK_F_BLK_SIZE),
    274  1.15  jdolecek 	    VIRTIO_BLK_FLAG_BITS);
    275  1.15  jdolecek 
    276  1.15  jdolecek 	features = virtio_features(vsc);
    277  1.15  jdolecek 
    278   1.1   hannken 	if (features & VIRTIO_BLK_F_RO)
    279   1.1   hannken 		sc->sc_readonly = 1;
    280   1.1   hannken 	else
    281   1.1   hannken 		sc->sc_readonly = 0;
    282   1.1   hannken 
    283   1.3   hannken 	if (features & VIRTIO_BLK_F_BLK_SIZE) {
    284   1.3   hannken 		ld->sc_secsize = virtio_read_device_config_4(vsc,
    285   1.3   hannken 					VIRTIO_BLK_CONFIG_BLK_SIZE);
    286   1.9  christos 	} else
    287   1.9  christos 		ld->sc_secsize = 512;
    288   1.9  christos 
    289   1.9  christos 	/* At least genfs_io assumes maxxfer == MAXPHYS. */
    290   1.9  christos 	if (features & VIRTIO_BLK_F_SIZE_MAX) {
    291   1.1   hannken 		maxxfersize = virtio_read_device_config_4(vsc,
    292   1.9  christos 		    VIRTIO_BLK_CONFIG_SIZE_MAX);
    293   1.9  christos 		if (maxxfersize < MAXPHYS) {
    294   1.9  christos 			aprint_error_dev(sc->sc_dev,
    295   1.9  christos 			    "Too small SIZE_MAX %dK minimum is %dK\n",
    296   1.9  christos 			    maxxfersize / 1024, MAXPHYS / 1024);
    297   1.9  christos 			// goto err;
    298   1.9  christos 			maxxfersize = MAXPHYS;
    299   1.9  christos 		} else if (maxxfersize > MAXPHYS) {
    300   1.9  christos 			aprint_normal_dev(sc->sc_dev,
    301   1.9  christos 			    "Clip SEG_MAX from %dK to %dK\n",
    302   1.9  christos 			    maxxfersize / 1024,
    303   1.9  christos 			    MAXPHYS / 1024);
    304   1.1   hannken 			maxxfersize = MAXPHYS;
    305   1.9  christos 		}
    306   1.9  christos 	} else
    307   1.9  christos 		maxxfersize = MAXPHYS;
    308   1.9  christos 
    309   1.9  christos 	if (features & VIRTIO_BLK_F_SEG_MAX) {
    310   1.9  christos 		maxnsegs = virtio_read_device_config_4(vsc,
    311   1.9  christos 		    VIRTIO_BLK_CONFIG_SEG_MAX);
    312   1.9  christos 		if (maxnsegs < VIRTIO_BLK_MIN_SEGMENTS) {
    313   1.9  christos 			aprint_error_dev(sc->sc_dev,
    314   1.9  christos 			    "Too small SEG_MAX %d minimum is %d\n",
    315   1.9  christos 			    maxnsegs, VIRTIO_BLK_MIN_SEGMENTS);
    316   1.9  christos 			maxnsegs = maxxfersize / NBPG;
    317   1.9  christos 			// goto err;
    318   1.9  christos 		}
    319   1.9  christos 	} else
    320   1.9  christos 		maxnsegs = maxxfersize / NBPG;
    321   1.9  christos 
    322   1.9  christos 	/* 2 for the minimum size */
    323   1.9  christos 	maxnsegs += VIRTIO_BLK_MIN_SEGMENTS;
    324   1.1   hannken 
    325   1.9  christos 	if (virtio_alloc_vq(vsc, &sc->sc_vq, 0, maxxfersize, maxnsegs,
    326   1.9  christos 	    "I/O request") != 0) {
    327   1.1   hannken 		goto err;
    328   1.1   hannken 	}
    329   1.9  christos 	qsize = sc->sc_vq.vq_num;
    330   1.9  christos 	sc->sc_vq.vq_done = ld_virtio_vq_done;
    331   1.1   hannken 
    332  1.15  jdolecek 	if (virtio_child_attach_finish(vsc) != 0)
    333  1.15  jdolecek 		goto err;
    334  1.15  jdolecek 
    335   1.1   hannken 	ld->sc_dv = self;
    336   1.1   hannken 	ld->sc_secperunit = virtio_read_device_config_8(vsc,
    337   1.1   hannken 				VIRTIO_BLK_CONFIG_CAPACITY);
    338   1.1   hannken 	ld->sc_maxxfer = maxxfersize;
    339   1.1   hannken 	if (features & VIRTIO_BLK_F_GEOMETRY) {
    340   1.1   hannken 		ld->sc_ncylinders = virtio_read_device_config_2(vsc,
    341   1.1   hannken 					VIRTIO_BLK_CONFIG_GEOMETRY_C);
    342   1.1   hannken 		ld->sc_nheads     = virtio_read_device_config_1(vsc,
    343   1.1   hannken 					VIRTIO_BLK_CONFIG_GEOMETRY_H);
    344   1.1   hannken 		ld->sc_nsectors   = virtio_read_device_config_1(vsc,
    345   1.1   hannken 					VIRTIO_BLK_CONFIG_GEOMETRY_S);
    346   1.1   hannken 	}
    347   1.1   hannken 	ld->sc_maxqueuecnt = qsize;
    348   1.1   hannken 
    349   1.1   hannken 	if (ld_virtio_alloc_reqs(sc, qsize) < 0)
    350   1.1   hannken 		goto err;
    351   1.1   hannken 
    352   1.1   hannken 	ld->sc_dump = ld_virtio_dump;
    353   1.1   hannken 	ld->sc_start = ld_virtio_start;
    354   1.1   hannken 
    355  1.16   mlelstv 	ld->sc_flags = LDF_ENABLED | LDF_MPSAFE;
    356  1.11  jdolecek 	ldattach(ld, BUFQ_DISK_DEFAULT_STRAT);
    357   1.1   hannken 
    358   1.1   hannken 	return;
    359   1.1   hannken 
    360   1.1   hannken err:
    361  1.15  jdolecek 	virtio_child_attach_failed(vsc);
    362   1.1   hannken 	return;
    363   1.1   hannken }
    364   1.1   hannken 
    365   1.1   hannken static int
    366   1.1   hannken ld_virtio_start(struct ld_softc *ld, struct buf *bp)
    367   1.1   hannken {
    368   1.1   hannken 	/* splbio */
    369   1.1   hannken 	struct ld_virtio_softc *sc = device_private(ld->sc_dv);
    370   1.1   hannken 	struct virtio_softc *vsc = sc->sc_virtio;
    371   1.9  christos 	struct virtqueue *vq = &sc->sc_vq;
    372   1.1   hannken 	struct virtio_blk_req *vr;
    373   1.1   hannken 	int r;
    374   1.1   hannken 	int isread = (bp->b_flags & B_READ);
    375   1.1   hannken 	int slot;
    376   1.1   hannken 
    377   1.1   hannken 	if (sc->sc_readonly && !isread)
    378   1.1   hannken 		return EIO;
    379   1.1   hannken 
    380   1.1   hannken 	r = virtio_enqueue_prep(vsc, vq, &slot);
    381   1.1   hannken 	if (r != 0)
    382   1.1   hannken 		return r;
    383   1.9  christos 
    384   1.1   hannken 	vr = &sc->sc_reqs[slot];
    385   1.9  christos 	KASSERT(vr->vr_bp == NULL);
    386   1.9  christos 
    387  1.15  jdolecek 	r = bus_dmamap_load(virtio_dmat(vsc), vr->vr_payload,
    388   1.1   hannken 			    bp->b_data, bp->b_bcount, NULL,
    389   1.1   hannken 			    ((isread?BUS_DMA_READ:BUS_DMA_WRITE)
    390   1.1   hannken 			     |BUS_DMA_NOWAIT));
    391   1.9  christos 	if (r != 0) {
    392   1.9  christos 		aprint_error_dev(sc->sc_dev,
    393   1.9  christos 		    "payload dmamap failed, error code %d\n", r);
    394   1.9  christos 		virtio_enqueue_abort(vsc, vq, slot);
    395   1.1   hannken 		return r;
    396   1.9  christos 	}
    397   1.1   hannken 
    398   1.9  christos 	r = virtio_enqueue_reserve(vsc, vq, slot, vr->vr_payload->dm_nsegs +
    399   1.9  christos 	    VIRTIO_BLK_MIN_SEGMENTS);
    400   1.1   hannken 	if (r != 0) {
    401  1.15  jdolecek 		bus_dmamap_unload(virtio_dmat(vsc), vr->vr_payload);
    402   1.1   hannken 		return r;
    403   1.1   hannken 	}
    404   1.1   hannken 
    405   1.1   hannken 	vr->vr_bp = bp;
    406   1.1   hannken 	vr->vr_hdr.type = isread?VIRTIO_BLK_T_IN:VIRTIO_BLK_T_OUT;
    407   1.1   hannken 	vr->vr_hdr.ioprio = 0;
    408   1.1   hannken 	vr->vr_hdr.sector = bp->b_rawblkno * sc->sc_ld.sc_secsize / 512;
    409   1.1   hannken 
    410  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    411   1.1   hannken 			0, sizeof(struct virtio_blk_req_hdr),
    412   1.1   hannken 			BUS_DMASYNC_PREWRITE);
    413  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
    414   1.1   hannken 			0, bp->b_bcount,
    415   1.1   hannken 			isread?BUS_DMASYNC_PREREAD:BUS_DMASYNC_PREWRITE);
    416  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    417   1.1   hannken 			offsetof(struct virtio_blk_req, vr_status),
    418   1.1   hannken 			sizeof(uint8_t),
    419   1.1   hannken 			BUS_DMASYNC_PREREAD);
    420   1.1   hannken 
    421   1.1   hannken 	virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
    422   1.1   hannken 			 0, sizeof(struct virtio_blk_req_hdr),
    423   1.1   hannken 			 true);
    424   1.1   hannken 	virtio_enqueue(vsc, vq, slot, vr->vr_payload, !isread);
    425   1.1   hannken 	virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
    426   1.1   hannken 			 offsetof(struct virtio_blk_req, vr_status),
    427   1.1   hannken 			 sizeof(uint8_t),
    428   1.1   hannken 			 false);
    429   1.1   hannken 	virtio_enqueue_commit(vsc, vq, slot, true);
    430   1.1   hannken 
    431   1.1   hannken 	return 0;
    432   1.1   hannken }
    433   1.1   hannken 
    434   1.1   hannken static void
    435   1.1   hannken ld_virtio_vq_done1(struct ld_virtio_softc *sc, struct virtio_softc *vsc,
    436   1.1   hannken 		   struct virtqueue *vq, int slot)
    437   1.1   hannken {
    438   1.1   hannken 	struct virtio_blk_req *vr = &sc->sc_reqs[slot];
    439   1.1   hannken 	struct buf *bp = vr->vr_bp;
    440   1.1   hannken 
    441   1.9  christos 	vr->vr_bp = NULL;
    442   1.9  christos 
    443  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    444   1.1   hannken 			0, sizeof(struct virtio_blk_req_hdr),
    445   1.1   hannken 			BUS_DMASYNC_POSTWRITE);
    446  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
    447   1.1   hannken 			0, bp->b_bcount,
    448   1.1   hannken 			(bp->b_flags & B_READ)?BUS_DMASYNC_POSTREAD
    449   1.1   hannken 					      :BUS_DMASYNC_POSTWRITE);
    450  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    451   1.1   hannken 			sizeof(struct virtio_blk_req_hdr), sizeof(uint8_t),
    452   1.1   hannken 			BUS_DMASYNC_POSTREAD);
    453   1.1   hannken 
    454   1.1   hannken 	if (vr->vr_status != VIRTIO_BLK_S_OK) {
    455   1.1   hannken 		bp->b_error = EIO;
    456   1.1   hannken 		bp->b_resid = bp->b_bcount;
    457   1.1   hannken 	} else {
    458   1.1   hannken 		bp->b_error = 0;
    459   1.1   hannken 		bp->b_resid = 0;
    460   1.1   hannken 	}
    461   1.1   hannken 
    462   1.1   hannken 	virtio_dequeue_commit(vsc, vq, slot);
    463   1.1   hannken 
    464   1.1   hannken 	lddone(&sc->sc_ld, bp);
    465   1.1   hannken }
    466   1.1   hannken 
    467   1.1   hannken static int
    468   1.1   hannken ld_virtio_vq_done(struct virtqueue *vq)
    469   1.1   hannken {
    470   1.1   hannken 	struct virtio_softc *vsc = vq->vq_owner;
    471  1.15  jdolecek 	struct ld_virtio_softc *sc = device_private(virtio_child(vsc));
    472   1.1   hannken 	int r = 0;
    473   1.1   hannken 	int slot;
    474   1.1   hannken 
    475   1.1   hannken again:
    476   1.1   hannken 	if (virtio_dequeue(vsc, vq, &slot, NULL))
    477   1.1   hannken 		return r;
    478   1.1   hannken 	r = 1;
    479   1.1   hannken 
    480   1.1   hannken 	ld_virtio_vq_done1(sc, vsc, vq, slot);
    481   1.1   hannken 	goto again;
    482   1.1   hannken }
    483   1.1   hannken 
    484   1.1   hannken static int
    485   1.1   hannken ld_virtio_dump(struct ld_softc *ld, void *data, int blkno, int blkcnt)
    486   1.1   hannken {
    487   1.1   hannken 	struct ld_virtio_softc *sc = device_private(ld->sc_dv);
    488   1.1   hannken 	struct virtio_softc *vsc = sc->sc_virtio;
    489   1.9  christos 	struct virtqueue *vq = &sc->sc_vq;
    490   1.1   hannken 	struct virtio_blk_req *vr;
    491   1.1   hannken 	int slot, r;
    492   1.1   hannken 
    493   1.1   hannken 	if (sc->sc_readonly)
    494   1.1   hannken 		return EIO;
    495   1.1   hannken 
    496   1.1   hannken 	r = virtio_enqueue_prep(vsc, vq, &slot);
    497   1.1   hannken 	if (r != 0) {
    498   1.1   hannken 		if (r == EAGAIN) { /* no free slot; dequeue first */
    499   1.1   hannken 			delay(100);
    500   1.1   hannken 			ld_virtio_vq_done(vq);
    501   1.1   hannken 			r = virtio_enqueue_prep(vsc, vq, &slot);
    502   1.1   hannken 			if (r != 0)
    503   1.1   hannken 				return r;
    504   1.1   hannken 		}
    505   1.1   hannken 		return r;
    506   1.1   hannken 	}
    507   1.1   hannken 	vr = &sc->sc_reqs[slot];
    508  1.15  jdolecek 	r = bus_dmamap_load(virtio_dmat(vsc), vr->vr_payload,
    509   1.1   hannken 			    data, blkcnt*ld->sc_secsize, NULL,
    510   1.1   hannken 			    BUS_DMA_WRITE|BUS_DMA_NOWAIT);
    511   1.1   hannken 	if (r != 0)
    512   1.1   hannken 		return r;
    513   1.1   hannken 
    514  1.17  jakllsch 	r = virtio_enqueue_reserve(vsc, vq, slot, vr->vr_payload->dm_nsegs +
    515   1.9  christos 	    VIRTIO_BLK_MIN_SEGMENTS);
    516   1.1   hannken 	if (r != 0) {
    517  1.15  jdolecek 		bus_dmamap_unload(virtio_dmat(vsc), vr->vr_payload);
    518   1.1   hannken 		return r;
    519   1.1   hannken 	}
    520   1.1   hannken 
    521   1.1   hannken 	vr->vr_bp = (void*)0xdeadbeef;
    522   1.1   hannken 	vr->vr_hdr.type = VIRTIO_BLK_T_OUT;
    523   1.1   hannken 	vr->vr_hdr.ioprio = 0;
    524   1.1   hannken 	vr->vr_hdr.sector = (daddr_t) blkno * ld->sc_secsize / 512;
    525   1.1   hannken 
    526  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    527   1.1   hannken 			0, sizeof(struct virtio_blk_req_hdr),
    528   1.1   hannken 			BUS_DMASYNC_PREWRITE);
    529  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
    530   1.1   hannken 			0, blkcnt*ld->sc_secsize,
    531   1.1   hannken 			BUS_DMASYNC_PREWRITE);
    532  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    533   1.1   hannken 			offsetof(struct virtio_blk_req, vr_status),
    534   1.1   hannken 			sizeof(uint8_t),
    535   1.1   hannken 			BUS_DMASYNC_PREREAD);
    536   1.1   hannken 
    537   1.1   hannken 	virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
    538   1.1   hannken 			 0, sizeof(struct virtio_blk_req_hdr),
    539   1.1   hannken 			 true);
    540   1.1   hannken 	virtio_enqueue(vsc, vq, slot, vr->vr_payload, true);
    541   1.1   hannken 	virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
    542   1.1   hannken 			 offsetof(struct virtio_blk_req, vr_status),
    543   1.1   hannken 			 sizeof(uint8_t),
    544   1.1   hannken 			 false);
    545   1.1   hannken 	virtio_enqueue_commit(vsc, vq, slot, true);
    546   1.1   hannken 
    547   1.1   hannken 	for ( ; ; ) {
    548   1.1   hannken 		int dslot;
    549   1.1   hannken 
    550   1.1   hannken 		r = virtio_dequeue(vsc, vq, &dslot, NULL);
    551   1.1   hannken 		if (r != 0)
    552   1.1   hannken 			continue;
    553   1.1   hannken 		if (dslot != slot) {
    554   1.1   hannken 			ld_virtio_vq_done1(sc, vsc, vq, dslot);
    555   1.1   hannken 			continue;
    556   1.1   hannken 		} else
    557   1.1   hannken 			break;
    558   1.1   hannken 	}
    559  1.17  jakllsch 
    560  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    561   1.1   hannken 			0, sizeof(struct virtio_blk_req_hdr),
    562   1.1   hannken 			BUS_DMASYNC_POSTWRITE);
    563  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
    564   1.1   hannken 			0, blkcnt*ld->sc_secsize,
    565   1.1   hannken 			BUS_DMASYNC_POSTWRITE);
    566  1.15  jdolecek 	bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
    567   1.1   hannken 			offsetof(struct virtio_blk_req, vr_status),
    568   1.1   hannken 			sizeof(uint8_t),
    569   1.1   hannken 			BUS_DMASYNC_POSTREAD);
    570   1.1   hannken 	if (vr->vr_status == VIRTIO_BLK_S_OK)
    571   1.1   hannken 		r = 0;
    572   1.1   hannken 	else
    573   1.1   hannken 		r = EIO;
    574   1.1   hannken 	virtio_dequeue_commit(vsc, vq, slot);
    575   1.1   hannken 
    576   1.1   hannken 	return r;
    577   1.1   hannken }
    578   1.1   hannken 
    579   1.1   hannken static int
    580   1.1   hannken ld_virtio_detach(device_t self, int flags)
    581   1.1   hannken {
    582   1.1   hannken 	struct ld_virtio_softc *sc = device_private(self);
    583   1.1   hannken 	struct ld_softc *ld = &sc->sc_ld;
    584  1.15  jdolecek 	bus_dma_tag_t dmat = virtio_dmat(sc->sc_virtio);
    585   1.1   hannken 	int r, i, qsize;
    586   1.1   hannken 
    587   1.9  christos 	qsize = sc->sc_vq.vq_num;
    588   1.1   hannken 	r = ldbegindetach(ld, flags);
    589   1.1   hannken 	if (r != 0)
    590   1.1   hannken 		return r;
    591   1.1   hannken 	virtio_reset(sc->sc_virtio);
    592   1.9  christos 	virtio_free_vq(sc->sc_virtio, &sc->sc_vq);
    593   1.1   hannken 
    594   1.1   hannken 	for (i = 0; i < qsize; i++) {
    595   1.1   hannken 		bus_dmamap_destroy(dmat,
    596   1.1   hannken 				   sc->sc_reqs[i].vr_cmdsts);
    597   1.1   hannken 		bus_dmamap_destroy(dmat,
    598   1.1   hannken 				   sc->sc_reqs[i].vr_payload);
    599   1.1   hannken 	}
    600   1.1   hannken 	bus_dmamem_unmap(dmat, sc->sc_reqs,
    601   1.1   hannken 			 sizeof(struct virtio_blk_req) * qsize);
    602   1.9  christos 	bus_dmamem_free(dmat, &sc->sc_reqs_seg, 1);
    603   1.1   hannken 
    604   1.1   hannken 	ldenddetach(ld);
    605   1.1   hannken 
    606  1.15  jdolecek 	virtio_child_detach(sc->sc_virtio);
    607  1.15  jdolecek 
    608   1.1   hannken 	return 0;
    609   1.1   hannken }
    610  1.12  pgoyette 
    611  1.12  pgoyette MODULE(MODULE_CLASS_DRIVER, ld_virtio, "ld,virtio");
    612  1.12  pgoyette 
    613  1.12  pgoyette #ifdef _MODULE
    614  1.12  pgoyette /*
    615  1.12  pgoyette  * XXX Don't allow ioconf.c to redefine the "struct cfdriver ld_cd"
    616  1.12  pgoyette  * XXX it will be defined in the common-code module
    617  1.12  pgoyette  */
    618  1.12  pgoyette #undef  CFDRIVER_DECL
    619  1.12  pgoyette #define CFDRIVER_DECL(name, class, attr)
    620  1.12  pgoyette #include "ioconf.c"
    621  1.12  pgoyette #endif
    622  1.17  jakllsch 
    623  1.12  pgoyette static int
    624  1.12  pgoyette ld_virtio_modcmd(modcmd_t cmd, void *opaque)
    625  1.12  pgoyette {
    626  1.12  pgoyette #ifdef _MODULE
    627  1.12  pgoyette 	/*
    628  1.12  pgoyette 	 * We ignore the cfdriver_vec[] that ioconf provides, since
    629  1.12  pgoyette 	 * the cfdrivers are attached already.
    630  1.12  pgoyette 	 */
    631  1.12  pgoyette 	static struct cfdriver * const no_cfdriver_vec[] = { NULL };
    632  1.12  pgoyette #endif
    633  1.12  pgoyette 	int error = 0;
    634  1.17  jakllsch 
    635  1.12  pgoyette #ifdef _MODULE
    636  1.12  pgoyette 	switch (cmd) {
    637  1.12  pgoyette 	case MODULE_CMD_INIT:
    638  1.12  pgoyette 		error = config_init_component(no_cfdriver_vec,
    639  1.12  pgoyette 		    cfattach_ioconf_ld_virtio, cfdata_ioconf_ld_virtio);
    640  1.12  pgoyette 		break;
    641  1.12  pgoyette 	case MODULE_CMD_FINI:
    642  1.12  pgoyette 		error = config_fini_component(no_cfdriver_vec,
    643  1.12  pgoyette 		    cfattach_ioconf_ld_virtio, cfdata_ioconf_ld_virtio);
    644  1.12  pgoyette 		break;
    645  1.12  pgoyette 	default:
    646  1.12  pgoyette 		error = ENOTTY;
    647  1.12  pgoyette 		break;
    648  1.12  pgoyette 	}
    649  1.12  pgoyette #endif
    650  1.12  pgoyette 
    651  1.12  pgoyette 	return error;
    652  1.12  pgoyette }
    653