amdsmn.c revision 329767 
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: stable/11/sys/dev/amdsmn/amdsmn.c 329767 2018-02-22 00:36:12Z truckman $");
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
56struct amdsmn_softc {
57	struct mtx smn_lock;
58};
59
60static struct pciid {
61	uint32_t	device_id;
62} amdsmn_ids[] = {
63	{ 0x14501022 },
64};
65
66/*
67 * Device methods.
68 */
69static void 	amdsmn_identify(driver_t *driver, device_t parent);
70static int	amdsmn_probe(device_t dev);
71static int	amdsmn_attach(device_t dev);
72static int	amdsmn_detach(device_t dev);
73
74static 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
83static driver_t amdsmn_driver = {
84	"amdsmn",
85	amdsmn_methods,
86	sizeof(struct amdsmn_softc),
87};
88
89static devclass_t amdsmn_devclass;
90DRIVER_MODULE(amdsmn, hostb, amdsmn_driver, amdsmn_devclass, NULL, NULL);
91MODULE_VERSION(amdsmn, 1);
92
93static bool
94amdsmn_match(device_t parent)
95{
96	uint32_t devid;
97	size_t i;
98
99	devid = pci_get_devid(parent);
100	for (i = 0; i < nitems(amdsmn_ids); i++)
101		if (amdsmn_ids[i].device_id == devid)
102			return (true);
103	return (false);
104}
105
106static void
107amdsmn_identify(driver_t *driver, device_t parent)
108{
109	device_t child;
110
111	/* Make sure we're not being doubly invoked. */
112	if (device_find_child(parent, "amdsmn", -1) != NULL)
113		return;
114	if (!amdsmn_match(parent))
115		return;
116
117	child = device_add_child(parent, "amdsmn", -1);
118	if (child == NULL)
119		device_printf(parent, "add amdsmn child failed\n");
120}
121
122static int
123amdsmn_probe(device_t dev)
124{
125	uint32_t family;
126
127	if (resource_disabled("amdsmn", 0))
128		return (ENXIO);
129	if (!amdsmn_match(device_get_parent(dev)))
130		return (ENXIO);
131
132	family = CPUID_TO_FAMILY(cpu_id);
133
134	switch (family) {
135	case 0x17:
136		break;
137	default:
138		return (ENXIO);
139	}
140	device_set_desc(dev, "AMD Family 17h System Management Network");
141
142	return (BUS_PROBE_GENERIC);
143}
144
145static int
146amdsmn_attach(device_t dev)
147{
148	struct amdsmn_softc *sc = device_get_softc(dev);
149
150	mtx_init(&sc->smn_lock, "SMN mtx", "SMN", MTX_DEF);
151	return (0);
152}
153
154int
155amdsmn_detach(device_t dev)
156{
157	struct amdsmn_softc *sc = device_get_softc(dev);
158
159	mtx_destroy(&sc->smn_lock);
160	return (0);
161}
162
163int
164amdsmn_read(device_t dev, uint32_t addr, uint32_t *value)
165{
166	struct amdsmn_softc *sc = device_get_softc(dev);
167	device_t parent;
168
169	parent = device_get_parent(dev);
170
171	mtx_lock(&sc->smn_lock);
172	pci_write_config(parent, SMN_ADDR_REG, addr, 4);
173	*value = pci_read_config(parent, SMN_DATA_REG, 4);
174	mtx_unlock(&sc->smn_lock);
175
176	return (0);
177}
178
179int
180amdsmn_write(device_t dev, uint32_t addr, uint32_t value)
181{
182	struct amdsmn_softc *sc = device_get_softc(dev);
183	device_t parent;
184
185	parent = device_get_parent(dev);
186
187	mtx_lock(&sc->smn_lock);
188	pci_write_config(parent, SMN_ADDR_REG, addr, 4);
189	pci_write_config(parent, SMN_DATA_REG, value, 4);
190	mtx_unlock(&sc->smn_lock);
191
192	return (0);
193}
194