lm_isa_common.c revision 1.6
1/* $NetBSD: lm_isa_common.c,v 1.6 2017/08/18 04:07:51 msaitoh Exp $ */ 2 3/*- 4 * Copyright (c) 2000 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Bill Squier. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32#include <sys/cdefs.h> 33__KERNEL_RCSID(0, "$NetBSD: lm_isa_common.c,v 1.6 2017/08/18 04:07:51 msaitoh Exp $"); 34 35#include <sys/param.h> 36#include <sys/systm.h> 37#include <sys/kernel.h> 38#include <sys/device.h> 39#include <sys/module.h> 40#include <sys/conf.h> 41 42#include <sys/bus.h> 43 44#include <dev/isa/isareg.h> 45#include <dev/isa/isavar.h> 46 47#include <dev/ic/nslm7xvar.h> 48 49int lm_isa_match(device_t, cfdata_t, void *); 50void lm_isa_attach(device_t, device_t, void *); 51int lm_isa_detach(device_t, int); 52 53static uint8_t lm_isa_readreg(struct lm_softc *, int); 54static void lm_isa_writereg(struct lm_softc *, int, uint8_t); 55 56struct lm_isa_softc { 57 struct lm_softc lmsc; 58 bus_space_tag_t lm_iot; 59 bus_space_handle_t lm_ioh; 60}; 61 62int 63lm_isa_match(device_t parent, cfdata_t match, void *aux) 64{ 65 bus_space_handle_t ioh; 66 struct isa_attach_args *ia = aux; 67 struct lm_isa_softc sc; 68 int rv; 69 70 /* Must supply an address */ 71 if (ia->ia_nio < 1) 72 return 0; 73 74 if (ISA_DIRECT_CONFIG(ia)) 75 return 0; 76 77 if (ia->ia_io[0].ir_addr == ISA_UNKNOWN_PORT) 78 return 0; 79 80 if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr, 8, 0, &ioh)) 81 return 0; 82 83 /* Bus independent probe */ 84 sc.lm_iot = ia->ia_iot; 85 sc.lm_ioh = ioh; 86 sc.lmsc.lm_writereg = lm_isa_writereg; 87 sc.lmsc.lm_readreg = lm_isa_readreg; 88 rv = lm_match(&sc.lmsc); 89 90 bus_space_unmap(ia->ia_iot, ioh, 8); 91 92 if (rv) { 93 ia->ia_nio = 1; 94 ia->ia_io[0].ir_size = 8; 95 96 ia->ia_niomem = 0; 97 ia->ia_nirq = 0; 98 ia->ia_ndrq = 0; 99 } 100 101 return rv; 102} 103 104 105void 106lm_isa_attach(device_t parent, device_t self, void *aux) 107{ 108 struct lm_isa_softc *sc = device_private(self); 109 struct isa_attach_args *ia = aux; 110 111 sc->lm_iot = ia->ia_iot; 112 113 if (bus_space_map(ia->ia_iot, ia->ia_io[0].ir_addr, 8, 0, 114 &sc->lm_ioh)) { 115 aprint_error(": can't map i/o space\n"); 116 return; 117 } 118 119 /* Bus-independent attachment */ 120 sc->lmsc.sc_dev = self; 121 sc->lmsc.lm_writereg = lm_isa_writereg; 122 sc->lmsc.lm_readreg = lm_isa_readreg; 123 /* pass wbsio Device ID */ 124 sc->lmsc.sioid = (uint16_t)(uintptr_t)ia->ia_aux; 125 126 lm_attach(&sc->lmsc); 127} 128 129int 130lm_isa_detach(device_t self, int flags) 131{ 132 struct lm_isa_softc *sc = device_private(self); 133 134 lm_detach(&sc->lmsc); 135 bus_space_unmap(sc->lm_iot, sc->lm_ioh, 8); 136 return 0; 137} 138 139static uint8_t 140lm_isa_readreg(struct lm_softc *lmsc, int reg) 141{ 142 struct lm_isa_softc *sc = (struct lm_isa_softc *)lmsc; 143 144 bus_space_write_1(sc->lm_iot, sc->lm_ioh, LMC_ADDR, reg); 145 return bus_space_read_1(sc->lm_iot, sc->lm_ioh, LMC_DATA); 146} 147 148static void 149lm_isa_writereg(struct lm_softc *lmsc, int reg, uint8_t val) 150{ 151 struct lm_isa_softc *sc = (struct lm_isa_softc *)lmsc; 152 153 bus_space_write_1(sc->lm_iot, sc->lm_ioh, LMC_ADDR, reg); 154 bus_space_write_1(sc->lm_iot, sc->lm_ioh, LMC_DATA, val); 155} 156 157MODULE(MODULE_CLASS_DRIVER, lm_isa_common, "lm"); 158 159static int 160lm_isa_common_modcmd(modcmd_t cmd, void *priv) 161{ 162 if ((cmd == MODULE_CMD_INIT) || (cmd == MODULE_CMD_FINI)) 163 return 0; 164 return ENOTTY; 165} 166