xref: /dragonfly/sys/dev/powermng/amdpm/amdpm.c (revision 2267fd784e8a7d1ca13e6d3541caa91f36c9e9fb)
1 /*-
2  * Copyright (c) 2000 Matthew C. Forman
3  *
4  * Based (heavily) on alpm.c which is:
5  *
6  * Copyright (c) 1998, 1999 Nicolas Souchu
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28  * SUCH DAMAGE.
29  *
30  * $FreeBSD: src/sys/pci/amdpm.c,v 1.22 2008/06/06 18:29:56 jhb Exp $
31  *
32  */
33 
34 /*
35  * Power management function/SMBus function support for the AMD 756 chip.
36  */
37 
38 #include <sys/param.h>
39 #include <sys/bus.h>
40 #include <sys/globaldata.h>
41 #include <sys/kernel.h>
42 #include <sys/lock.h>
43 #include <sys/module.h>
44 #include <sys/rman.h>
45 #include <sys/systm.h>
46 
47 #include <bus/pci/pcivar.h>
48 #include <bus/pci/pcireg.h>
49 
50 #include <bus/smbus/smbconf.h>
51 #include "smbus_if.h"
52 
53 #define AMDPM_DEBUG(x)        if (amdpm_debug) (x)
54 
55 #ifdef DEBUG
56 static int amdpm_debug = 1;
57 #else
58 static int amdpm_debug = 0;
59 #endif
60 
61 #define AMDPM_VENDORID_AMD 0x1022
62 #define AMDPM_DEVICEID_AMD756PM 0x740b
63 #define AMDPM_DEVICEID_AMD766PM 0x7413
64 #define AMDPM_DEVICEID_AMD768PM 0x7443
65 #define AMDPM_DEVICEID_AMD8111PM 0x746B
66 
67 /* nVidia nForce chipset */
68 #define AMDPM_VENDORID_NVIDIA 0x10de
69 #define AMDPM_DEVICEID_NF_SMB 0x01b4
70 
71 /* PCI Configuration space registers */
72 #define AMDPCI_PMBASE 0x58
73 #define NFPCI_PMBASE  0x14
74 
75 #define AMDPCI_GEN_CONFIG_PM 0x41
76 #define AMDPCI_PMIOEN (1<<7)
77 
78 #define AMDPCI_SCIINT_CONFIG_PM 0x42
79 #define AMDPCI_SCISEL_IRQ11 11
80 
81 #define AMDPCI_REVID 0x08
82 
83 /*
84  * I/O registers.
85  * Base address programmed via AMDPCI_PMBASE.
86  */
87 
88 #define AMDSMB_GLOBAL_STATUS (0x00)
89 #define AMDSMB_GS_TO_STS (1<<5)
90 #define AMDSMB_GS_HCYC_STS (1<<4)
91 #define AMDSMB_GS_HST_STS (1<<3)
92 #define AMDSMB_GS_PRERR_STS (1<<2)
93 #define AMDSMB_GS_COL_STS (1<<1)
94 #define AMDSMB_GS_ABRT_STS (1<<0)
95 #define AMDSMB_GS_CLEAR_STS (AMDSMB_GS_TO_STS|AMDSMB_GS_HCYC_STS|AMDSMB_GS_PRERR_STS|AMDSMB_GS_COL_STS|AMDSMB_GS_ABRT_STS)
96 
97 #define AMDSMB_GLOBAL_ENABLE (0x02)
98 #define AMDSMB_GE_ABORT (1<<5)
99 #define AMDSMB_GE_HCYC_EN (1<<4)
100 #define AMDSMB_GE_HOST_STC (1<<3)
101 #define AMDSMB_GE_CYC_QUICK 0
102 #define AMDSMB_GE_CYC_BYTE 1
103 #define AMDSMB_GE_CYC_BDATA 2
104 #define AMDSMB_GE_CYC_WDATA 3
105 #define AMDSMB_GE_CYC_PROCCALL 4
106 #define AMDSMB_GE_CYC_BLOCK 5
107 
108 #define   LSB                 0x1       /* XXX: Better name: Read/Write? */
109 
110 #define AMDSMB_HSTADDR  (0x04)
111 #define AMDSMB_HSTDATA  (0x06)
112 #define AMDSMB_HSTCMD   (0x08)
113 #define AMDSMB_HSTDFIFO (0x09)
114 #define AMDSMB_HSLVDATA (0x0A)
115 #define AMDSMB_HSLVDA   (0x0C)
116 #define AMDSMB_HSLVDDR  (0x0E)
117 #define AMDSMB_SNPADDR  (0x0F)
118 
119 struct amdpm_softc {
120           int base;
121           int rid;
122           struct resource *res;
123           device_t smbus;
124           struct lock lock;
125 };
126 
127 #define   AMDPM_LOCK(amdpm)             lockmgr(&(amdpm)->lock, LK_EXCLUSIVE)
128 #define   AMDPM_UNLOCK(amdpm)           lockmgr(&(amdpm)->lock, LK_RELEASE)
129 #define   AMDPM_LOCK_ASSERT(amdpm)      KKASSERT(lockstatus(&(amdpm)->lock, curthread) != 0)
130 
131 #define AMDPM_SMBINB(amdpm,register) \
132           (bus_read_1(amdpm->res, register))
133 #define AMDPM_SMBOUTB(amdpm,register,value) \
134           (bus_write_1(amdpm->res, register, value))
135 #define AMDPM_SMBINW(amdpm,register) \
136           (bus_read_2(amdpm->res, register))
137 #define AMDPM_SMBOUTW(amdpm,register,value) \
138           (bus_write_2(amdpm->res, register, value))
139 
140 static int          amdpm_detach(device_t dev);
141 
142 static int
amdpm_probe(device_t dev)143 amdpm_probe(device_t dev)
144 {
145           u_long base;
146           u_int16_t vid;
147           u_int16_t did;
148 
149           vid = pci_get_vendor(dev);
150           did = pci_get_device(dev);
151           if ((vid == AMDPM_VENDORID_AMD) &&
152               ((did == AMDPM_DEVICEID_AMD756PM) ||
153                (did == AMDPM_DEVICEID_AMD766PM) ||
154                (did == AMDPM_DEVICEID_AMD768PM) ||
155                (did == AMDPM_DEVICEID_AMD8111PM))) {
156                     device_set_desc(dev, "AMD 756/766/768/8111 Power Management Controller");
157 
158                     /*
159                      * We have to do this, since the BIOS won't give us the
160                      * resource info (not mine, anyway).
161                      */
162                     base = pci_read_config(dev, AMDPCI_PMBASE, 4);
163                     base &= 0xff00;
164                     bus_set_resource(dev, SYS_RES_IOPORT, AMDPCI_PMBASE,
165                                          base+0xe0, 32, -1);
166                     return (BUS_PROBE_DEFAULT);
167           }
168 
169           if ((vid == AMDPM_VENDORID_NVIDIA) &&
170               (did == AMDPM_DEVICEID_NF_SMB)) {
171                     device_set_desc(dev, "nForce SMBus Controller");
172 
173                     /*
174                      * We have to do this, since the BIOS won't give us the
175                      * resource info (not mine, anyway).
176                      */
177                     base = pci_read_config(dev, NFPCI_PMBASE, 4);
178                     base &= 0xff00;
179                     bus_set_resource(dev, SYS_RES_IOPORT, NFPCI_PMBASE,
180                                          base, 32, -1);
181 
182                     return (BUS_PROBE_DEFAULT);
183           }
184 
185           return ENXIO;
186 }
187 
188 static int
amdpm_attach(device_t dev)189 amdpm_attach(device_t dev)
190 {
191           struct amdpm_softc *amdpm_sc = device_get_softc(dev);
192           u_char val_b;
193 
194           /* Enable I/O block access */
195           val_b = pci_read_config(dev, AMDPCI_GEN_CONFIG_PM, 1);
196           pci_write_config(dev, AMDPCI_GEN_CONFIG_PM, val_b | AMDPCI_PMIOEN, 1);
197 
198           /* Allocate I/O space */
199           if (pci_get_vendor(dev) == AMDPM_VENDORID_AMD)
200                     amdpm_sc->rid = AMDPCI_PMBASE;
201           else
202                     amdpm_sc->rid = NFPCI_PMBASE;
203           amdpm_sc->res = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
204                     &amdpm_sc->rid, RF_ACTIVE);
205 
206           if (amdpm_sc->res == NULL) {
207                     device_printf(dev, "could not map i/o space\n");
208                     return (ENXIO);
209           }
210 
211           lockinit(&amdpm_sc->lock, "amdpm", 0, LK_CANRECURSE);
212 
213           /* Allocate a new smbus device */
214           amdpm_sc->smbus = device_add_child(dev, "smbus", -1);
215           if (!amdpm_sc->smbus) {
216                     amdpm_detach(dev);
217                     return (EINVAL);
218           }
219 
220           bus_generic_attach(dev);
221 
222           return (0);
223 }
224 
225 static int
amdpm_detach(device_t dev)226 amdpm_detach(device_t dev)
227 {
228           struct amdpm_softc *amdpm_sc = device_get_softc(dev);
229 
230           if (amdpm_sc->smbus) {
231                     device_delete_child(dev, amdpm_sc->smbus);
232                     amdpm_sc->smbus = NULL;
233           }
234 
235           lockuninit(&amdpm_sc->lock);
236           if (amdpm_sc->res)
237                     bus_release_resource(dev, SYS_RES_IOPORT, amdpm_sc->rid,
238                                              amdpm_sc->res);
239 
240           return (0);
241 }
242 
243 static int
amdpm_callback(device_t dev,int index,void * data)244 amdpm_callback(device_t dev, int index, void *data)
245 {
246           int error = 0;
247 
248           switch (index) {
249           case SMB_REQUEST_BUS:
250           case SMB_RELEASE_BUS:
251                     break;
252           default:
253                     error = EINVAL;
254           }
255 
256           return (error);
257 }
258 
259 static int
amdpm_clear(struct amdpm_softc * sc)260 amdpm_clear(struct amdpm_softc *sc)
261 {
262 
263           AMDPM_LOCK_ASSERT(sc);
264           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_STATUS, AMDSMB_GS_CLEAR_STS);
265           DELAY(10);
266 
267           return (0);
268 }
269 
270 #if 0
271 static int
272 amdpm_abort(struct amdpm_softc *sc)
273 {
274           u_short l;
275 
276           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
277           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, l | AMDSMB_GE_ABORT);
278 
279           return (0);
280 }
281 #endif
282 
283 static int
amdpm_idle(struct amdpm_softc * sc)284 amdpm_idle(struct amdpm_softc *sc)
285 {
286           u_short sts;
287 
288           AMDPM_LOCK_ASSERT(sc);
289           sts = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_STATUS);
290 
291           AMDPM_DEBUG(kprintf("amdpm: busy? STS=0x%x\n", sts));
292 
293           return (~(sts & AMDSMB_GS_HST_STS));
294 }
295 
296 /*
297  * Poll the SMBus controller
298  */
299 static int
amdpm_wait(struct amdpm_softc * sc)300 amdpm_wait(struct amdpm_softc *sc)
301 {
302           int count = 10000;
303           u_short sts = 0;
304           int error;
305 
306           AMDPM_LOCK_ASSERT(sc);
307           /* Wait for command to complete (SMBus controller is idle) */
308           while(count--) {
309                     DELAY(10);
310                     sts = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_STATUS);
311                     if (!(sts & AMDSMB_GS_HST_STS))
312                               break;
313           }
314 
315           AMDPM_DEBUG(kprintf("amdpm: STS=0x%x (count=%d)\n", sts, count));
316 
317           error = SMB_ENOERR;
318 
319           if (!count)
320                     error |= SMB_ETIMEOUT;
321 
322           if (sts & AMDSMB_GS_ABRT_STS)
323                     error |= SMB_EABORT;
324 
325           if (sts & AMDSMB_GS_COL_STS)
326                     error |= SMB_ENOACK;
327 
328           if (sts & AMDSMB_GS_PRERR_STS)
329                     error |= SMB_EBUSERR;
330 
331           if (error != SMB_ENOERR)
332                     amdpm_clear(sc);
333 
334           return (error);
335 }
336 
337 static int
amdpm_quick(device_t dev,u_char slave,int how)338 amdpm_quick(device_t dev, u_char slave, int how)
339 {
340           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
341           int error;
342           u_short l;
343 
344           AMDPM_LOCK(sc);
345           amdpm_clear(sc);
346           if (!amdpm_idle(sc)) {
347                     AMDPM_UNLOCK(sc);
348                     return (EBUSY);
349           }
350 
351           switch (how) {
352           case SMB_QWRITE:
353                     AMDPM_DEBUG(kprintf("amdpm: QWRITE to 0x%x", slave));
354                     AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave & ~LSB);
355                     break;
356           case SMB_QREAD:
357                     AMDPM_DEBUG(kprintf("amdpm: QREAD to 0x%x", slave));
358                     AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave | LSB);
359                     break;
360           default:
361                     panic("%s: unknown QUICK command (%x)!", __func__, how);
362           }
363           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
364           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_QUICK | AMDSMB_GE_HOST_STC);
365 
366           error = amdpm_wait(sc);
367 
368           AMDPM_DEBUG(kprintf(", error=0x%x\n", error));
369           AMDPM_UNLOCK(sc);
370 
371           return (error);
372 }
373 
374 static int
amdpm_sendb(device_t dev,u_char slave,char byte)375 amdpm_sendb(device_t dev, u_char slave, char byte)
376 {
377           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
378           int error;
379           u_short l;
380 
381           AMDPM_LOCK(sc);
382           amdpm_clear(sc);
383           if (!amdpm_idle(sc)) {
384                     AMDPM_UNLOCK(sc);
385                     return (SMB_EBUSY);
386           }
387 
388           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave & ~LSB);
389           AMDPM_SMBOUTW(sc, AMDSMB_HSTDATA, byte);
390           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
391           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_BYTE | AMDSMB_GE_HOST_STC);
392 
393           error = amdpm_wait(sc);
394 
395           AMDPM_DEBUG(kprintf("amdpm: SENDB to 0x%x, byte=0x%x, error=0x%x\n", slave, byte, error));
396           AMDPM_UNLOCK(sc);
397 
398           return (error);
399 }
400 
401 static int
amdpm_recvb(device_t dev,u_char slave,char * byte)402 amdpm_recvb(device_t dev, u_char slave, char *byte)
403 {
404           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
405           int error;
406           u_short l;
407 
408           AMDPM_LOCK(sc);
409           amdpm_clear(sc);
410           if (!amdpm_idle(sc)) {
411                     AMDPM_UNLOCK(sc);
412                     return (SMB_EBUSY);
413           }
414 
415           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave | LSB);
416           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
417           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_BYTE | AMDSMB_GE_HOST_STC);
418 
419           if ((error = amdpm_wait(sc)) == SMB_ENOERR)
420                     *byte = AMDPM_SMBINW(sc, AMDSMB_HSTDATA);
421 
422           AMDPM_DEBUG(kprintf("amdpm: RECVB from 0x%x, byte=0x%x, error=0x%x\n", slave, *byte, error));
423           AMDPM_UNLOCK(sc);
424 
425           return (error);
426 }
427 
428 static int
amdpm_writeb(device_t dev,u_char slave,char cmd,char byte)429 amdpm_writeb(device_t dev, u_char slave, char cmd, char byte)
430 {
431           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
432           int error;
433           u_short l;
434 
435           AMDPM_LOCK(sc);
436           amdpm_clear(sc);
437           if (!amdpm_idle(sc)) {
438                     AMDPM_UNLOCK(sc);
439                     return (SMB_EBUSY);
440           }
441 
442           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave & ~LSB);
443           AMDPM_SMBOUTW(sc, AMDSMB_HSTDATA, byte);
444           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
445           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
446           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_BDATA | AMDSMB_GE_HOST_STC);
447 
448           error = amdpm_wait(sc);
449 
450           AMDPM_DEBUG(kprintf("amdpm: WRITEB to 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, byte, error));
451           AMDPM_UNLOCK(sc);
452 
453           return (error);
454 }
455 
456 static int
amdpm_readb(device_t dev,u_char slave,char cmd,char * byte)457 amdpm_readb(device_t dev, u_char slave, char cmd, char *byte)
458 {
459           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
460           int error;
461           u_short l;
462 
463           AMDPM_LOCK(sc);
464           amdpm_clear(sc);
465           if (!amdpm_idle(sc)) {
466                     AMDPM_UNLOCK(sc);
467                     return (SMB_EBUSY);
468           }
469 
470           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave | LSB);
471           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
472           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
473           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_BDATA | AMDSMB_GE_HOST_STC);
474 
475           if ((error = amdpm_wait(sc)) == SMB_ENOERR)
476                     *byte = AMDPM_SMBINW(sc, AMDSMB_HSTDATA);
477 
478           AMDPM_DEBUG(kprintf("amdpm: READB from 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, *byte, error));
479           AMDPM_UNLOCK(sc);
480 
481           return (error);
482 }
483 
484 static int
amdpm_writew(device_t dev,u_char slave,char cmd,short word)485 amdpm_writew(device_t dev, u_char slave, char cmd, short word)
486 {
487           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
488           int error;
489           u_short l;
490 
491           AMDPM_LOCK(sc);
492           amdpm_clear(sc);
493           if (!amdpm_idle(sc)) {
494                     AMDPM_UNLOCK(sc);
495                     return (SMB_EBUSY);
496           }
497 
498           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave & ~LSB);
499           AMDPM_SMBOUTW(sc, AMDSMB_HSTDATA, word);
500           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
501           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
502           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_WDATA | AMDSMB_GE_HOST_STC);
503 
504           error = amdpm_wait(sc);
505 
506           AMDPM_DEBUG(kprintf("amdpm: WRITEW to 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, word, error));
507           AMDPM_UNLOCK(sc);
508 
509           return (error);
510 }
511 
512 static int
amdpm_readw(device_t dev,u_char slave,char cmd,short * word)513 amdpm_readw(device_t dev, u_char slave, char cmd, short *word)
514 {
515           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
516           int error;
517           u_short l;
518 
519           AMDPM_LOCK(sc);
520           amdpm_clear(sc);
521           if (!amdpm_idle(sc)) {
522                     AMDPM_UNLOCK(sc);
523                     return (SMB_EBUSY);
524           }
525 
526           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave | LSB);
527           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
528           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
529           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE, (l & 0xfff8) | AMDSMB_GE_CYC_WDATA | AMDSMB_GE_HOST_STC);
530 
531           if ((error = amdpm_wait(sc)) == SMB_ENOERR)
532                     *word = AMDPM_SMBINW(sc, AMDSMB_HSTDATA);
533 
534           AMDPM_DEBUG(kprintf("amdpm: READW from 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, *word, error));
535           AMDPM_UNLOCK(sc);
536 
537           return (error);
538 }
539 
540 static int
amdpm_bwrite(device_t dev,u_char slave,char cmd,u_char count,char * buf)541 amdpm_bwrite(device_t dev, u_char slave, char cmd, u_char count, char *buf)
542 {
543           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
544           u_char i;
545           int error;
546           u_short l;
547 
548           if (count < 1 || count > 32)
549                     return (SMB_EINVAL);
550 
551           AMDPM_LOCK(sc);
552           amdpm_clear(sc);
553           if (!amdpm_idle(sc)) {
554                     AMDPM_UNLOCK(sc);
555                     return (SMB_EBUSY);
556           }
557 
558           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave & ~LSB);
559 
560           /*
561            * Do we have to reset the internal 32-byte buffer?
562            * Can't see how to do this from the data sheet.
563            */
564           AMDPM_SMBOUTW(sc, AMDSMB_HSTDATA, count);
565 
566           /* Fill the 32-byte internal buffer */
567           for (i = 0; i < count; i++) {
568                     AMDPM_SMBOUTB(sc, AMDSMB_HSTDFIFO, buf[i]);
569                     DELAY(2);
570           }
571           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
572           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
573           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE,
574               (l & 0xfff8) | AMDSMB_GE_CYC_BLOCK | AMDSMB_GE_HOST_STC);
575 
576           error = amdpm_wait(sc);
577 
578           AMDPM_DEBUG(kprintf("amdpm: WRITEBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, count, cmd, error));
579           AMDPM_UNLOCK(sc);
580 
581           return (error);
582 }
583 
584 static int
amdpm_bread(device_t dev,u_char slave,char cmd,u_char * count,char * buf)585 amdpm_bread(device_t dev, u_char slave, char cmd, u_char *count, char *buf)
586 {
587           struct amdpm_softc *sc = (struct amdpm_softc *)device_get_softc(dev);
588           u_char data, len, i;
589           int error;
590           u_short l;
591 
592           if (*count < 1 || *count > 32)
593                     return (SMB_EINVAL);
594 
595           AMDPM_LOCK(sc);
596           amdpm_clear(sc);
597           if (!amdpm_idle(sc)) {
598                     AMDPM_UNLOCK(sc);
599                     return (SMB_EBUSY);
600           }
601 
602           AMDPM_SMBOUTW(sc, AMDSMB_HSTADDR, slave | LSB);
603 
604           AMDPM_SMBOUTB(sc, AMDSMB_HSTCMD, cmd);
605 
606           l = AMDPM_SMBINW(sc, AMDSMB_GLOBAL_ENABLE);
607           AMDPM_SMBOUTW(sc, AMDSMB_GLOBAL_ENABLE,
608               (l & 0xfff8) | AMDSMB_GE_CYC_BLOCK | AMDSMB_GE_HOST_STC);
609 
610           if ((error = amdpm_wait(sc)) != SMB_ENOERR)
611                     goto error;
612 
613           len = AMDPM_SMBINW(sc, AMDSMB_HSTDATA);
614 
615           /* Read the 32-byte internal buffer */
616           for (i = 0; i < len; i++) {
617                     data = AMDPM_SMBINB(sc, AMDSMB_HSTDFIFO);
618                     if (i < *count)
619                               buf[i] = data;
620                     DELAY(2);
621           }
622           *count = len;
623 
624 error:
625           AMDPM_DEBUG(kprintf("amdpm: READBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, *count, cmd, error));
626           AMDPM_UNLOCK(sc);
627 
628           return (error);
629 }
630 
631 static devclass_t amdpm_devclass;
632 
633 static device_method_t amdpm_methods[] = {
634           /* Device interface */
635           DEVMETHOD(device_probe,                 amdpm_probe),
636           DEVMETHOD(device_attach,      amdpm_attach),
637           DEVMETHOD(device_detach,      amdpm_detach),
638 
639           /* SMBus interface */
640           DEVMETHOD(smbus_callback,     amdpm_callback),
641           DEVMETHOD(smbus_quick,                  amdpm_quick),
642           DEVMETHOD(smbus_sendb,                  amdpm_sendb),
643           DEVMETHOD(smbus_recvb,                  amdpm_recvb),
644           DEVMETHOD(smbus_writeb,                 amdpm_writeb),
645           DEVMETHOD(smbus_readb,                  amdpm_readb),
646           DEVMETHOD(smbus_writew,                 amdpm_writew),
647           DEVMETHOD(smbus_readw,                  amdpm_readw),
648           DEVMETHOD(smbus_bwrite,                 amdpm_bwrite),
649           DEVMETHOD(smbus_bread,                  amdpm_bread),
650 
651           DEVMETHOD_END
652 };
653 
654 static driver_t amdpm_driver = {
655           "amdpm",
656           amdpm_methods,
657           sizeof(struct amdpm_softc),
658 };
659 
660 DRIVER_MODULE(amdpm, pci, amdpm_driver, amdpm_devclass, NULL, NULL);
661 DRIVER_MODULE(smbus, amdpm, smbus_driver, smbus_devclass, NULL, NULL);
662 
663 MODULE_DEPEND(amdpm, pci, 1, 1, 1);
664 MODULE_DEPEND(amdpm, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER);
665 MODULE_VERSION(amdpm, 1);
666