intpm.c revision 234040
1/*- 2 * Copyright (c) 1998, 1999 Takanori Watanabe 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 AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: head/sys/pci/intpm.c 234040 2012-04-08 19:58:38Z avg $"); 29 30#include <sys/param.h> 31#include <sys/systm.h> 32#include <sys/bus.h> 33#include <sys/kernel.h> 34#include <sys/lock.h> 35#include <sys/module.h> 36#include <sys/mutex.h> 37#include <sys/rman.h> 38#include <machine/bus.h> 39#include <dev/smbus/smbconf.h> 40 41#include "smbus_if.h" 42 43#include <dev/pci/pcireg.h> 44#include <dev/pci/pcivar.h> 45#include <pci/intpmreg.h> 46 47#include "opt_intpm.h" 48 49struct intsmb_softc { 50 device_t dev; 51 struct resource *io_res; 52 struct resource *irq_res; 53 void *irq_hand; 54 device_t smbus; 55 int isbusy; 56 int cfg_irq9; 57 int poll; 58 struct mtx lock; 59}; 60 61#define INTSMB_LOCK(sc) mtx_lock(&(sc)->lock) 62#define INTSMB_UNLOCK(sc) mtx_unlock(&(sc)->lock) 63#define INTSMB_LOCK_ASSERT(sc) mtx_assert(&(sc)->lock, MA_OWNED) 64 65static int intsmb_probe(device_t); 66static int intsmb_attach(device_t); 67static int intsmb_detach(device_t); 68static int intsmb_intr(struct intsmb_softc *sc); 69static int intsmb_slvintr(struct intsmb_softc *sc); 70static void intsmb_alrintr(struct intsmb_softc *sc); 71static int intsmb_callback(device_t dev, int index, void *data); 72static int intsmb_quick(device_t dev, u_char slave, int how); 73static int intsmb_sendb(device_t dev, u_char slave, char byte); 74static int intsmb_recvb(device_t dev, u_char slave, char *byte); 75static int intsmb_writeb(device_t dev, u_char slave, char cmd, char byte); 76static int intsmb_writew(device_t dev, u_char slave, char cmd, short word); 77static int intsmb_readb(device_t dev, u_char slave, char cmd, char *byte); 78static int intsmb_readw(device_t dev, u_char slave, char cmd, short *word); 79static int intsmb_pcall(device_t dev, u_char slave, char cmd, short sdata, short *rdata); 80static int intsmb_bwrite(device_t dev, u_char slave, char cmd, u_char count, char *buf); 81static int intsmb_bread(device_t dev, u_char slave, char cmd, u_char *count, char *buf); 82static void intsmb_start(struct intsmb_softc *sc, u_char cmd, int nointr); 83static int intsmb_stop(struct intsmb_softc *sc); 84static int intsmb_stop_poll(struct intsmb_softc *sc); 85static int intsmb_free(struct intsmb_softc *sc); 86static void intsmb_rawintr(void *arg); 87 88static int 89intsmb_probe(device_t dev) 90{ 91 92 switch (pci_get_devid(dev)) { 93 case 0x71138086: /* Intel 82371AB */ 94 case 0x719b8086: /* Intel 82443MX */ 95#if 0 96 /* Not a good idea yet, this stops isab0 functioning */ 97 case 0x02001166: /* ServerWorks OSB4 */ 98#endif 99 device_set_desc(dev, "Intel PIIX4 SMBUS Interface"); 100 break; 101 case 0x43851002: 102 /* SB800 and newer can not be configured in a compatible way. */ 103 if (pci_get_revid(dev) >= 0x40) 104 return (ENXIO); 105 device_set_desc(dev, "AMD SB600/700/710/750 SMBus Controller"); 106 /* XXX Maybe force polling right here? */ 107 break; 108 default: 109 return (ENXIO); 110 } 111 112 return (BUS_PROBE_DEFAULT); 113} 114 115static int 116intsmb_attach(device_t dev) 117{ 118 struct intsmb_softc *sc = device_get_softc(dev); 119 int error, rid, value; 120 int intr; 121 char *str; 122 123 sc->dev = dev; 124 125 mtx_init(&sc->lock, device_get_nameunit(dev), "intsmb", MTX_DEF); 126 127 sc->cfg_irq9 = 0; 128#ifndef NO_CHANGE_PCICONF 129 switch (pci_get_devid(dev)) { 130 case 0x71138086: /* Intel 82371AB */ 131 case 0x719b8086: /* Intel 82443MX */ 132 /* Changing configuration is allowed. */ 133 sc->cfg_irq9 = 1; 134 break; 135 } 136#endif 137 138 rid = PCI_BASE_ADDR_SMB; 139 sc->io_res = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, 140 RF_ACTIVE); 141 if (sc->io_res == NULL) { 142 device_printf(dev, "Could not allocate I/O space\n"); 143 error = ENXIO; 144 goto fail; 145 } 146 147 if (sc->cfg_irq9) { 148 pci_write_config(dev, PCIR_INTLINE, 0x9, 1); 149 pci_write_config(dev, PCI_HST_CFG_SMB, 150 PCI_INTR_SMB_IRQ9 | PCI_INTR_SMB_ENABLE, 1); 151 } 152 value = pci_read_config(dev, PCI_HST_CFG_SMB, 1); 153 sc->poll = (value & PCI_INTR_SMB_ENABLE) == 0; 154 intr = value & PCI_INTR_SMB_MASK; 155 switch (intr) { 156 case PCI_INTR_SMB_SMI: 157 str = "SMI"; 158 break; 159 case PCI_INTR_SMB_IRQ9: 160 str = "IRQ 9"; 161 break; 162 case PCI_INTR_SMB_IRQ_PCI: 163 str = "PCI IRQ"; 164 break; 165 default: 166 str = "BOGUS"; 167 } 168 169 device_printf(dev, "intr %s %s ", str, 170 sc->poll == 0 ? "enabled" : "disabled"); 171 printf("revision %d\n", pci_read_config(dev, PCI_REVID_SMB, 1)); 172 173 if (!sc->poll && intr == PCI_INTR_SMB_SMI) { 174 device_printf(dev, 175 "using polling mode when configured interrupt is SMI\n"); 176 sc->poll = 1; 177 } 178 179 if (sc->poll) 180 goto no_intr; 181 182 if (intr != PCI_INTR_SMB_IRQ9 && intr != PCI_INTR_SMB_IRQ_PCI) { 183 device_printf(dev, "Unsupported interrupt mode\n"); 184 error = ENXIO; 185 goto fail; 186 } 187 188 /* Force IRQ 9. */ 189 rid = 0; 190 if (sc->cfg_irq9) 191 bus_set_resource(dev, SYS_RES_IRQ, rid, 9, 1); 192 193 sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 194 RF_SHAREABLE | RF_ACTIVE); 195 if (sc->irq_res == NULL) { 196 device_printf(dev, "Could not allocate irq\n"); 197 error = ENXIO; 198 goto fail; 199 } 200 201 error = bus_setup_intr(dev, sc->irq_res, INTR_TYPE_MISC | INTR_MPSAFE, 202 NULL, intsmb_rawintr, sc, &sc->irq_hand); 203 if (error) { 204 device_printf(dev, "Failed to map intr\n"); 205 goto fail; 206 } 207 208no_intr: 209 sc->isbusy = 0; 210 sc->smbus = device_add_child(dev, "smbus", -1); 211 if (sc->smbus == NULL) { 212 error = ENXIO; 213 goto fail; 214 } 215 error = device_probe_and_attach(sc->smbus); 216 if (error) 217 goto fail; 218 219#ifdef ENABLE_ALART 220 /* Enable Arart */ 221 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, PIIX4_SMBSLVCNT_ALTEN); 222#endif 223 return (0); 224 225fail: 226 intsmb_detach(dev); 227 return (error); 228} 229 230static int 231intsmb_detach(device_t dev) 232{ 233 struct intsmb_softc *sc = device_get_softc(dev); 234 int error; 235 236 error = bus_generic_detach(dev); 237 if (error) 238 return (error); 239 240 if (sc->smbus) 241 device_delete_child(dev, sc->smbus); 242 if (sc->irq_hand) 243 bus_teardown_intr(dev, sc->irq_res, sc->irq_hand); 244 if (sc->irq_res) 245 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq_res); 246 if (sc->io_res) 247 bus_release_resource(dev, SYS_RES_IOPORT, PCI_BASE_ADDR_SMB, 248 sc->io_res); 249 mtx_destroy(&sc->lock); 250 return (0); 251} 252 253static void 254intsmb_rawintr(void *arg) 255{ 256 struct intsmb_softc *sc = arg; 257 258 INTSMB_LOCK(sc); 259 intsmb_intr(sc); 260 intsmb_slvintr(sc); 261 INTSMB_UNLOCK(sc); 262} 263 264static int 265intsmb_callback(device_t dev, int index, void *data) 266{ 267 int error = 0; 268 269 switch (index) { 270 case SMB_REQUEST_BUS: 271 break; 272 case SMB_RELEASE_BUS: 273 break; 274 default: 275 error = EINVAL; 276 } 277 278 return (error); 279} 280 281/* Counterpart of smbtx_smb_free(). */ 282static int 283intsmb_free(struct intsmb_softc *sc) 284{ 285 286 INTSMB_LOCK_ASSERT(sc); 287 if ((bus_read_1(sc->io_res, PIIX4_SMBHSTSTS) & PIIX4_SMBHSTSTAT_BUSY) || 288#ifdef ENABLE_ALART 289 (bus_read_1(sc->io_res, PIIX4_SMBSLVSTS) & PIIX4_SMBSLVSTS_BUSY) || 290#endif 291 sc->isbusy) 292 return (SMB_EBUSY); 293 294 sc->isbusy = 1; 295 /* Disable Interrupt in slave part. */ 296#ifndef ENABLE_ALART 297 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, 0); 298#endif 299 /* Reset INTR Flag to prepare INTR. */ 300 bus_write_1(sc->io_res, PIIX4_SMBHSTSTS, 301 PIIX4_SMBHSTSTAT_INTR | PIIX4_SMBHSTSTAT_ERR | 302 PIIX4_SMBHSTSTAT_BUSC | PIIX4_SMBHSTSTAT_FAIL); 303 return (0); 304} 305 306static int 307intsmb_intr(struct intsmb_softc *sc) 308{ 309 int status, tmp; 310 311 status = bus_read_1(sc->io_res, PIIX4_SMBHSTSTS); 312 if (status & PIIX4_SMBHSTSTAT_BUSY) 313 return (1); 314 315 if (status & (PIIX4_SMBHSTSTAT_INTR | PIIX4_SMBHSTSTAT_ERR | 316 PIIX4_SMBHSTSTAT_BUSC | PIIX4_SMBHSTSTAT_FAIL)) { 317 318 tmp = bus_read_1(sc->io_res, PIIX4_SMBHSTCNT); 319 bus_write_1(sc->io_res, PIIX4_SMBHSTCNT, 320 tmp & ~PIIX4_SMBHSTCNT_INTREN); 321 if (sc->isbusy) { 322 sc->isbusy = 0; 323 wakeup(sc); 324 } 325 return (0); 326 } 327 return (1); /* Not Completed */ 328} 329 330static int 331intsmb_slvintr(struct intsmb_softc *sc) 332{ 333 int status; 334 335 status = bus_read_1(sc->io_res, PIIX4_SMBSLVSTS); 336 if (status & PIIX4_SMBSLVSTS_BUSY) 337 return (1); 338 if (status & PIIX4_SMBSLVSTS_ALART) 339 intsmb_alrintr(sc); 340 else if (status & ~(PIIX4_SMBSLVSTS_ALART | PIIX4_SMBSLVSTS_SDW2 341 | PIIX4_SMBSLVSTS_SDW1)) { 342 } 343 344 /* Reset Status Register */ 345 bus_write_1(sc->io_res, PIIX4_SMBSLVSTS, 346 PIIX4_SMBSLVSTS_ALART | PIIX4_SMBSLVSTS_SDW2 | 347 PIIX4_SMBSLVSTS_SDW1 | PIIX4_SMBSLVSTS_SLV); 348 return (0); 349} 350 351static void 352intsmb_alrintr(struct intsmb_softc *sc) 353{ 354 int slvcnt; 355#ifdef ENABLE_ALART 356 int error; 357 uint8_t addr; 358#endif 359 360 /* Stop generating INTR from ALART. */ 361 slvcnt = bus_read_1(sc->io_res, PIIX4_SMBSLVCNT); 362#ifdef ENABLE_ALART 363 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, 364 slvcnt & ~PIIX4_SMBSLVCNT_ALTEN); 365#endif 366 DELAY(5); 367 368 /* Ask bus who asserted it and then ask it what's the matter. */ 369#ifdef ENABLE_ALART 370 error = intsmb_free(sc); 371 if (error) 372 return; 373 374 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, SMBALTRESP | LSB); 375 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BYTE, 1); 376 error = intsmb_stop_poll(sc); 377 if (error) 378 device_printf(sc->dev, "ALART: ERROR\n"); 379 else { 380 addr = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 381 device_printf(sc->dev, "ALART_RESPONSE: 0x%x\n", addr); 382 } 383 384 /* Re-enable INTR from ALART. */ 385 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, 386 slvcnt | PIIX4_SMBSLVCNT_ALTEN); 387 DELAY(5); 388#endif 389} 390 391static void 392intsmb_start(struct intsmb_softc *sc, unsigned char cmd, int nointr) 393{ 394 unsigned char tmp; 395 396 INTSMB_LOCK_ASSERT(sc); 397 tmp = bus_read_1(sc->io_res, PIIX4_SMBHSTCNT); 398 tmp &= 0xe0; 399 tmp |= cmd; 400 tmp |= PIIX4_SMBHSTCNT_START; 401 402 /* While not in autoconfiguration enable interrupts. */ 403 if (!sc->poll && !cold && !nointr) 404 tmp |= PIIX4_SMBHSTCNT_INTREN; 405 bus_write_1(sc->io_res, PIIX4_SMBHSTCNT, tmp); 406} 407 408static int 409intsmb_error(device_t dev, int status) 410{ 411 int error = 0; 412 413 if (status & PIIX4_SMBHSTSTAT_ERR) 414 error |= SMB_EBUSERR; 415 if (status & PIIX4_SMBHSTSTAT_BUSC) 416 error |= SMB_ECOLLI; 417 if (status & PIIX4_SMBHSTSTAT_FAIL) 418 error |= SMB_ENOACK; 419 420 if (error != 0 && bootverbose) 421 device_printf(dev, "error = %d, status = %#x\n", error, status); 422 423 return (error); 424} 425 426/* 427 * Polling Code. 428 * 429 * Polling is not encouraged because it requires waiting for the 430 * device if it is busy. 431 * (29063505.pdf from Intel) But during boot, interrupt cannot be used, so use 432 * polling code then. 433 */ 434static int 435intsmb_stop_poll(struct intsmb_softc *sc) 436{ 437 int error, i, status, tmp; 438 439 INTSMB_LOCK_ASSERT(sc); 440 441 /* First, wait for busy to be set. */ 442 for (i = 0; i < 0x7fff; i++) 443 if (bus_read_1(sc->io_res, PIIX4_SMBHSTSTS) & 444 PIIX4_SMBHSTSTAT_BUSY) 445 break; 446 447 /* Wait for busy to clear. */ 448 for (i = 0; i < 0x7fff; i++) { 449 status = bus_read_1(sc->io_res, PIIX4_SMBHSTSTS); 450 if (!(status & PIIX4_SMBHSTSTAT_BUSY)) { 451 sc->isbusy = 0; 452 error = intsmb_error(sc->dev, status); 453 return (error); 454 } 455 } 456 457 /* Timed out waiting for busy to clear. */ 458 sc->isbusy = 0; 459 tmp = bus_read_1(sc->io_res, PIIX4_SMBHSTCNT); 460 bus_write_1(sc->io_res, PIIX4_SMBHSTCNT, tmp & ~PIIX4_SMBHSTCNT_INTREN); 461 return (SMB_ETIMEOUT); 462} 463 464/* 465 * Wait for completion and return result. 466 */ 467static int 468intsmb_stop(struct intsmb_softc *sc) 469{ 470 int error, status; 471 472 INTSMB_LOCK_ASSERT(sc); 473 474 if (sc->poll || cold) 475 /* So that it can use device during device probe on SMBus. */ 476 return (intsmb_stop_poll(sc)); 477 478 error = msleep(sc, &sc->lock, PWAIT | PCATCH, "SMBWAI", hz / 8); 479 if (error == 0) { 480 status = bus_read_1(sc->io_res, PIIX4_SMBHSTSTS); 481 if (!(status & PIIX4_SMBHSTSTAT_BUSY)) { 482 error = intsmb_error(sc->dev, status); 483 if (error == 0 && !(status & PIIX4_SMBHSTSTAT_INTR)) 484 device_printf(sc->dev, "unknown cause why?\n"); 485#ifdef ENABLE_ALART 486 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, 487 PIIX4_SMBSLVCNT_ALTEN); 488#endif 489 return (error); 490 } 491 } 492 493 /* Timeout Procedure. */ 494 sc->isbusy = 0; 495 496 /* Re-enable supressed interrupt from slave part. */ 497 bus_write_1(sc->io_res, PIIX4_SMBSLVCNT, PIIX4_SMBSLVCNT_ALTEN); 498 if (error == EWOULDBLOCK) 499 return (SMB_ETIMEOUT); 500 else 501 return (SMB_EABORT); 502} 503 504static int 505intsmb_quick(device_t dev, u_char slave, int how) 506{ 507 struct intsmb_softc *sc = device_get_softc(dev); 508 int error; 509 u_char data; 510 511 data = slave; 512 513 /* Quick command is part of Address, I think. */ 514 switch(how) { 515 case SMB_QWRITE: 516 data &= ~LSB; 517 break; 518 case SMB_QREAD: 519 data |= LSB; 520 break; 521 default: 522 return (EINVAL); 523 } 524 525 INTSMB_LOCK(sc); 526 error = intsmb_free(sc); 527 if (error) { 528 INTSMB_UNLOCK(sc); 529 return (error); 530 } 531 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, data); 532 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_QUICK, 0); 533 error = intsmb_stop(sc); 534 INTSMB_UNLOCK(sc); 535 return (error); 536} 537 538static int 539intsmb_sendb(device_t dev, u_char slave, char byte) 540{ 541 struct intsmb_softc *sc = device_get_softc(dev); 542 int error; 543 544 INTSMB_LOCK(sc); 545 error = intsmb_free(sc); 546 if (error) { 547 INTSMB_UNLOCK(sc); 548 return (error); 549 } 550 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave & ~LSB); 551 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, byte); 552 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BYTE, 0); 553 error = intsmb_stop(sc); 554 INTSMB_UNLOCK(sc); 555 return (error); 556} 557 558static int 559intsmb_recvb(device_t dev, u_char slave, char *byte) 560{ 561 struct intsmb_softc *sc = device_get_softc(dev); 562 int error; 563 564 INTSMB_LOCK(sc); 565 error = intsmb_free(sc); 566 if (error) { 567 INTSMB_UNLOCK(sc); 568 return (error); 569 } 570 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave | LSB); 571 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BYTE, 0); 572 error = intsmb_stop(sc); 573 if (error == 0) { 574#ifdef RECV_IS_IN_CMD 575 /* 576 * Linux SMBus stuff also troubles 577 * Because Intel's datasheet does not make clear. 578 */ 579 *byte = bus_read_1(sc->io_res, PIIX4_SMBHSTCMD); 580#else 581 *byte = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 582#endif 583 } 584 INTSMB_UNLOCK(sc); 585 return (error); 586} 587 588static int 589intsmb_writeb(device_t dev, u_char slave, char cmd, char byte) 590{ 591 struct intsmb_softc *sc = device_get_softc(dev); 592 int error; 593 594 INTSMB_LOCK(sc); 595 error = intsmb_free(sc); 596 if (error) { 597 INTSMB_UNLOCK(sc); 598 return (error); 599 } 600 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave & ~LSB); 601 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 602 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT0, byte); 603 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BDATA, 0); 604 error = intsmb_stop(sc); 605 INTSMB_UNLOCK(sc); 606 return (error); 607} 608 609static int 610intsmb_writew(device_t dev, u_char slave, char cmd, short word) 611{ 612 struct intsmb_softc *sc = device_get_softc(dev); 613 int error; 614 615 INTSMB_LOCK(sc); 616 error = intsmb_free(sc); 617 if (error) { 618 INTSMB_UNLOCK(sc); 619 return (error); 620 } 621 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave & ~LSB); 622 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 623 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT0, word & 0xff); 624 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT1, (word >> 8) & 0xff); 625 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_WDATA, 0); 626 error = intsmb_stop(sc); 627 INTSMB_UNLOCK(sc); 628 return (error); 629} 630 631static int 632intsmb_readb(device_t dev, u_char slave, char cmd, char *byte) 633{ 634 struct intsmb_softc *sc = device_get_softc(dev); 635 int error; 636 637 INTSMB_LOCK(sc); 638 error = intsmb_free(sc); 639 if (error) { 640 INTSMB_UNLOCK(sc); 641 return (error); 642 } 643 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave | LSB); 644 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 645 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BDATA, 0); 646 error = intsmb_stop(sc); 647 if (error == 0) 648 *byte = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 649 INTSMB_UNLOCK(sc); 650 return (error); 651} 652 653static int 654intsmb_readw(device_t dev, u_char slave, char cmd, short *word) 655{ 656 struct intsmb_softc *sc = device_get_softc(dev); 657 int error; 658 659 INTSMB_LOCK(sc); 660 error = intsmb_free(sc); 661 if (error) { 662 INTSMB_UNLOCK(sc); 663 return (error); 664 } 665 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave | LSB); 666 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 667 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_WDATA, 0); 668 error = intsmb_stop(sc); 669 if (error == 0) { 670 *word = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 671 *word |= bus_read_1(sc->io_res, PIIX4_SMBHSTDAT1) << 8; 672 } 673 INTSMB_UNLOCK(sc); 674 return (error); 675} 676 677/* 678 * Data sheet claims that it implements all function, but also claims 679 * that it implements 7 function and not mention PCALL. So I don't know 680 * whether it will work. 681 */ 682static int 683intsmb_pcall(device_t dev, u_char slave, char cmd, short sdata, short *rdata) 684{ 685#ifdef PROCCALL_TEST 686 struct intsmb_softc *sc = device_get_softc(dev); 687 int error; 688 689 INTSMB_LOCK(sc); 690 error = intsmb_free(sc); 691 if (error) { 692 INTSMB_UNLOCK(sc); 693 return (error); 694 } 695 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave & ~LSB); 696 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 697 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT0, sdata & 0xff); 698 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT1, (sdata & 0xff) >> 8); 699 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_WDATA, 0); 700 error = intsmb_stop(sc); 701 if (error == 0) { 702 *rdata = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 703 *rdata |= bus_read_1(sc->io_res, PIIX4_SMBHSTDAT1) << 8; 704 } 705 INTSMB_UNLOCK(sc); 706 return (error); 707#else 708 return (SMB_ENOTSUPP); 709#endif 710} 711 712static int 713intsmb_bwrite(device_t dev, u_char slave, char cmd, u_char count, char *buf) 714{ 715 struct intsmb_softc *sc = device_get_softc(dev); 716 int error, i; 717 718 if (count > SMBBLOCKTRANS_MAX || count == 0) 719 return (SMB_EINVAL); 720 721 INTSMB_LOCK(sc); 722 error = intsmb_free(sc); 723 if (error) { 724 INTSMB_UNLOCK(sc); 725 return (error); 726 } 727 728 /* Reset internal array index. */ 729 bus_read_1(sc->io_res, PIIX4_SMBHSTCNT); 730 731 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave & ~LSB); 732 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 733 for (i = 0; i < count; i++) 734 bus_write_1(sc->io_res, PIIX4_SMBBLKDAT, buf[i]); 735 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT0, count); 736 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BLOCK, 0); 737 error = intsmb_stop(sc); 738 INTSMB_UNLOCK(sc); 739 return (error); 740} 741 742static int 743intsmb_bread(device_t dev, u_char slave, char cmd, u_char *count, char *buf) 744{ 745 struct intsmb_softc *sc = device_get_softc(dev); 746 int error, i; 747 u_char data, nread; 748 749 if (*count > SMBBLOCKTRANS_MAX || *count == 0) 750 return (SMB_EINVAL); 751 752 INTSMB_LOCK(sc); 753 error = intsmb_free(sc); 754 if (error) { 755 INTSMB_UNLOCK(sc); 756 return (error); 757 } 758 759 /* Reset internal array index. */ 760 bus_read_1(sc->io_res, PIIX4_SMBHSTCNT); 761 762 bus_write_1(sc->io_res, PIIX4_SMBHSTADD, slave | LSB); 763 bus_write_1(sc->io_res, PIIX4_SMBHSTCMD, cmd); 764 bus_write_1(sc->io_res, PIIX4_SMBHSTDAT0, *count); 765 intsmb_start(sc, PIIX4_SMBHSTCNT_PROT_BLOCK, 0); 766 error = intsmb_stop(sc); 767 if (error == 0) { 768 nread = bus_read_1(sc->io_res, PIIX4_SMBHSTDAT0); 769 if (nread != 0 && nread <= SMBBLOCKTRANS_MAX) { 770 for (i = 0; i < nread; i++) { 771 data = bus_read_1(sc->io_res, PIIX4_SMBBLKDAT); 772 if (i < *count) 773 buf[i] = data; 774 } 775 *count = nread; 776 } else 777 error = EIO; 778 } 779 INTSMB_UNLOCK(sc); 780 return (error); 781} 782 783static devclass_t intsmb_devclass; 784 785static device_method_t intsmb_methods[] = { 786 /* Device interface */ 787 DEVMETHOD(device_probe, intsmb_probe), 788 DEVMETHOD(device_attach, intsmb_attach), 789 DEVMETHOD(device_detach, intsmb_detach), 790 791 /* SMBus interface */ 792 DEVMETHOD(smbus_callback, intsmb_callback), 793 DEVMETHOD(smbus_quick, intsmb_quick), 794 DEVMETHOD(smbus_sendb, intsmb_sendb), 795 DEVMETHOD(smbus_recvb, intsmb_recvb), 796 DEVMETHOD(smbus_writeb, intsmb_writeb), 797 DEVMETHOD(smbus_writew, intsmb_writew), 798 DEVMETHOD(smbus_readb, intsmb_readb), 799 DEVMETHOD(smbus_readw, intsmb_readw), 800 DEVMETHOD(smbus_pcall, intsmb_pcall), 801 DEVMETHOD(smbus_bwrite, intsmb_bwrite), 802 DEVMETHOD(smbus_bread, intsmb_bread), 803 804 DEVMETHOD_END 805}; 806 807static driver_t intsmb_driver = { 808 "intsmb", 809 intsmb_methods, 810 sizeof(struct intsmb_softc), 811}; 812 813DRIVER_MODULE(intsmb, pci, intsmb_driver, intsmb_devclass, 0, 0); 814DRIVER_MODULE(smbus, intsmb, smbus_driver, smbus_devclass, 0, 0); 815MODULE_DEPEND(intsmb, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER); 816MODULE_VERSION(intsmb, 1); 817