sys/dev/amdsmn/amdsmn.c

   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 }