bmd.c revision 1.21
1 /* $NetBSD: bmd.c,v 1.21 2014/07/25 08:10:35 dholland Exp $ */ 2 3 /* 4 * Copyright (c) 2002 Tetsuya Isaki. All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 20 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 22 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 23 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 */ 27 28 /* 29 * Nereid bank memory disk 30 */ 31 32 #include <sys/cdefs.h> 33 __KERNEL_RCSID(0, "$NetBSD: bmd.c,v 1.21 2014/07/25 08:10:35 dholland Exp $"); 34 35 #include <sys/param.h> 36 #include <sys/systm.h> 37 #include <sys/buf.h> 38 #include <sys/conf.h> 39 #include <sys/device.h> 40 #include <sys/kernel.h> 41 #include <sys/stat.h> 42 #include <sys/disk.h> 43 #include <sys/disklabel.h> 44 #include <sys/ioctl.h> 45 #include <sys/fcntl.h> 46 #include <sys/proc.h> 47 48 #include <machine/bus.h> 49 #include <machine/cpu.h> 50 51 #include <arch/x68k/dev/intiovar.h> 52 53 #define BMD_ADDR1 (0xece3f0) 54 #define BMD_ADDR2 (0xecebf0) 55 56 #define BMD_PAGESIZE (0x10000) /* 64KB */ 57 #define BMD_BSIZE (512) 58 #define BLKS_PER_PAGE (BMD_PAGESIZE / BMD_BSIZE) 59 60 #define BMD_PAGE (0) 61 #define BMD_CTRL (1) 62 #define BMD_CTRL_ENABLE (0x80) /* DIP8: 1=Enable, 0=Disable */ 63 #define BMD_CTRL_MEMORY (0x40) /* 1=16M available, 0=4M available */ 64 #define BMD_CTRL_WINDOW (0x20) /* DIP6: 1=0xee0000, 0=0xef0000 */ 65 66 67 #define BMD_UNIT(dev) (minor(dev) / 8) 68 69 #ifdef BMD_DEBUG 70 #define DPRINTF(x) printf x 71 #else 72 #define DPRINTF(x) /* nothing */ 73 #endif 74 75 struct bmd_softc { 76 struct disk sc_dkdev; 77 bus_space_tag_t sc_iot; 78 bus_space_handle_t sc_ioh; 79 bus_space_handle_t sc_bank; 80 81 int sc_maxpage; 82 int sc_window; 83 84 int sc_flags; 85 #define BMD_OPENBLK (0x01) 86 #define BMD_OPENCHR (0x02) 87 #define BMD_OPEN (BMD_OPENBLK | BMD_OPENCHR) 88 }; 89 90 static int bmd_match(device_t, cfdata_t, void *); 91 static void bmd_attach(device_t, device_t, void *); 92 static int bmd_getdisklabel(struct bmd_softc *, dev_t); 93 94 extern struct cfdriver bmd_cd; 95 96 CFATTACH_DECL_NEW(bmd, sizeof(struct bmd_softc), 97 bmd_match, bmd_attach, NULL, NULL); 98 99 dev_type_open(bmdopen); 100 dev_type_close(bmdclose); 101 dev_type_read(bmdread); 102 dev_type_write(bmdwrite); 103 dev_type_ioctl(bmdioctl); 104 dev_type_strategy(bmdstrategy); 105 dev_type_dump(bmddump); 106 dev_type_size(bmdsize); 107 108 const struct bdevsw bmd_bdevsw = { 109 .d_open = bmdopen, 110 .d_close = bmdclose, 111 .d_strategy = bmdstrategy, 112 .d_ioctl = bmdioctl, 113 .d_dump = bmddump, 114 .d_psize = bmdsize, 115 .d_discard = nodiscard, 116 .d_flag = D_DISK 117 }; 118 119 const struct cdevsw bmd_cdevsw = { 120 .d_open = bmdopen, 121 .d_close = bmdclose, 122 .d_read = bmdread, 123 .d_write = bmdwrite, 124 .d_ioctl = bmdioctl, 125 .d_stop = nostop, 126 .d_tty = notty, 127 .d_poll = nopoll, 128 .d_mmap = nommap, 129 .d_kqfilter = nokqfilter, 130 .d_discard = nodiscard, 131 .d_flag = D_DISK 132 }; 133 134 struct dkdriver bmddkdriver = { bmdstrategy }; 135 136 static int 137 bmd_match(device_t parent, cfdata_t cf, void *aux) 138 { 139 struct intio_attach_args *ia = aux; 140 bus_space_tag_t iot = ia->ia_bst; 141 bus_space_handle_t ioh; 142 int window; 143 int r; 144 145 if (ia->ia_addr == INTIOCF_ADDR_DEFAULT) 146 ia->ia_addr = BMD_ADDR1; 147 148 /* fixed parameter */ 149 if (ia->ia_addr != BMD_ADDR1 && ia->ia_addr != BMD_ADDR2) 150 return (0); 151 152 /* Check CTRL addr */ 153 if (badaddr((void *)IIOV(ia->ia_addr))) 154 return (0); 155 156 ia->ia_size = 2; 157 if (bus_space_map(iot, ia->ia_addr, ia->ia_size, 0, &ioh)) 158 return (0); 159 160 /* Check window addr */ 161 r = bus_space_read_1(iot, ioh, BMD_CTRL); 162 bus_space_unmap(iot, ioh, ia->ia_size); 163 164 if ((r & BMD_CTRL_WINDOW)) 165 window = 0xef0000; 166 else 167 window = 0xee0000; 168 if (badaddr((void *)IIOV(window))) 169 return (0); 170 171 return (1); 172 } 173 174 static void 175 bmd_attach(device_t parent, device_t self, void *aux) 176 { 177 struct bmd_softc *sc = device_private(self); 178 struct intio_attach_args *ia = aux; 179 bus_space_tag_t iot = ia->ia_bst; 180 bus_space_handle_t ioh; 181 u_int8_t r; 182 183 aprint_normal(": Nereid Bank Memory Disk\n"); 184 185 /* Map I/O space */ 186 ia->ia_size = 2; 187 if (bus_space_map(iot, ia->ia_addr, ia->ia_size, 0, &ioh)) { 188 aprint_error_dev(self, "can't map I/O space\n"); 189 return; 190 } 191 192 sc->sc_iot = iot; 193 sc->sc_ioh = ioh; 194 195 /* read control register */ 196 r = bus_space_read_1(sc->sc_iot, sc->sc_ioh, BMD_CTRL); 197 198 /* check enable-bit */ 199 if ((r & BMD_CTRL_ENABLE) == 0) { 200 aprint_error_dev(self, "disabled by DIP-SW 8\n"); 201 return; 202 } 203 204 if ((r & BMD_CTRL_MEMORY)) 205 sc->sc_maxpage = 256; 206 else 207 sc->sc_maxpage = 64; 208 209 if ((r & BMD_CTRL_WINDOW)) 210 sc->sc_window = 0xef0000; 211 else 212 sc->sc_window = 0xee0000; 213 214 /* Map bank area */ 215 if (bus_space_map(iot, sc->sc_window, BMD_PAGESIZE, 0, &sc->sc_bank)) { 216 aprint_error_dev(self, "can't map bank area: 0x%x\n", 217 sc->sc_window); 218 return; 219 } 220 221 aprint_normal_dev(self, "%d MB, 0x%x(64KB) x %d pages\n", 222 (sc->sc_maxpage / 16), sc->sc_window, sc->sc_maxpage); 223 224 disk_init(&sc->sc_dkdev, device_xname(self), &bmddkdriver); 225 disk_attach(&sc->sc_dkdev); 226 } 227 228 int 229 bmdopen(dev_t dev, int oflags, int devtype, struct lwp *l) 230 { 231 struct bmd_softc *sc; 232 233 DPRINTF(("%s%d\n", __func__, unit)); 234 235 sc = device_lookup_private(&bmd_cd, BMD_UNIT(dev)); 236 if (sc == NULL) 237 return ENXIO; 238 239 switch (devtype) { 240 case S_IFCHR: 241 sc->sc_flags |= BMD_OPENCHR; 242 break; 243 case S_IFBLK: 244 sc->sc_flags |= BMD_OPENBLK; 245 break; 246 } 247 248 bmd_getdisklabel(sc, dev); 249 250 return (0); 251 } 252 253 int 254 bmdclose(dev_t dev, int fflag, int devtype, struct lwp *l) 255 { 256 struct bmd_softc *sc = device_lookup_private(&bmd_cd, BMD_UNIT(dev)); 257 258 DPRINTF(("%s%d\n", __func__, BMD_UNIT(dev))); 259 260 switch (devtype) { 261 case S_IFCHR: 262 sc->sc_flags &= ~BMD_OPENCHR; 263 break; 264 case S_IFBLK: 265 sc->sc_flags &= ~BMD_OPENBLK; 266 break; 267 } 268 269 return (0); 270 } 271 272 void 273 bmdstrategy(struct buf *bp) 274 { 275 int unit = BMD_UNIT(bp->b_dev); 276 struct bmd_softc *sc; 277 int offset, disksize, resid; 278 int page, pg_offset, pg_resid; 279 void *data; 280 281 if (unit >= bmd_cd.cd_ndevs) { 282 bp->b_error = ENXIO; 283 goto done; 284 } 285 286 sc = device_lookup_private(&bmd_cd, BMD_UNIT(bp->b_dev)); 287 if (sc == NULL) { 288 bp->b_error = ENXIO; 289 goto done; 290 } 291 292 DPRINTF(("bmdstrategy: %s blkno %d bcount %ld:", 293 (bp->b_flags & B_READ) ? "read " : "write", 294 bp->b_blkno, bp->b_bcount)); 295 296 bp->b_resid = bp->b_bcount; 297 offset = (bp->b_blkno << DEV_BSHIFT); 298 disksize = sc->sc_maxpage * BMD_PAGESIZE; 299 if (offset >= disksize) { 300 /* EOF if read, EIO if write */ 301 if (bp->b_flags & B_READ) 302 goto done; 303 bp->b_error = EIO; 304 goto done; 305 } 306 307 resid = bp->b_resid; 308 if (resid > disksize - offset) 309 resid = disksize - offset; 310 311 data = bp->b_data; 312 do { 313 page = offset / BMD_PAGESIZE; 314 pg_offset = offset % BMD_PAGESIZE; 315 316 /* length */ 317 pg_resid = MIN(resid, BMD_PAGESIZE - pg_offset); 318 319 /* switch bank page */ 320 bus_space_write_1(sc->sc_iot, sc->sc_ioh, BMD_PAGE, page); 321 322 /* XXX we should use DMA transfer? */ 323 if ((bp->b_flags & B_READ)) { 324 bus_space_read_region_1(sc->sc_iot, sc->sc_bank, 325 pg_offset, data, pg_resid); 326 } else { 327 bus_space_write_region_1(sc->sc_iot, sc->sc_bank, 328 pg_offset, data, pg_resid); 329 } 330 331 data = (char *)data + pg_resid; 332 offset += pg_resid; 333 resid -= pg_resid; 334 bp->b_resid -= pg_resid; 335 } while (resid > 0); 336 337 DPRINTF(("\n")); 338 339 done: 340 biodone(bp); 341 } 342 343 int 344 bmdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l) 345 { 346 struct bmd_softc *sc; 347 struct disklabel dl; 348 int error; 349 350 DPRINTF(("%s%d %ld\n", __func__, BMD_UNIT(dev), cmd)); 351 352 sc = device_lookup_private(&bmd_cd, BMD_UNIT(dev)); 353 if (sc == NULL) 354 return ENXIO; 355 356 switch (cmd) { 357 case DIOCGDINFO: 358 *(struct disklabel *)data = *(sc->sc_dkdev.dk_label); 359 break; 360 361 case DIOCWDINFO: 362 if ((flag & FWRITE) == 0) 363 return EBADF; 364 365 error = setdisklabel(&dl, (struct disklabel *)data, 0, NULL); 366 if (error) 367 return error; 368 error = writedisklabel(dev, bmdstrategy, &dl, NULL); 369 return error; 370 371 default: 372 return EINVAL; 373 } 374 return 0; 375 } 376 377 int 378 bmddump(dev_t dev, daddr_t blkno, void *va, size_t size) 379 { 380 381 DPRINTF(("%s%d ", __func__, BMD_UNIT(dev))); 382 return ENODEV; 383 } 384 385 int 386 bmdsize(dev_t dev) 387 { 388 struct bmd_softc *sc; 389 390 DPRINTF(("%s%d ", __func__, BMD_UNIT(dev))); 391 392 sc = device_lookup_private(&bmd_cd, BMD_UNIT(dev)); 393 if (sc == NULL) 394 return 0; 395 396 return (sc->sc_maxpage * BMD_PAGESIZE) >> DEV_BSHIFT; 397 } 398 399 int 400 bmdread(dev_t dev, struct uio *uio, int ioflag) 401 { 402 return physio(bmdstrategy, NULL, dev, B_READ, minphys, uio); 403 } 404 405 int 406 bmdwrite(dev_t dev, struct uio *uio, int ioflag) 407 { 408 return physio(bmdstrategy, NULL, dev, B_WRITE, minphys, uio); 409 } 410 411 static int 412 bmd_getdisklabel(struct bmd_softc *sc, dev_t dev) 413 { 414 struct disklabel *lp; 415 int part; 416 417 part = DISKPART(dev); 418 lp = sc->sc_dkdev.dk_label; 419 memset(lp, 0, sizeof(struct disklabel)); 420 421 lp->d_secsize = BMD_BSIZE; 422 lp->d_nsectors = BLKS_PER_PAGE; 423 lp->d_ntracks = sc->sc_maxpage; 424 lp->d_ncylinders = 1; 425 lp->d_secpercyl = lp->d_nsectors * lp->d_ntracks; 426 lp->d_secperunit = lp->d_secpercyl * lp->d_ncylinders; 427 428 lp->d_type = DTYPE_LD; 429 lp->d_rpm = 300; /* dummy */ 430 lp->d_interleave = 1; /* dummy? */ 431 432 lp->d_npartitions = part + 1; 433 lp->d_bbsize = 8192; 434 lp->d_sbsize = 8192; /* ? */ 435 436 lp->d_magic = DISKMAGIC; 437 lp->d_magic2 = DISKMAGIC; 438 lp->d_checksum = dkcksum(lp); 439 440 lp->d_partitions[part].p_size = lp->d_secperunit; 441 lp->d_partitions[part].p_fstype = FS_BSDFFS; 442 lp->d_partitions[part].p_fsize = 1024; 443 lp->d_partitions[part].p_frag = 8; 444 445 return (0); 446 } 447
Indexes created Tue Sep 30 20:09:53 GMT 2025