nvram_pnpbus.c revision 1.3.2.6       1  1.3.2.6  yamt /* $NetBSD: nvram_pnpbus.c,v 1.3.2.6 2008/01/21 09:38:32 yamt Exp $ */
      2  1.3.2.2  yamt 
      3  1.3.2.2  yamt /*-
      4  1.3.2.2  yamt  * Copyright (c) 2006 The NetBSD Foundation, Inc.
      5  1.3.2.2  yamt  * All rights reserved.
      6  1.3.2.2  yamt  *
      7  1.3.2.2  yamt  * This code is derived from software contributed to The NetBSD Foundation
      8  1.3.2.2  yamt  * by Tim Rightnour
      9  1.3.2.2  yamt  *
     10  1.3.2.2  yamt  * Redistribution and use in source and binary forms, with or without
     11  1.3.2.2  yamt  * modification, are permitted provided that the following conditions
     12  1.3.2.2  yamt  * are met:
     13  1.3.2.2  yamt  * 1. Redistributions of source code must retain the above copyright
     14  1.3.2.2  yamt  *    notice, this list of conditions and the following disclaimer.
     15  1.3.2.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.3.2.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     17  1.3.2.2  yamt  *    documentation and/or other materials provided with the distribution.
     18  1.3.2.2  yamt  * 3. All advertising materials mentioning features or use of this software
     19  1.3.2.2  yamt  *    must display the following acknowledgement:
     20  1.3.2.2  yamt  *        This product includes software developed by the NetBSD
     21  1.3.2.2  yamt  *        Foundation, Inc. and its contributors.
     22  1.3.2.2  yamt  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.3.2.2  yamt  *    contributors may be used to endorse or promote products derived
     24  1.3.2.2  yamt  *    from this software without specific prior written permission.
     25  1.3.2.2  yamt  *
     26  1.3.2.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.3.2.2  yamt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.3.2.2  yamt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.3.2.2  yamt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.3.2.2  yamt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.3.2.2  yamt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.3.2.2  yamt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.3.2.2  yamt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.3.2.2  yamt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.3.2.2  yamt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.3.2.2  yamt  * POSSIBILITY OF SUCH DAMAGE.
     37  1.3.2.2  yamt  */
     38  1.3.2.2  yamt 
     39  1.3.2.2  yamt #include <sys/cdefs.h>
     40  1.3.2.6  yamt __KERNEL_RCSID(0, "$NetBSD: nvram_pnpbus.c,v 1.3.2.6 2008/01/21 09:38:32 yamt Exp $");
     41  1.3.2.2  yamt 
     42  1.3.2.2  yamt #include <sys/types.h>
     43  1.3.2.2  yamt #include <sys/param.h>
     44  1.3.2.2  yamt #include <sys/systm.h>
     45  1.3.2.2  yamt #include <sys/ioctl.h>
     46  1.3.2.2  yamt #include <sys/conf.h>
     47  1.3.2.2  yamt #include <sys/kthread.h>
     48  1.3.2.2  yamt #include <sys/device.h>
     49  1.3.2.2  yamt #include <sys/malloc.h>
     50  1.3.2.6  yamt #include <sys/simplelock.h>
     51  1.3.2.6  yamt #include <sys/bus.h>
     52  1.3.2.6  yamt #include <sys/intr.h>
     53  1.3.2.2  yamt 
     54  1.3.2.2  yamt #include <machine/isa_machdep.h>
     55  1.3.2.2  yamt /* clock stuff for motorolla machines */
     56  1.3.2.2  yamt #include <dev/clock_subr.h>
     57  1.3.2.2  yamt #include <dev/ic/mk48txxreg.h>
     58  1.3.2.2  yamt 
     59  1.3.2.4  yamt #include <uvm/uvm_extern.h>
     60  1.3.2.4  yamt 
     61  1.3.2.4  yamt #include <machine/residual.h>
     62  1.3.2.2  yamt #include <machine/nvram.h>
     63  1.3.2.2  yamt 
     64  1.3.2.2  yamt #include <prep/pnpbus/pnpbusvar.h>
     65  1.3.2.2  yamt 
     66  1.3.2.2  yamt #include "opt_nvram.h"
     67  1.3.2.2  yamt 
     68  1.3.2.2  yamt static char *nvramData;
     69  1.3.2.2  yamt static NVRAM_MAP *nvram;
     70  1.3.2.2  yamt static char *nvramGEAp;		/* pointer to the GE area */
     71  1.3.2.2  yamt static char *nvramCAp;		/* pointer to the Config area */
     72  1.3.2.2  yamt static char *nvramOSAp;		/* pointer to the OSArea */
     73  1.3.2.2  yamt struct simplelock nvram_slock;	/* lock */
     74  1.3.2.2  yamt 
     75  1.3.2.2  yamt int prep_clock_mk48txx;
     76  1.3.2.2  yamt 
     77  1.3.2.2  yamt extern char bootpath[256];
     78  1.3.2.4  yamt extern RESIDUAL resdata;
     79  1.3.2.2  yamt 
     80  1.3.2.2  yamt #define NVRAM_STD_DEV 0
     81  1.3.2.2  yamt 
     82  1.3.2.2  yamt static int	nvram_pnpbus_probe(struct device *, struct cfdata *, void *);
     83  1.3.2.2  yamt static void	nvram_pnpbus_attach(struct device *, struct device *, void *);
     84  1.3.2.2  yamt uint8_t		prep_nvram_read_val(int);
     85  1.3.2.2  yamt char		*prep_nvram_next_var(char *);
     86  1.3.2.2  yamt char		*prep_nvram_find_var(const char *);
     87  1.3.2.2  yamt char		*prep_nvram_get_var(const char *);
     88  1.3.2.2  yamt int		prep_nvram_get_var_len(const char *);
     89  1.3.2.2  yamt int		prep_nvram_count_vars(void);
     90  1.3.2.2  yamt void		prep_nvram_write_val(int, uint8_t);
     91  1.3.2.2  yamt uint8_t		mkclock_pnpbus_nvrd(struct mk48txx_softc *, int);
     92  1.3.2.2  yamt void		mkclock_pnpbus_nvwr(struct mk48txx_softc *, int, uint8_t);
     93  1.3.2.2  yamt 
     94  1.3.2.2  yamt CFATTACH_DECL(nvram_pnpbus, sizeof(struct nvram_pnpbus_softc),
     95  1.3.2.2  yamt     nvram_pnpbus_probe, nvram_pnpbus_attach, NULL, NULL);
     96  1.3.2.2  yamt 
     97  1.3.2.2  yamt dev_type_open(prep_nvramopen);
     98  1.3.2.2  yamt dev_type_ioctl(prep_nvramioctl);
     99  1.3.2.2  yamt dev_type_close(prep_nvramclose);
    100  1.3.2.4  yamt dev_type_read(prep_nvramread);
    101  1.3.2.2  yamt 
    102  1.3.2.4  yamt const struct cdevsw nvram_cdevsw = {
    103  1.3.2.4  yamt 	prep_nvramopen, prep_nvramclose, prep_nvramread, nowrite,
    104  1.3.2.4  yamt 	prep_nvramioctl, nostop, notty, nopoll, nommap, nokqfilter, D_OTHER,
    105  1.3.2.2  yamt };
    106  1.3.2.2  yamt 
    107  1.3.2.2  yamt extern struct cfdriver nvram_cd;
    108  1.3.2.2  yamt 
    109  1.3.2.2  yamt static int
    110  1.3.2.2  yamt nvram_pnpbus_probe(struct device *parent, struct cfdata *match, void *aux)
    111  1.3.2.2  yamt {
    112  1.3.2.2  yamt 	struct pnpbus_dev_attach_args *pna = aux;
    113  1.3.2.2  yamt 	int ret = 0;
    114  1.3.2.2  yamt 
    115  1.3.2.2  yamt 	if (strcmp(pna->pna_devid, "IBM0008") == 0)
    116  1.3.2.2  yamt 		ret = 1;
    117  1.3.2.2  yamt 
    118  1.3.2.2  yamt 	if (ret)
    119  1.3.2.2  yamt 		pnpbus_scan(pna, pna->pna_ppc_dev);
    120  1.3.2.2  yamt 
    121  1.3.2.2  yamt 	return ret;
    122  1.3.2.2  yamt }
    123  1.3.2.2  yamt 
    124  1.3.2.2  yamt static void
    125  1.3.2.2  yamt nvram_pnpbus_attach(struct device *parent, struct device *self, void *aux)
    126  1.3.2.2  yamt {
    127  1.3.2.2  yamt 	struct nvram_pnpbus_softc *sc = (void *)self;
    128  1.3.2.2  yamt 	struct pnpbus_dev_attach_args *pna = aux;
    129  1.3.2.2  yamt 	int as_iobase, as_len, data_iobase, data_len, i, nvlen, cur;
    130  1.3.2.2  yamt 	uint8_t *p;
    131  1.3.2.2  yamt 	HEADER prep_nvram_header;
    132  1.3.2.2  yamt 
    133  1.3.2.2  yamt 	sc->sc_iot = pna->pna_iot;
    134  1.3.2.2  yamt 
    135  1.3.2.2  yamt 	pnpbus_getioport(&pna->pna_res, 0, &as_iobase, &as_len);
    136  1.3.2.2  yamt 	pnpbus_getioport(&pna->pna_res, 1, &data_iobase, &data_len);
    137  1.3.2.2  yamt 
    138  1.3.2.2  yamt 	if (pnpbus_io_map(&pna->pna_res, 0, &sc->sc_as, &sc->sc_ash) ||
    139  1.3.2.2  yamt 	    pnpbus_io_map(&pna->pna_res, 1, &sc->sc_data, &sc->sc_datah)) {
    140  1.3.2.2  yamt 		aprint_error("nvram: couldn't map registers\n");
    141  1.3.2.2  yamt 		return;
    142  1.3.2.2  yamt 	}
    143  1.3.2.2  yamt 
    144  1.3.2.2  yamt 	simple_lock_init(&nvram_slock);
    145  1.3.2.2  yamt 
    146  1.3.2.2  yamt 	/* Initialize the nvram header */
    147  1.3.2.2  yamt 	p = (uint8_t *) &prep_nvram_header;
    148  1.3.2.2  yamt 	for (i = 0; i < sizeof(HEADER); i++)
    149  1.3.2.2  yamt 		*p++ = prep_nvram_read_val(i);
    150  1.3.2.2  yamt 
    151  1.3.2.2  yamt 	/*
    152  1.3.2.2  yamt 	 * now that we have the header, we know how big the NVRAM part on
    153  1.3.2.2  yamt 	 * this machine really is.  Malloc space to save a copy.
    154  1.3.2.2  yamt 	 */
    155  1.3.2.2  yamt 
    156  1.3.2.2  yamt 	nvlen = 1024 * prep_nvram_header.Size;
    157  1.3.2.2  yamt 	nvramData = malloc(nvlen, M_DEVBUF, M_NOWAIT);
    158  1.3.2.2  yamt 	p = (uint8_t *) nvramData;
    159  1.3.2.2  yamt 
    160  1.3.2.2  yamt 	/*
    161  1.3.2.2  yamt 	 * now read the whole nvram in, one chunk at a time, marking down
    162  1.3.2.2  yamt 	 * the main start points as we go.
    163  1.3.2.2  yamt 	 */
    164  1.3.2.2  yamt 	for (i = 0; i < sizeof(HEADER) && i < nvlen; i++)
    165  1.3.2.2  yamt 		*p++ = prep_nvram_read_val(i);
    166  1.3.2.2  yamt 	nvramGEAp = p;
    167  1.3.2.2  yamt 	cur = i;
    168  1.3.2.2  yamt 	for (; i < cur + prep_nvram_header.GELength && i < nvlen; i++)
    169  1.3.2.2  yamt 		*p++ = prep_nvram_read_val(i);
    170  1.3.2.2  yamt 	nvramOSAp = p;
    171  1.3.2.2  yamt 	cur = i;
    172  1.3.2.2  yamt 	for (; i < cur + prep_nvram_header.OSAreaLength && i < nvlen; i++)
    173  1.3.2.2  yamt 		*p++ = prep_nvram_read_val(i);
    174  1.3.2.2  yamt 	nvramCAp = p;
    175  1.3.2.2  yamt 	cur = i;
    176  1.3.2.2  yamt 	for (; i < cur + prep_nvram_header.ConfigLength && i < nvlen; i++)
    177  1.3.2.2  yamt 		*p++ = prep_nvram_read_val(i);
    178  1.3.2.2  yamt 
    179  1.3.2.2  yamt 	/* we should be done here.  umm.. yay? */
    180  1.3.2.2  yamt 	nvram = (NVRAM_MAP *)&nvramData[0];
    181  1.3.2.2  yamt 	aprint_normal("\n");
    182  1.3.2.2  yamt 	aprint_verbose("%s: Read %d bytes from nvram of size %d\n",
    183  1.3.2.2  yamt 	    device_xname(self), i, nvlen);
    184  1.3.2.2  yamt 
    185  1.3.2.2  yamt #if defined(NVRAM_DUMP)
    186  1.3.2.2  yamt 	printf("Boot device: %s\n", prep_nvram_get_var("fw-boot-device"));
    187  1.3.2.2  yamt 	printf("Dumping nvram\n");
    188  1.3.2.2  yamt 	for (cur=0; cur < i; cur++) {
    189  1.3.2.2  yamt 		printf("%c", nvramData[cur]);
    190  1.3.2.2  yamt 		if (cur % 70 == 0)
    191  1.3.2.2  yamt 			printf("\n");
    192  1.3.2.2  yamt 	}
    193  1.3.2.2  yamt #endif
    194  1.3.2.2  yamt 	strncpy(bootpath, prep_nvram_get_var("fw-boot-device"), 256);
    195  1.3.2.2  yamt 
    196  1.3.2.2  yamt 
    197  1.3.2.2  yamt 	if (prep_clock_mk48txx == 0)
    198  1.3.2.2  yamt 		return;
    199  1.3.2.2  yamt 	/* otherwise, we have a motorolla clock chip.  Set it up. */
    200  1.3.2.2  yamt 	sc->sc_mksc.sc_model = "mk48t18";
    201  1.3.2.2  yamt 	sc->sc_mksc.sc_year0 = 1900;
    202  1.3.2.2  yamt 	sc->sc_mksc.sc_nvrd = mkclock_pnpbus_nvrd;
    203  1.3.2.2  yamt 	sc->sc_mksc.sc_nvwr = mkclock_pnpbus_nvwr;
    204  1.3.2.2  yamt 	/* copy down the bus space tags */
    205  1.3.2.2  yamt 	sc->sc_mksc.sc_bst = sc->sc_as;
    206  1.3.2.2  yamt 	sc->sc_mksc.sc_bsh = sc->sc_ash;
    207  1.3.2.2  yamt 	sc->sc_mksc.sc_data = sc->sc_data;
    208  1.3.2.2  yamt 	sc->sc_mksc.sc_datah = sc->sc_datah;
    209  1.3.2.2  yamt 
    210  1.3.2.2  yamt 	aprint_normal("%s: attaching clock", device_xname(self));
    211  1.3.2.2  yamt 	mk48txx_attach((struct mk48txx_softc *)&sc->sc_mksc);
    212  1.3.2.3  yamt 	aprint_normal("\n");
    213  1.3.2.2  yamt }
    214  1.3.2.2  yamt 
    215  1.3.2.2  yamt /*
    216  1.3.2.2  yamt  * This function should be called at a high spl only, as it interfaces with
    217  1.3.2.2  yamt  * real hardware.
    218  1.3.2.2  yamt  */
    219  1.3.2.2  yamt 
    220  1.3.2.2  yamt uint8_t
    221  1.3.2.2  yamt prep_nvram_read_val(int addr)
    222  1.3.2.2  yamt {
    223  1.3.2.2  yamt 	struct nvram_pnpbus_softc *sc;
    224  1.3.2.2  yamt 
    225  1.3.2.2  yamt 	if (nvram_cd.cd_devs == NULL || nvram_cd.cd_ndevs == 0
    226  1.3.2.2  yamt             || nvram_cd.cd_devs[NVRAM_STD_DEV] == NULL) {
    227  1.3.2.2  yamt                 return 0;
    228  1.3.2.2  yamt         }
    229  1.3.2.2  yamt 
    230  1.3.2.2  yamt         sc = (struct nvram_pnpbus_softc *) nvram_cd.cd_devs[NVRAM_STD_DEV];
    231  1.3.2.2  yamt 
    232  1.3.2.2  yamt 	/* tell the NVRAM what we want */
    233  1.3.2.2  yamt 	bus_space_write_1(sc->sc_as, sc->sc_ash, 0, addr);
    234  1.3.2.2  yamt 	bus_space_write_1(sc->sc_as, sc->sc_ash, 1, addr>>8);
    235  1.3.2.2  yamt 
    236  1.3.2.2  yamt 	return bus_space_read_1(sc->sc_data, sc->sc_datah, 0);
    237  1.3.2.2  yamt }
    238  1.3.2.2  yamt 
    239  1.3.2.2  yamt /*
    240  1.3.2.2  yamt  * This function should be called at a high spl only, as it interfaces with
    241  1.3.2.2  yamt  * real hardware.
    242  1.3.2.2  yamt  */
    243  1.3.2.2  yamt 
    244  1.3.2.2  yamt void
    245  1.3.2.2  yamt prep_nvram_write_val(int addr, uint8_t val)
    246  1.3.2.2  yamt {
    247  1.3.2.2  yamt 	struct nvram_pnpbus_softc *sc;
    248  1.3.2.2  yamt 
    249  1.3.2.2  yamt 	if (nvram_cd.cd_devs == NULL || nvram_cd.cd_ndevs == 0
    250  1.3.2.2  yamt             || nvram_cd.cd_devs[NVRAM_STD_DEV] == NULL) {
    251  1.3.2.2  yamt                 return;
    252  1.3.2.2  yamt         }
    253  1.3.2.2  yamt 
    254  1.3.2.2  yamt         sc = (struct nvram_pnpbus_softc *) nvram_cd.cd_devs[NVRAM_STD_DEV];
    255  1.3.2.2  yamt 
    256  1.3.2.2  yamt 	/* tell the NVRAM what we want */
    257  1.3.2.2  yamt 	bus_space_write_1(sc->sc_as, sc->sc_ash, 0, addr);
    258  1.3.2.2  yamt 	bus_space_write_1(sc->sc_as, sc->sc_ash, 1, addr>>8);
    259  1.3.2.2  yamt 
    260  1.3.2.2  yamt 	bus_space_write_1(sc->sc_data, sc->sc_datah, 0, val);
    261  1.3.2.2  yamt }
    262  1.3.2.2  yamt 
    263  1.3.2.2  yamt /* the rest of these should all be called with the lock held */
    264  1.3.2.2  yamt 
    265  1.3.2.2  yamt char *
    266  1.3.2.2  yamt prep_nvram_next_var(char *name)
    267  1.3.2.2  yamt {
    268  1.3.2.2  yamt 	char *cp;
    269  1.3.2.2  yamt 
    270  1.3.2.4  yamt 	if (name == NULL)
    271  1.3.2.4  yamt 		return NULL;
    272  1.3.2.4  yamt 
    273  1.3.2.2  yamt 	cp = name;
    274  1.3.2.2  yamt 	/* skip forward to the first null char */
    275  1.3.2.2  yamt 	while ((cp - nvramGEAp) < nvram->Header.GELength && (*cp != '\0'))
    276  1.3.2.2  yamt 		cp++;
    277  1.3.2.2  yamt 	/* skip nulls */
    278  1.3.2.2  yamt 	while ((cp - nvramGEAp) < nvram->Header.GELength && (*cp == '\0'))
    279  1.3.2.2  yamt 		cp++;
    280  1.3.2.2  yamt 	if ((cp - nvramGEAp) < nvram->Header.GELength)
    281  1.3.2.2  yamt 		return cp;
    282  1.3.2.2  yamt 	else
    283  1.3.2.2  yamt 		return NULL;
    284  1.3.2.2  yamt }
    285  1.3.2.2  yamt 
    286  1.3.2.2  yamt char *
    287  1.3.2.2  yamt prep_nvram_find_var(const char *name)
    288  1.3.2.2  yamt {
    289  1.3.2.2  yamt 	char *cp = nvramGEAp;
    290  1.3.2.2  yamt 	size_t len;
    291  1.3.2.2  yamt 
    292  1.3.2.2  yamt 	len = strlen(name);
    293  1.3.2.2  yamt 	while (cp != NULL) {
    294  1.3.2.2  yamt 		if ((strncmp(name, cp, len) == 0) && (cp[len] == '='))
    295  1.3.2.2  yamt 			return cp;
    296  1.3.2.2  yamt 		cp = prep_nvram_next_var(cp);
    297  1.3.2.2  yamt 	}
    298  1.3.2.2  yamt 	return NULL;
    299  1.3.2.2  yamt }
    300  1.3.2.2  yamt 
    301  1.3.2.2  yamt char *
    302  1.3.2.2  yamt prep_nvram_get_var(const char *name)
    303  1.3.2.2  yamt {
    304  1.3.2.2  yamt 	char *cp = nvramGEAp;
    305  1.3.2.2  yamt 	size_t len;
    306  1.3.2.2  yamt 
    307  1.3.2.4  yamt 	if (name == NULL)
    308  1.3.2.4  yamt 		return NULL;
    309  1.3.2.2  yamt 	len = strlen(name);
    310  1.3.2.2  yamt 	while (cp != NULL) {
    311  1.3.2.2  yamt 		if ((strncmp(name, cp, len) == 0) && (cp[len] == '='))
    312  1.3.2.2  yamt 			return cp+len+1;
    313  1.3.2.2  yamt 		cp = prep_nvram_next_var(cp);
    314  1.3.2.2  yamt 	}
    315  1.3.2.2  yamt 	return NULL;
    316  1.3.2.2  yamt }
    317  1.3.2.2  yamt 
    318  1.3.2.2  yamt int
    319  1.3.2.2  yamt prep_nvram_get_var_len(const char *name)
    320  1.3.2.2  yamt {
    321  1.3.2.2  yamt 	char *cp = nvramGEAp;
    322  1.3.2.2  yamt 	char *ep;
    323  1.3.2.2  yamt 	size_t len;
    324  1.3.2.2  yamt 
    325  1.3.2.4  yamt 	if (name == NULL)
    326  1.3.2.4  yamt 		return -1;
    327  1.3.2.4  yamt 
    328  1.3.2.2  yamt 	len = strlen(name);
    329  1.3.2.2  yamt 	while (cp != NULL) {
    330  1.3.2.2  yamt 		if ((strncmp(name, cp, len) == 0) && (cp[len] == '='))
    331  1.3.2.2  yamt 			goto out;
    332  1.3.2.2  yamt 		cp = prep_nvram_next_var(cp);
    333  1.3.2.2  yamt 	}
    334  1.3.2.2  yamt 	return -1;
    335  1.3.2.2  yamt 
    336  1.3.2.2  yamt out:
    337  1.3.2.2  yamt 	ep = cp;
    338  1.3.2.2  yamt 	while (ep != NULL && *ep != '\0')
    339  1.3.2.2  yamt 		ep++;
    340  1.3.2.2  yamt 	return ep-cp;
    341  1.3.2.2  yamt }
    342  1.3.2.2  yamt 
    343  1.3.2.2  yamt int
    344  1.3.2.2  yamt prep_nvram_count_vars(void)
    345  1.3.2.2  yamt {
    346  1.3.2.2  yamt 	char *cp = nvramGEAp;
    347  1.3.2.2  yamt 	int i=0;
    348  1.3.2.2  yamt 
    349  1.3.2.2  yamt 	while (cp != NULL) {
    350  1.3.2.2  yamt 		i++;
    351  1.3.2.2  yamt 		cp = prep_nvram_next_var(cp);
    352  1.3.2.2  yamt 	}
    353  1.3.2.2  yamt 	return i;
    354  1.3.2.2  yamt }
    355  1.3.2.2  yamt 
    356  1.3.2.4  yamt static int
    357  1.3.2.4  yamt nvramgetstr(int len, char *user, char **cpp)
    358  1.3.2.4  yamt {
    359  1.3.2.4  yamt 	int error;
    360  1.3.2.4  yamt 	char *cp;
    361  1.3.2.4  yamt 
    362  1.3.2.4  yamt 	/* Reject obvious bogus requests */
    363  1.3.2.4  yamt 	if ((u_int)len > (8 * 1024) - 1)
    364  1.3.2.4  yamt 		return ENAMETOOLONG;
    365  1.3.2.4  yamt 
    366  1.3.2.4  yamt 	*cpp = cp = malloc(len + 1, M_TEMP, M_WAITOK);
    367  1.3.2.4  yamt 	error = copyin(user, cp, len);
    368  1.3.2.4  yamt 	cp[len] = '\0';
    369  1.3.2.4  yamt 	return error;
    370  1.3.2.4  yamt }
    371  1.3.2.4  yamt 
    372  1.3.2.2  yamt int
    373  1.3.2.4  yamt prep_nvramioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
    374  1.3.2.2  yamt {
    375  1.3.2.2  yamt 	int len, error;
    376  1.3.2.2  yamt 	struct pnviocdesc *pnv;
    377  1.3.2.4  yamt 	char *np, *cp, *name;
    378  1.3.2.2  yamt 
    379  1.3.2.2  yamt 	pnv = (struct pnviocdesc *)data;
    380  1.3.2.2  yamt 	error = 0;
    381  1.3.2.4  yamt 	cp = name = NULL;
    382  1.3.2.2  yamt 
    383  1.3.2.2  yamt 	switch (cmd) {
    384  1.3.2.2  yamt 	case PNVIOCGET:
    385  1.3.2.2  yamt 		if (pnv->pnv_name == NULL)
    386  1.3.2.2  yamt 			return EINVAL;
    387  1.3.2.2  yamt 
    388  1.3.2.4  yamt 		error = nvramgetstr(pnv->pnv_namelen, pnv->pnv_name, &name);
    389  1.3.2.2  yamt 		simple_lock(&nvram_slock);
    390  1.3.2.4  yamt 		np = prep_nvram_get_var(name);
    391  1.3.2.2  yamt 		simple_unlock(&nvram_slock);
    392  1.3.2.2  yamt 		if (np == NULL)
    393  1.3.2.2  yamt 			return EINVAL;
    394  1.3.2.2  yamt 		simple_lock(&nvram_slock);
    395  1.3.2.4  yamt 		len = prep_nvram_get_var_len(name);
    396  1.3.2.2  yamt 		simple_unlock(&nvram_slock);
    397  1.3.2.2  yamt 
    398  1.3.2.2  yamt 		if (len > pnv->pnv_buflen) {
    399  1.3.2.2  yamt 			error = ENOMEM;
    400  1.3.2.2  yamt 			break;
    401  1.3.2.2  yamt 		}
    402  1.3.2.2  yamt 		if (len <= 0)
    403  1.3.2.2  yamt 			break;
    404  1.3.2.2  yamt 		error = copyout(np, pnv->pnv_buf, len);
    405  1.3.2.2  yamt 		pnv->pnv_buflen = len;
    406  1.3.2.2  yamt 		break;
    407  1.3.2.2  yamt 
    408  1.3.2.2  yamt 	case PNVIOCGETNEXTNAME:
    409  1.3.2.2  yamt 		/* if the first one is null, we give them the first name */
    410  1.3.2.2  yamt 		simple_lock(&nvram_slock);
    411  1.3.2.2  yamt 		if (pnv->pnv_name == NULL) {
    412  1.3.2.4  yamt 			cp = nvramGEAp;
    413  1.3.2.2  yamt 		} else {
    414  1.3.2.4  yamt 			error = nvramgetstr(pnv->pnv_namelen, pnv->pnv_name,
    415  1.3.2.4  yamt 			    &name);
    416  1.3.2.4  yamt 			if (!error) {
    417  1.3.2.4  yamt 				np = prep_nvram_find_var(name);
    418  1.3.2.4  yamt 				cp = prep_nvram_next_var(np);
    419  1.3.2.4  yamt 			}
    420  1.3.2.2  yamt 		}
    421  1.3.2.2  yamt 		simple_unlock(&nvram_slock);
    422  1.3.2.4  yamt 		if (cp == NULL)
    423  1.3.2.4  yamt 			error = EINVAL;
    424  1.3.2.4  yamt 		if (error)
    425  1.3.2.4  yamt 			break;
    426  1.3.2.4  yamt 
    427  1.3.2.2  yamt 		np = cp;
    428  1.3.2.2  yamt 		while (*np != '=')
    429  1.3.2.2  yamt 			np++;
    430  1.3.2.2  yamt 		len = np-cp;
    431  1.3.2.2  yamt 		if (len > pnv->pnv_buflen) {
    432  1.3.2.2  yamt 			error = ENOMEM;
    433  1.3.2.2  yamt 			break;
    434  1.3.2.2  yamt 		}
    435  1.3.2.2  yamt 		error = copyout(cp, pnv->pnv_buf, len);
    436  1.3.2.4  yamt 		if (error)
    437  1.3.2.4  yamt 			break;
    438  1.3.2.2  yamt 		pnv->pnv_buflen = len;
    439  1.3.2.2  yamt 		break;
    440  1.3.2.4  yamt 
    441  1.3.2.4  yamt 	case PNVIOCGETNUMGE:
    442  1.3.2.4  yamt 		/* count the GE variables */
    443  1.3.2.4  yamt 		simple_lock(&nvram_slock);
    444  1.3.2.4  yamt 		pnv->pnv_num = prep_nvram_count_vars();
    445  1.3.2.4  yamt 		simple_unlock(&nvram_slock);
    446  1.3.2.4  yamt 		break;
    447  1.3.2.4  yamt 	case PNVIOCSET:
    448  1.3.2.4  yamt 		/* this will require some real work.  Not ready yet */
    449  1.3.2.4  yamt 		return ENOTSUP;
    450  1.3.2.4  yamt 
    451  1.3.2.2  yamt 	default:
    452  1.3.2.4  yamt 		return ENOTTY;
    453  1.3.2.4  yamt 	}
    454  1.3.2.4  yamt 	if (name)
    455  1.3.2.4  yamt 		free(name, M_TEMP);
    456  1.3.2.4  yamt 	return error;
    457  1.3.2.4  yamt }
    458  1.3.2.4  yamt 
    459  1.3.2.4  yamt int
    460  1.3.2.4  yamt prep_nvramread(dev_t dev, struct uio *uio, int flags)
    461  1.3.2.4  yamt {
    462  1.3.2.4  yamt 	int size, resid, error;
    463  1.3.2.4  yamt 	u_int c;
    464  1.3.2.4  yamt 	char *rdata;
    465  1.3.2.4  yamt 
    466  1.3.2.4  yamt 	error = 0;
    467  1.3.2.4  yamt 	rdata = (char *)&resdata;
    468  1.3.2.4  yamt 
    469  1.3.2.4  yamt 	if (uio->uio_rw == UIO_WRITE) {
    470  1.3.2.4  yamt 		uio->uio_resid = 0;
    471  1.3.2.4  yamt 		return 0;
    472  1.3.2.4  yamt 	}
    473  1.3.2.4  yamt 
    474  1.3.2.4  yamt 	switch (minor(dev)) {
    475  1.3.2.4  yamt 	case DEV_NVRAM:
    476  1.3.2.4  yamt 		size = nvram->Header.Size * 1024;
    477  1.3.2.4  yamt 		break;
    478  1.3.2.4  yamt 	case DEV_RESIDUAL:
    479  1.3.2.4  yamt 		size = res->ResidualLength;
    480  1.3.2.4  yamt 		break;
    481  1.3.2.4  yamt 	default:
    482  1.3.2.4  yamt 		return ENXIO;
    483  1.3.2.4  yamt 	}
    484  1.3.2.4  yamt 	resid = size;
    485  1.3.2.4  yamt 	if (uio->uio_resid < resid)
    486  1.3.2.4  yamt 		resid = uio->uio_resid;
    487  1.3.2.4  yamt 	while (resid > 0 && error == 0 && uio->uio_offset < size) {
    488  1.3.2.4  yamt 		switch (minor(dev)) {
    489  1.3.2.4  yamt 		case DEV_NVRAM:
    490  1.3.2.4  yamt 			c = min(resid, PAGE_SIZE);
    491  1.3.2.4  yamt 			error = uiomove(&nvramData[uio->uio_offset], c, uio);
    492  1.3.2.4  yamt 			break;
    493  1.3.2.4  yamt 		case DEV_RESIDUAL:
    494  1.3.2.4  yamt 			c = min(resid, PAGE_SIZE);
    495  1.3.2.4  yamt 			error = uiomove(&rdata[uio->uio_offset], c, uio);
    496  1.3.2.4  yamt 			break;
    497  1.3.2.4  yamt 		default:
    498  1.3.2.4  yamt 			return ENXIO;
    499  1.3.2.4  yamt 		}
    500  1.3.2.2  yamt 	}
    501  1.3.2.4  yamt 	return error;
    502  1.3.2.2  yamt }
    503  1.3.2.2  yamt 
    504  1.3.2.2  yamt int
    505  1.3.2.2  yamt prep_nvramopen(dev_t dev, int flags, int mode, struct lwp *l)
    506  1.3.2.2  yamt {
    507  1.3.2.2  yamt 	struct nvram_pnpbus_softc *sc;
    508  1.3.2.2  yamt 
    509  1.3.2.4  yamt 	sc = device_lookup(&nvram_cd, NVRAM_STD_DEV);
    510  1.3.2.2  yamt 	if (sc == NULL)
    511  1.3.2.2  yamt 		return ENODEV;
    512  1.3.2.2  yamt 
    513  1.3.2.2  yamt 	if (sc->sc_open)
    514  1.3.2.2  yamt 		return EBUSY;
    515  1.3.2.2  yamt 
    516  1.3.2.2  yamt 	sc->sc_open = 1;
    517  1.3.2.2  yamt 
    518  1.3.2.2  yamt 	return 0;
    519  1.3.2.2  yamt }
    520  1.3.2.2  yamt 
    521  1.3.2.2  yamt int
    522  1.3.2.2  yamt prep_nvramclose(dev_t dev, int flags, int mode, struct lwp *l)
    523  1.3.2.2  yamt {
    524  1.3.2.2  yamt 	struct nvram_pnpbus_softc *sc;
    525  1.3.2.2  yamt 
    526  1.3.2.4  yamt 	sc = device_lookup(&nvram_cd, NVRAM_STD_DEV);
    527  1.3.2.2  yamt 	if (sc == NULL)
    528  1.3.2.2  yamt 		return ENODEV;
    529  1.3.2.2  yamt 	sc->sc_open = 0;
    530  1.3.2.2  yamt 	return 0;
    531  1.3.2.2  yamt }
    532  1.3.2.2  yamt 
    533  1.3.2.2  yamt /* Motorola mk48txx clock routines */
    534  1.3.2.2  yamt uint8_t
    535  1.3.2.2  yamt mkclock_pnpbus_nvrd(struct mk48txx_softc *osc, int off)
    536  1.3.2.2  yamt {
    537  1.3.2.2  yamt 	struct prep_mk48txx_softc *sc = (struct prep_mk48txx_softc *)osc;
    538  1.3.2.2  yamt 	uint8_t datum;
    539  1.3.2.2  yamt 	int s;
    540  1.3.2.2  yamt 
    541  1.3.2.2  yamt #ifdef DEBUG
    542  1.3.2.5  yamt 	aprint_debug("mkclock_pnpbus_nvrd(%d)", off);
    543  1.3.2.2  yamt #endif
    544  1.3.2.2  yamt 	s = splclock();
    545  1.3.2.2  yamt 	bus_space_write_1(sc->sc_bst, sc->sc_bsh, 0, off & 0xff);
    546  1.3.2.2  yamt 	bus_space_write_1(sc->sc_bst, sc->sc_bsh, 1, off >> 8);
    547  1.3.2.2  yamt 	datum = bus_space_read_1(sc->sc_data, sc->sc_datah, 0);
    548  1.3.2.2  yamt 	splx(s);
    549  1.3.2.2  yamt #ifdef DEBUG
    550  1.3.2.5  yamt 	aprint_debug(" -> %02x\n", datum);
    551  1.3.2.2  yamt #endif
    552  1.3.2.2  yamt 	return datum;
    553  1.3.2.2  yamt }
    554  1.3.2.2  yamt 
    555  1.3.2.2  yamt void
    556  1.3.2.2  yamt mkclock_pnpbus_nvwr(struct mk48txx_softc *osc, int off, uint8_t datum)
    557  1.3.2.2  yamt {
    558  1.3.2.2  yamt 	struct prep_mk48txx_softc *sc = (struct prep_mk48txx_softc *)osc;
    559  1.3.2.2  yamt 	int s;
    560  1.3.2.2  yamt 
    561  1.3.2.2  yamt #ifdef DEBUG
    562  1.3.2.5  yamt 	aprint_debug("mkclock_isa_nvwr(%d, %02x)\n", off, datum);
    563  1.3.2.2  yamt #endif
    564  1.3.2.2  yamt 	s = splclock();
    565  1.3.2.2  yamt 	bus_space_write_1(sc->sc_bst, sc->sc_bsh, 0, off & 0xff);
    566  1.3.2.2  yamt 	bus_space_write_1(sc->sc_bst, sc->sc_bsh, 1, off >> 8);
    567  1.3.2.2  yamt 	bus_space_write_1(sc->sc_data, sc->sc_datah, 0, datum);
    568  1.3.2.2  yamt 	splx(s);
    569  1.3.2.2  yamt }
    570