dev/cfi/cfi_disk.c

87 	struct cfi_disk_softc *sc = device_get_softc(dev);
89 	sc->parent = device_get_softc(device_get_parent(dev));
91 	if (sc->parent->sc_width != 1 &&
92 	    sc->parent->sc_width != 2 &&
93 	    sc->parent->sc_width != 4)
96 	sc->disk = disk_alloc();
97 	if (sc->disk == NULL)
99 	sc->disk->d_name = "cfid";
100 	sc->disk->d_unit = device_get_unit(dev);
101 	sc->disk->d_open = cfi_disk_open;
102 	sc->disk->d_close = cfi_disk_close;
103 	sc->disk->d_strategy = cfi_disk_strategy;
104 	sc->disk->d_ioctl = cfi_disk_ioctl;
105 	sc->disk->d_dump = NULL;		/* NB: no dumps */
106 	sc->disk->d_getattr = cfi_disk_getattr;
107 	sc->disk->d_sectorsize = CFI_DISK_SECSIZE;
108 	sc->disk->d_mediasize = sc->parent->sc_size;
109 	sc->disk->d_maxsize = CFI_DISK_MAXIOSIZE;
111 	if (sc->parent->sc_regions) {
118 		sc->disk->d_stripesize =
119 		    sc->parent->sc_region[sc->parent->sc_regions-1].r_blksz;
121 		sc->disk->d_stripesize = sc->disk->d_mediasize;
122 	sc->disk->d_drv1 = sc;
123 	disk_create(sc->disk, DISK_VERSION);
125 	mtx_init(&sc->qlock, "CFID I/O lock", NULL, MTX_DEF);
126 	bioq_init(&sc->bioq);
128 	sc->tq = taskqueue_create("cfid_taskq", M_NOWAIT,
129 		taskqueue_thread_enqueue, &sc->tq);
130 	taskqueue_start_threads(&sc->tq, 1, PI_DISK, "cfid taskq");
132 	TASK_INIT(&sc->iotask, 0, cfi_io_proc, sc);
140 	struct cfi_disk_softc *sc = device_get_softc(dev);
142 	if (sc->flags & CFI_DISK_OPEN)
144 	taskqueue_free(sc->tq);
146 	disk_destroy(sc->disk);
147 	mtx_destroy(&sc->qlock);
154 	struct cfi_disk_softc *sc = dp->d_drv1;
157 	sc->flags |= CFI_DISK_OPEN;
164 	struct cfi_disk_softc *sc = dp->d_drv1;
166 	sc->flags &= ~CFI_DISK_OPEN;
171 cfi_disk_read(struct cfi_softc *sc, struct bio *bp)
175 	KASSERT(sc->sc_width == 1 || sc->sc_width == 2 || sc->sc_width == 4,
176 	    ("sc_width %d", sc->sc_width));
178 	if (sc->sc_writing) {
179 		bp->bio_error = cfi_block_finish(sc);
185 	if (bp->bio_offset > sc->sc_size) {
191 	if (sc->sc_width == 1) {
193 		while (resid > 0 && bp->bio_offset < sc->sc_size) {
194 			*dp++ = cfi_read_raw(sc, bp->bio_offset);
197 	} else if (sc->sc_width == 2) {
199 		while (resid > 0 && bp->bio_offset < sc->sc_size) {
200 			*dp++ = cfi_read_raw(sc, bp->bio_offset);
205 		while (resid > 0 && bp->bio_offset < sc->sc_size) {
206 			*dp++ = cfi_read_raw(sc, bp->bio_offset);
216 cfi_disk_write(struct cfi_softc *sc, struct bio *bp)
221 	KASSERT(sc->sc_width == 1 || sc->sc_width == 2 || sc->sc_width == 4,
222 	    ("sc_width %d", sc->sc_width));
224 	if (bp->bio_offset > sc->sc_size) {
235 		if (sc->sc_writing) {
236 			top = sc->sc_wrofs + sc->sc_wrbufsz;
237 			if (bp->bio_offset < sc->sc_wrofs ||
239 				cfi_block_finish(sc);
243 		if (!sc->sc_writing) {
244 			bp->bio_error = cfi_block_start(sc, bp->bio_offset);
251 		top = sc->sc_wrofs + sc->sc_wrbufsz;
253 		    sc->sc_wrbuf + bp->bio_offset - sc->sc_wrofs,
265 	struct cfi_disk_softc *sc = arg;
266 	struct cfi_softc *cfi = sc->parent;
270 		mtx_lock(&sc->qlock);
271 		bp = bioq_takefirst(&sc->bioq);
272 		mtx_unlock(&sc->qlock);
291 	struct cfi_softc *sc;
298 	sc = dsc->parent;
299 	dev = sc->sc_dev;
314 	struct cfi_disk_softc *sc = bp->bio_disk->d_drv1;
316 	if (sc == NULL)
326 		mtx_lock(&sc->qlock);
328 		bioq_insert_tail(&sc->bioq, bp);
329 		mtx_unlock(&sc->qlock);
330 		taskqueue_enqueue(sc->tq, &sc->iotask);