1 /*- 2 * Copyright (c) 2017 Conrad Meyer <cem@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 16 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 17 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 18 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 19 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 20 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 22 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 23 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 24 * POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27 /* 28 * Driver for the AMD Family 17h CPU System Management Network. 29 */ 30 31 #include <sys/cdefs.h> 32 __FBSDID("$FreeBSD$"); 33 34 #include <sys/param.h> 35 #include <sys/bus.h> 36 #include <sys/conf.h> 37 #include <sys/lock.h> 38 #include <sys/kernel.h> 39 #include <sys/module.h> 40 #include <sys/mutex.h> 41 #include <sys/sysctl.h> 42 #include <sys/systm.h> 43 44 #include <machine/cpufunc.h> 45 #include <machine/md_var.h> 46 #include <machine/specialreg.h> 47 48 #include <dev/pci/pcivar.h> 49 #include <x86/pci_cfgreg.h> 50 51 #include <dev/amdsmn/amdsmn.h> 52 53 #define SMN_ADDR_REG 0x60 54 #define SMN_DATA_REG 0x64 55 56 struct amdsmn_softc { 57 struct mtx smn_lock; 58 }; 59 60 static struct pciid { 61 uint32_t device_id; 62 } amdsmn_ids[] = { 63 { 0x14501022 }, 64 }; 65 66 /* 67 * Device methods. 68 */ 69 static void amdsmn_identify(driver_t *driver, device_t parent); 70 static int amdsmn_probe(device_t dev); 71 static int amdsmn_attach(device_t dev); 72 static int amdsmn_detach(device_t dev); 73 74 static device_method_t amdsmn_methods[] = { 75 /* Device interface */ 76 DEVMETHOD(device_identify, amdsmn_identify), 77 DEVMETHOD(device_probe, amdsmn_probe), 78 DEVMETHOD(device_attach, amdsmn_attach), 79 DEVMETHOD(device_detach, amdsmn_detach), 80 DEVMETHOD_END 81 }; 82 83 static driver_t amdsmn_driver = { 84 "amdsmn", 85 amdsmn_methods, 86 sizeof(struct amdsmn_softc), 87 }; 88 89 static devclass_t amdsmn_devclass; 90 DRIVER_MODULE(amdsmn, hostb, amdsmn_driver, amdsmn_devclass, NULL, NULL); 91 MODULE_VERSION(amdsmn, 1); 92 MODULE_PNP_INFO("W32:vendor/device", pci, amdsmn, amdsmn_ids, 93 sizeof(amdsmn_ids[0]), nitems(amdsmn_ids)); 94 95 static bool 96 amdsmn_match(device_t parent) 97 { 98 uint32_t devid; 99 size_t i; 100 101 devid = pci_get_devid(parent); 102 for (i = 0; i < nitems(amdsmn_ids); i++) 103 if (amdsmn_ids[i].device_id == devid) 104 return (true); 105 return (false); 106 } 107 108 static void 109 amdsmn_identify(driver_t *driver, device_t parent) 110 { 111 device_t child; 112 113 /* Make sure we're not being doubly invoked. */ 114 if (device_find_child(parent, "amdsmn", -1) != NULL) 115 return; 116 if (!amdsmn_match(parent)) 117 return; 118 119 child = device_add_child(parent, "amdsmn", -1); 120 if (child == NULL) 121 device_printf(parent, "add amdsmn child failed\n"); 122 } 123 124 static int 125 amdsmn_probe(device_t dev) 126 { 127 uint32_t family; 128 129 if (resource_disabled("amdsmn", 0)) 130 return (ENXIO); 131 if (!amdsmn_match(device_get_parent(dev))) 132 return (ENXIO); 133 134 family = CPUID_TO_FAMILY(cpu_id); 135 136 switch (family) { 137 case 0x17: 138 break; 139 default: 140 return (ENXIO); 141 } 142 device_set_desc(dev, "AMD Family 17h System Management Network"); 143 144 return (BUS_PROBE_GENERIC); 145 } 146 147 static int 148 amdsmn_attach(device_t dev) 149 { 150 struct amdsmn_softc *sc = device_get_softc(dev); 151 152 mtx_init(&sc->smn_lock, "SMN mtx", "SMN", MTX_DEF); 153 return (0); 154 } 155 156 int 157 amdsmn_detach(device_t dev) 158 { 159 struct amdsmn_softc *sc = device_get_softc(dev); 160 161 mtx_destroy(&sc->smn_lock); 162 return (0); 163 } 164 165 int 166 amdsmn_read(device_t dev, uint32_t addr, uint32_t *value) 167 { 168 struct amdsmn_softc *sc = device_get_softc(dev); 169 device_t parent; 170 171 parent = device_get_parent(dev); 172 173 mtx_lock(&sc->smn_lock); 174 pci_write_config(parent, SMN_ADDR_REG, addr, 4); 175 *value = pci_read_config(parent, SMN_DATA_REG, 4); 176 mtx_unlock(&sc->smn_lock); 177 178 return (0); 179 } 180 181 int 182 amdsmn_write(device_t dev, uint32_t addr, uint32_t value) 183 { 184 struct amdsmn_softc *sc = device_get_softc(dev); 185 device_t parent; 186 187 parent = device_get_parent(dev); 188 189 mtx_lock(&sc->smn_lock); 190 pci_write_config(parent, SMN_ADDR_REG, addr, 4); 191 pci_write_config(parent, SMN_DATA_REG, value, 4); 192 mtx_unlock(&sc->smn_lock); 193 194 return (0); 195 } 196