ofrom.c revision 1.26
11.26Sdholland/* $NetBSD: ofrom.c,v 1.26 2014/07/25 08:10:34 dholland Exp $ */ 21.1Sthorpej 31.1Sthorpej/* 41.1Sthorpej * Copyright 1998 51.1Sthorpej * Digital Equipment Corporation. All rights reserved. 61.1Sthorpej * 71.1Sthorpej * This software is furnished under license and may be used and 81.1Sthorpej * copied only in accordance with the following terms and conditions. 91.1Sthorpej * Subject to these conditions, you may download, copy, install, 101.1Sthorpej * use, modify and distribute this software in source and/or binary 111.1Sthorpej * form. No title or ownership is transferred hereby. 121.1Sthorpej * 131.1Sthorpej * 1) Any source code used, modified or distributed must reproduce 141.1Sthorpej * and retain this copyright notice and list of conditions as 151.1Sthorpej * they appear in the source file. 161.1Sthorpej * 171.1Sthorpej * 2) No right is granted to use any trade name, trademark, or logo of 181.1Sthorpej * Digital Equipment Corporation. Neither the "Digital Equipment 191.1Sthorpej * Corporation" name nor any trademark or logo of Digital Equipment 201.1Sthorpej * Corporation may be used to endorse or promote products derived 211.1Sthorpej * from this software without the prior written permission of 221.1Sthorpej * Digital Equipment Corporation. 231.1Sthorpej * 241.1Sthorpej * 3) This software is provided "AS-IS" and any express or implied 251.1Sthorpej * warranties, including but not limited to, any implied warranties 261.1Sthorpej * of merchantability, fitness for a particular purpose, or 271.1Sthorpej * non-infringement are disclaimed. In no event shall DIGITAL be 281.1Sthorpej * liable for any damages whatsoever, and in particular, DIGITAL 291.1Sthorpej * shall not be liable for special, indirect, consequential, or 301.1Sthorpej * incidental damages or damages for lost profits, loss of 311.1Sthorpej * revenue or loss of use, whether such damages arise in contract, 321.1Sthorpej * negligence, tort, under statute, in equity, at law or otherwise, 331.1Sthorpej * even if advised of the possibility of such damage. 341.1Sthorpej */ 351.1Sthorpej 361.1Sthorpej/* 371.1Sthorpej * XXX open for writing (for user programs to mmap, and write contents) 381.1Sthorpej */ 391.11Slukem 401.11Slukem#include <sys/cdefs.h> 411.26Sdholland__KERNEL_RCSID(0, "$NetBSD: ofrom.c,v 1.26 2014/07/25 08:10:34 dholland Exp $"); 421.1Sthorpej 431.1Sthorpej#include <sys/param.h> 441.1Sthorpej#include <sys/device.h> 451.1Sthorpej#include <sys/systm.h> 461.1Sthorpej#include <sys/conf.h> 471.1Sthorpej#include <sys/fcntl.h> 481.22Sdyoung#include <sys/bus.h> 491.1Sthorpej 501.1Sthorpej#include <uvm/uvm_extern.h> 511.1Sthorpej 521.1Sthorpej#include <dev/ofw/openfirm.h> 531.1Sthorpej 541.1Sthorpejstruct ofrom_softc { 551.1Sthorpej int enabled; 561.12Stsutsui paddr_t base; 571.12Stsutsui paddr_t size; 581.1Sthorpej}; 591.1Sthorpej 601.23Smrgint ofromprobe(device_t, cfdata_t, void *); 611.23Smrgvoid ofromattach(device_t, device_t, void *); 621.1Sthorpej 631.23SmrgCFATTACH_DECL_NEW(ofrom, sizeof(struct ofrom_softc), 641.8Sthorpej ofromprobe, ofromattach, NULL, NULL); 651.1Sthorpej 661.1Sthorpejextern struct cfdriver ofrom_cd; 671.1Sthorpej 681.5Sgehennadev_type_open(ofromopen); 691.5Sgehennadev_type_read(ofromrw); 701.5Sgehennadev_type_mmap(ofrommmap); 711.5Sgehenna 721.5Sgehennaconst struct cdevsw ofrom_cdevsw = { 731.25Sdholland .d_open = ofromopen, 741.25Sdholland .d_close = nullclose, 751.25Sdholland .d_read = ofromrw, 761.25Sdholland .d_write = ofromrw, 771.25Sdholland .d_ioctl = noioctl, 781.25Sdholland .d_stop = nostop, 791.25Sdholland .d_tty = notty, 801.25Sdholland .d_poll = nopoll, 811.25Sdholland .d_mmap = ofrommmap, 821.25Sdholland .d_kqfilter = nokqfilter, 831.26Sdholland .d_discard = nodiscard, 841.25Sdholland .d_flag = 0 851.5Sgehenna}; 861.1Sthorpej 871.1Sthorpejint 881.23Smrgofromprobe(device_t parent, cfdata_t cf, void *aux) 891.1Sthorpej{ 901.1Sthorpej struct ofbus_attach_args *oba = aux; 911.4Syamt static const char *const compatible_strings[] = { "rom", NULL }; 921.1Sthorpej 931.1Sthorpej return (of_compatible(oba->oba_phandle, compatible_strings) == -1) ? 941.1Sthorpej 0 : 5; 951.1Sthorpej} 961.1Sthorpej 971.1Sthorpej 981.1Sthorpejvoid 991.23Smrgofromattach(device_t parent, device_t self, void *aux) 1001.1Sthorpej{ 1011.23Smrg struct ofrom_softc *sc = device_private(self); 1021.1Sthorpej struct ofbus_attach_args *oba = aux; 1031.1Sthorpej char regbuf[8]; 1041.1Sthorpej 1051.1Sthorpej if (OF_getproplen(oba->oba_phandle, "reg") != 8) { 1061.1Sthorpej printf(": invalid reg property\n"); 1071.1Sthorpej return; 1081.1Sthorpej } 1091.1Sthorpej if (OF_getprop(oba->oba_phandle, "reg", regbuf, sizeof regbuf) != 8) { 1101.1Sthorpej printf(": couldn't read reg property\n"); 1111.1Sthorpej return; 1121.1Sthorpej } 1131.1Sthorpej sc->base = of_decode_int(®buf[0]); 1141.1Sthorpej sc->size = of_decode_int(®buf[4]); 1151.1Sthorpej sc->enabled = 1; 1161.1Sthorpej 1171.1Sthorpej printf(": %#lx-%#lx\n", sc->base, sc->base + sc->size - 1); 1181.1Sthorpej} 1191.1Sthorpej 1201.1Sthorpejint 1211.16Sceggerofromopen(dev_t dev, int oflags, int devtype, struct lwp *l) 1221.1Sthorpej{ 1231.1Sthorpej struct ofrom_softc *sc; 1241.1Sthorpej 1251.16Scegger sc = device_lookup_private(&ofrom_cd, minor(dev)); 1261.1Sthorpej if (!sc || !sc->enabled) 1271.1Sthorpej return (ENXIO); 1281.1Sthorpej 1291.1Sthorpej if (oflags & FWRITE) 1301.1Sthorpej return (EINVAL); 1311.1Sthorpej 1321.1Sthorpej return (0); 1331.1Sthorpej} 1341.1Sthorpej 1351.1Sthorpejint 1361.16Sceggerofromrw(dev_t dev, struct uio *uio, int flags) 1371.1Sthorpej{ 1381.24Smatt pmap_t kpm = pmap_kernel(); 1391.1Sthorpej struct ofrom_softc *sc; 1401.16Scegger int c, error = 0; 1411.1Sthorpej struct iovec *iov; 1421.12Stsutsui paddr_t v; 1431.12Stsutsui psize_t o; 1441.17She extern kmutex_t memlock; 1451.1Sthorpej extern char *memhook; 1461.1Sthorpej 1471.16Scegger sc = device_lookup_private(&ofrom_cd, minor(dev)); 1481.1Sthorpej if (!sc || !sc->enabled) 1491.1Sthorpej return (ENXIO); /* XXX PANIC */ 1501.1Sthorpej 1511.17She mutex_enter(&memlock); 1521.1Sthorpej while (uio->uio_resid > 0 && error == 0) { 1531.1Sthorpej iov = uio->uio_iov; 1541.1Sthorpej if (iov->iov_len == 0) { 1551.1Sthorpej uio->uio_iov++; 1561.1Sthorpej uio->uio_iovcnt--; 1571.1Sthorpej if (uio->uio_iovcnt < 0) 1581.1Sthorpej panic("ofromrw"); 1591.1Sthorpej continue; 1601.1Sthorpej } 1611.1Sthorpej 1621.1Sthorpej /* 1631.1Sthorpej * Since everything is page aligned and no more 1641.1Sthorpej * than the rest of a page is done at once, we 1651.1Sthorpej * can just check that the offset isn't too big. 1661.1Sthorpej */ 1671.1Sthorpej if (uio->uio_offset >= sc->size) 1681.1Sthorpej break; 1691.1Sthorpej 1701.21Srmind /* XXX: Use unamanged mapping. */ 1711.1Sthorpej v = sc->base + uio->uio_offset; 1721.24Smatt pmap_kenter_pa((vaddr_t)memhook, trunc_page(v), 1731.24Smatt uio->uio_rw == UIO_READ ? VM_PROT_READ : VM_PROT_WRITE, 1741.24Smatt 0); 1751.24Smatt pmap_update(kpm); 1761.1Sthorpej o = uio->uio_offset & PGOFSET; 1771.10Sthorpej c = min(uio->uio_resid, (int)(PAGE_SIZE - o)); 1781.15Schristos error = uiomove((char *)memhook + o, c, uio); 1791.24Smatt pmap_kremove((vaddr_t)memhook, (vaddr_t)memhook + PAGE_SIZE); 1801.24Smatt pmap_update(kpm); 1811.1Sthorpej } 1821.17She mutex_exit(&memlock); 1831.1Sthorpej 1841.1Sthorpej return (error); 1851.1Sthorpej} 1861.1Sthorpej 1871.1Sthorpejpaddr_t 1881.16Sceggerofrommmap(dev_t dev, off_t off, int prot) 1891.1Sthorpej{ 1901.1Sthorpej struct ofrom_softc *sc; 1911.1Sthorpej 1921.16Scegger sc = device_lookup_private(&ofrom_cd, minor(dev)); 1931.1Sthorpej if (!sc || !sc->enabled) 1941.1Sthorpej return (-1); /* XXX PANIC */ 1951.1Sthorpej 1961.1Sthorpej if ((u_int)off >= sc->size) 1971.1Sthorpej return (-1); 1981.1Sthorpej 1991.3Sthorpej return arm_btop(sc->base + off); 2001.1Sthorpej} 201