The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/pci/viapm.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * Copyright (c) 2001 Alcove - Nicolas Souchu
    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: releng/6.0/sys/pci/viapm.c 146734 2005-05-29 04:42:30Z nyan $");
   29 
   30 #include <sys/param.h>
   31 #include <sys/kernel.h>
   32 #include <sys/systm.h>
   33 #include <sys/module.h>
   34 #include <sys/bus.h>
   35 #include <sys/uio.h>
   36 
   37 #include <machine/bus.h>
   38 #include <machine/clock.h>              /* for DELAY */
   39 #include <machine/resource.h>
   40 #include <sys/rman.h>
   41 
   42 #include <dev/pci/pcivar.h>
   43 #include <dev/pci/pcireg.h>
   44 
   45 #include <dev/iicbus/iiconf.h>
   46 #include <dev/iicbus/iicbus.h>
   47 
   48 #include <dev/smbus/smbconf.h>
   49 #include <dev/smbus/smbus.h>
   50 
   51 #include "iicbb_if.h"
   52 #include "smbus_if.h"
   53 
   54 #define VIAPM_DEBUG(x)  if (viapm_debug) (x)
   55 
   56 #ifdef DEBUG
   57 static int viapm_debug = 1;
   58 #else
   59 static int viapm_debug = 0;
   60 #endif
   61 
   62 #define VIA_586B_PMU_ID         0x30401106
   63 #define VIA_596A_PMU_ID         0x30501106
   64 #define VIA_596B_PMU_ID         0x30511106
   65 #define VIA_686A_PMU_ID         0x30571106
   66 #define VIA_8233_PMU_ID         0x30741106
   67 #define VIA_8233A_PMU_ID        0x31471106
   68 
   69 #define VIAPM_INB(port) \
   70         ((u_char)bus_space_read_1(viapm->st, viapm->sh, port))
   71 #define VIAPM_OUTB(port,val) \
   72         (bus_space_write_1(viapm->st, viapm->sh, port, (u_char)(val)))
   73 
   74 #define VIAPM_TYP_UNKNOWN       0
   75 #define VIAPM_TYP_586B_3040E    1
   76 #define VIAPM_TYP_586B_3040F    2
   77 #define VIAPM_TYP_596B          3
   78 #define VIAPM_TYP_686A          4
   79 #define VIAPM_TYP_8233          5
   80 
   81 struct viapm_softc {
   82         int type;
   83         u_int32_t base;
   84         bus_space_tag_t st;
   85         bus_space_handle_t sh;
   86         int iorid;
   87         int irqrid;
   88         struct resource *iores;
   89         struct resource *irqres;
   90         void *irqih;
   91 
   92         device_t iicbb;
   93         device_t smbus;
   94 };
   95 
   96 static devclass_t viapm_devclass;
   97 static devclass_t viapropm_devclass;
   98 
   99 /*
  100  * VT82C586B definitions
  101  */
  102 
  103 #define VIAPM_586B_REVID        0x08
  104 
  105 #define VIAPM_586B_3040E_BASE   0x20
  106 #define VIAPM_586B_3040E_ACTIV  0x4             /* 16 bits */
  107 
  108 #define VIAPM_586B_3040F_BASE   0x48
  109 #define VIAPM_586B_3040F_ACTIV  0x41            /* 8 bits */
  110 
  111 #define VIAPM_586B_OEM_REV_E    0x00
  112 #define VIAPM_586B_OEM_REV_F    0x01
  113 #define VIAPM_586B_PROD_REV_A   0x10
  114 
  115 #define VIAPM_586B_BA_MASK      0x0000ff00
  116 
  117 #define GPIO_DIR        0x40
  118 #define GPIO_VAL        0x42
  119 #define EXTSMI_VAL      0x44
  120 
  121 #define VIAPM_SCL       0x02                    /* GPIO1_VAL */
  122 #define VIAPM_SDA       0x04                    /* GPIO2_VAL */
  123 
  124 /*
  125  * VIAPRO common definitions
  126  */
  127 
  128 #define VIAPM_PRO_BA_MASK       0x0000fff0
  129 #define VIAPM_PRO_SMBCTRL       0xd2
  130 #define VIAPM_PRO_REVID         0xd6
  131 
  132 /*
  133  * VT82C686A definitions
  134  */
  135 
  136 #define VIAPM_PRO_BASE          0x90
  137 
  138 #define SMBHST                  0x0
  139 #define SMBHSL                  0x1
  140 #define SMBHCTRL                0x2
  141 #define SMBHCMD                 0x3
  142 #define SMBHADDR                0x4
  143 #define SMBHDATA0               0x5
  144 #define SMBHDATA1               0x6
  145 #define SMBHBLOCK               0x7
  146 
  147 #define SMBSST                  0x1
  148 #define SMBSCTRL                0x8
  149 #define SMBSSDWCMD              0x9
  150 #define SMBSEVENT               0xa
  151 #define SMBSDATA                0xc
  152 
  153 #define SMBHST_RESERVED         0xef    /* reserved bits */
  154 #define SMBHST_FAILED           0x10    /* failed bus transaction */
  155 #define SMBHST_COLLID           0x08    /* bus collision */
  156 #define SMBHST_ERROR            0x04    /* device error */
  157 #define SMBHST_INTR             0x02    /* command completed */
  158 #define SMBHST_BUSY             0x01    /* host busy */
  159 
  160 #define SMBHCTRL_START          0x40    /* start command */
  161 #define SMBHCTRL_PROTO          0x1c    /* command protocol mask */
  162 #define SMBHCTRL_QUICK          0x00
  163 #define SMBHCTRL_SENDRECV       0x04
  164 #define SMBHCTRL_BYTE           0x08
  165 #define SMBHCTRL_WORD           0x0c
  166 #define SMBHCTRL_BLOCK          0x14
  167 #define SMBHCTRL_KILL           0x02    /* stop the current transaction */
  168 #define SMBHCTRL_ENABLE         0x01    /* enable interrupts */
  169 
  170 #define SMBSCTRL_ENABLE         0x01    /* enable slave */
  171 
  172 
  173 /*
  174  * VIA8233 definitions
  175  */
  176 
  177 #define VIAPM_8233_BASE         0xD0
  178 
  179 static int
  180 viapm_586b_probe(device_t dev)
  181 {
  182         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  183         u_int32_t l;
  184         u_int16_t s;
  185         u_int8_t c;
  186 
  187         switch (pci_get_devid(dev)) {
  188         case VIA_586B_PMU_ID:
  189 
  190                 bzero(viapm, sizeof(struct viapm_softc));
  191 
  192                 l = pci_read_config(dev, VIAPM_586B_REVID, 1);
  193                 switch (l) {
  194                 case VIAPM_586B_OEM_REV_E:
  195                         viapm->type = VIAPM_TYP_586B_3040E;
  196                         viapm->iorid = VIAPM_586B_3040E_BASE;
  197 
  198                         /* Activate IO block access */
  199                         s = pci_read_config(dev, VIAPM_586B_3040E_ACTIV, 2);
  200                         pci_write_config(dev, VIAPM_586B_3040E_ACTIV, s | 0x1, 2);
  201                         break;
  202 
  203                 case VIAPM_586B_OEM_REV_F:
  204                 case VIAPM_586B_PROD_REV_A:
  205                 default:
  206                         viapm->type = VIAPM_TYP_586B_3040F;
  207                         viapm->iorid = VIAPM_586B_3040F_BASE;
  208 
  209                         /* Activate IO block access */
  210                         c = pci_read_config(dev, VIAPM_586B_3040F_ACTIV, 1);
  211                         pci_write_config(dev, VIAPM_586B_3040F_ACTIV, c | 0x80, 1);
  212                         break;
  213                 }
  214 
  215                 viapm->base = pci_read_config(dev, viapm->iorid, 4) &
  216                                 VIAPM_586B_BA_MASK;
  217 
  218                 /*
  219                  * We have to set the I/O resources by hand because it is
  220                  * described outside the viapmope of the traditional maps
  221                  */
  222                 if (bus_set_resource(dev, SYS_RES_IOPORT, viapm->iorid,
  223                                                         viapm->base, 256)) {
  224                         device_printf(dev, "could not set bus resource\n");
  225                         return ENXIO;
  226                 }
  227                 device_set_desc(dev, "VIA VT82C586B Power Management Unit");
  228                 return (BUS_PROBE_DEFAULT);
  229 
  230         default:
  231                 break;
  232         }
  233 
  234         return ENXIO;
  235 }
  236 
  237 
  238 static int
  239 viapm_pro_probe(device_t dev)
  240 {
  241         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  242 #ifdef VIAPM_BASE_ADDR
  243         u_int32_t l;
  244 #endif
  245         u_int32_t base_cfgreg;
  246         char *desc;
  247 
  248         switch (pci_get_devid(dev)) {
  249         case VIA_596A_PMU_ID:
  250                 desc = "VIA VT82C596A Power Management Unit";
  251                 viapm->type = VIAPM_TYP_596B;
  252                 base_cfgreg = VIAPM_PRO_BASE;
  253                 goto viapro;
  254 
  255         case VIA_596B_PMU_ID:
  256                 desc = "VIA VT82C596B Power Management Unit";
  257                 viapm->type = VIAPM_TYP_596B;
  258                 base_cfgreg = VIAPM_PRO_BASE;
  259                 goto viapro;
  260 
  261         case VIA_686A_PMU_ID:
  262                 desc = "VIA VT82C686A Power Management Unit";
  263                 viapm->type = VIAPM_TYP_686A;
  264                 base_cfgreg = VIAPM_PRO_BASE;
  265                 goto viapro;
  266 
  267         case VIA_8233_PMU_ID:
  268         case VIA_8233A_PMU_ID:
  269                 desc = "VIA VT8233 Power Management Unit";
  270                 viapm->type = VIAPM_TYP_UNKNOWN;
  271                 base_cfgreg = VIAPM_8233_BASE;
  272                 goto viapro;
  273 
  274         viapro:
  275 
  276 #ifdef VIAPM_BASE_ADDR
  277                 /* force VIAPM I/O base address */
  278 
  279                 /* enable the SMBus controller function */
  280                 l = pci_read_config(dev, VIAPM_PRO_SMBCTRL, 1);
  281                 pci_write_config(dev, VIAPM_PRO_SMBCTRL, l | 1, 1);
  282 
  283                 /* write the base address */
  284                 pci_write_config(dev, base_cfgreg,
  285                                  VIAPM_BASE_ADDR & VIAPM_PRO_BA_MASK, 4);
  286 #endif
  287 
  288                 viapm->base = pci_read_config(dev, base_cfgreg, 4) & VIAPM_PRO_BA_MASK;
  289 
  290                 /*
  291                  * We have to set the I/O resources by hand because it is
  292                  * described outside the viapmope of the traditional maps
  293                  */
  294                 viapm->iorid = base_cfgreg;
  295                 if (bus_set_resource(dev, SYS_RES_IOPORT, viapm->iorid,
  296                                      viapm->base, 16)) {
  297                         device_printf(dev, "could not set bus resource 0x%x\n",
  298                                         viapm->base);
  299                         return ENXIO;
  300                 }
  301 
  302                 if (1 || bootverbose) {
  303                         device_printf(dev, "SMBus I/O base at 0x%x\n", viapm->base);
  304                 }
  305 
  306                 device_set_desc(dev, desc);
  307                 return (BUS_PROBE_DEFAULT);
  308 
  309         default:
  310                 break;
  311         }
  312 
  313         return ENXIO;
  314 }
  315 
  316 static int
  317 viapm_pro_attach(device_t dev)
  318 {
  319         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  320         u_int32_t l;
  321 
  322         if (!(viapm->iores = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
  323                 &viapm->iorid, RF_ACTIVE))) {
  324                 device_printf(dev, "could not allocate bus space\n");
  325                 goto error;
  326         }
  327         viapm->st = rman_get_bustag(viapm->iores);
  328         viapm->sh = rman_get_bushandle(viapm->iores);
  329 
  330 #if notyet
  331         /* force irq 9 */
  332         l = pci_read_config(dev, VIAPM_PRO_SMBCTRL, 1);
  333         pci_write_config(dev, VIAPM_PRO_SMBCTRL, l | 0x80, 1);
  334 
  335         viapm->irqrid = 0;
  336         if (!(viapm->irqres = bus_alloc_resource(dev, SYS_RES_IRQ,
  337                                 &viapm->irqrid, 9, 9, 1,
  338                                 RF_SHAREABLE | RF_ACTIVE))) {
  339                 device_printf(dev, "could not allocate irq\n");
  340                 goto error;
  341         }
  342 
  343         if (bus_setup_intr(dev, viapm->irqres, INTR_TYPE_MISC,
  344                         (driver_intr_t *) viasmb_intr, viapm, &viapm->irqih)) {
  345                 device_printf(dev, "could not setup irq\n");
  346                 goto error;
  347         }
  348 #endif
  349 
  350         if (1 | bootverbose) {
  351                 l = pci_read_config(dev, VIAPM_PRO_REVID, 1);
  352                 device_printf(dev, "SMBus revision code 0x%x\n", l);
  353         }
  354 
  355         viapm->smbus = device_add_child(dev, "smbus", -1);
  356 
  357         /* probe and attach the smbus */
  358         bus_generic_attach(dev);
  359 
  360         /* disable slave function */
  361         VIAPM_OUTB(SMBSCTRL, VIAPM_INB(SMBSCTRL) & ~SMBSCTRL_ENABLE);
  362 
  363         /* enable the SMBus controller function */
  364         l = pci_read_config(dev, VIAPM_PRO_SMBCTRL, 1);
  365         pci_write_config(dev, VIAPM_PRO_SMBCTRL, l | 1, 1);
  366 
  367 #if notyet
  368         /* enable interrupts */
  369         VIAPM_OUTB(SMBHCTRL, VIAPM_INB(SMBHCTRL) | SMBHCTRL_ENABLE);
  370 #endif
  371 
  372         return 0;
  373 
  374 error:
  375         if (viapm->iores)
  376                 bus_release_resource(dev, SYS_RES_IOPORT, viapm->iorid, viapm->iores);
  377 #if notyet
  378         if (viapm->irqres)
  379                 bus_release_resource(dev, SYS_RES_IRQ, viapm->irqrid, viapm->irqres);
  380 #endif
  381 
  382         return ENXIO;
  383 }
  384 
  385 static int
  386 viapm_586b_attach(device_t dev)
  387 {
  388         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  389         
  390         if (!(viapm->iores = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
  391                 &viapm->iorid, RF_ACTIVE | RF_SHAREABLE))) {
  392                 device_printf(dev, "could not allocate bus resource\n");
  393                 return ENXIO;
  394         }
  395         viapm->st = rman_get_bustag(viapm->iores);
  396         viapm->sh = rman_get_bushandle(viapm->iores);
  397 
  398         VIAPM_OUTB(GPIO_DIR, VIAPM_INB(GPIO_DIR) | VIAPM_SCL | VIAPM_SDA);
  399 
  400         /* add generic bit-banging code */
  401         if (!(viapm->iicbb = device_add_child(dev, "iicbb", -1)))
  402                 goto error;
  403 
  404         bus_generic_attach(dev);
  405 
  406         return 0;
  407 
  408 error:
  409         if (viapm->iores)
  410                 bus_release_resource(dev, SYS_RES_IOPORT,
  411                                         viapm->iorid, viapm->iores);
  412         return ENXIO;
  413 }
  414 
  415 static int
  416 viapm_586b_detach(device_t dev)
  417 {
  418         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  419         int error;
  420 
  421         bus_generic_detach(dev);
  422         if (viapm->iicbb) {
  423                 device_delete_child(dev, viapm->iicbb);
  424         }
  425 
  426         if (viapm->iores && (error = bus_release_resource(dev, SYS_RES_IOPORT,
  427                                                 viapm->iorid, viapm->iores)))
  428                 return (error);
  429 
  430         return 0;
  431 }
  432 
  433 static int
  434 viapm_pro_detach(device_t dev)
  435 {
  436         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  437         int error;
  438 
  439         bus_generic_detach(dev);
  440         if (viapm->smbus) {
  441                 device_delete_child(dev, viapm->smbus);
  442         }
  443 
  444         if ((error = bus_release_resource(dev, SYS_RES_IOPORT,
  445                                 viapm->iorid, viapm->iores)))
  446                 return (error);
  447 
  448 #if notyet
  449         if ((error = bus_release_resource(dev, SYS_RES_IRQ,
  450                                         viapm->irqrid, viapm->irqres))
  451                 return (error);
  452 #endif
  453 
  454         return 0;
  455 }
  456 
  457 static int
  458 viabb_callback(device_t dev, int index, caddr_t *data)
  459 {
  460         return 0;
  461 }
  462 
  463 static void
  464 viabb_setscl(device_t dev, int ctrl)
  465 {
  466         struct viapm_softc *viapm = device_get_softc(dev);
  467         u_char val;
  468 
  469         val = VIAPM_INB(GPIO_VAL);
  470 
  471         if (ctrl)
  472                 val |= VIAPM_SCL;
  473         else
  474                 val &= ~VIAPM_SCL;
  475 
  476         VIAPM_OUTB(GPIO_VAL, val);
  477 
  478         return;
  479 }
  480 
  481 static void
  482 viabb_setsda(device_t dev, int data)
  483 {
  484         struct viapm_softc *viapm = device_get_softc(dev);
  485         u_char val;
  486 
  487         val = VIAPM_INB(GPIO_VAL);
  488 
  489         if (data)
  490                 val |= VIAPM_SDA;
  491         else
  492                 val &= ~VIAPM_SDA;
  493 
  494         VIAPM_OUTB(GPIO_VAL, val);
  495 
  496         return;
  497 }
  498         
  499 static int
  500 viabb_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr)
  501 {
  502         /* reset bus */
  503         viabb_setsda(dev, 1);
  504         viabb_setscl(dev, 1);
  505 
  506         return (IIC_ENOADDR);
  507 }
  508 
  509 static int
  510 viabb_getscl(device_t dev)
  511 {
  512         struct viapm_softc *viapm = device_get_softc(dev);
  513 
  514         return ((VIAPM_INB(EXTSMI_VAL) & VIAPM_SCL) != 0);
  515 }
  516 
  517 static int
  518 viabb_getsda(device_t dev)
  519 {
  520         struct viapm_softc *viapm = device_get_softc(dev);
  521 
  522         return ((VIAPM_INB(EXTSMI_VAL) & VIAPM_SDA) != 0);
  523 }
  524 
  525 static int
  526 viapm_abort(struct viapm_softc *viapm)
  527 {
  528         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_KILL);
  529         DELAY(10);
  530 
  531         return (0);
  532 }
  533 
  534 static int
  535 viapm_clear(struct viapm_softc *viapm)
  536 {
  537         VIAPM_OUTB(SMBHST, SMBHST_FAILED | SMBHST_COLLID |
  538                 SMBHST_ERROR | SMBHST_INTR);
  539         DELAY(10);
  540 
  541         return (0);
  542 }
  543 
  544 static int
  545 viapm_busy(struct viapm_softc *viapm)
  546 {
  547         u_char sts;
  548 
  549         sts = VIAPM_INB(SMBHST);
  550 
  551         VIAPM_DEBUG(printf("viapm: idle? STS=0x%x\n", sts));
  552 
  553         return (sts & SMBHST_BUSY);
  554 }
  555 
  556 /*
  557  * Poll the SMBus controller
  558  */
  559 static int
  560 viapm_wait(struct viapm_softc *viapm)
  561 {
  562         int count = 10000;
  563         u_char sts = 0;
  564         int error;
  565 
  566         /* wait for command to complete and SMBus controller is idle */
  567         while(count--) {
  568                 DELAY(10);
  569                 sts = VIAPM_INB(SMBHST);
  570 
  571                 /* check if the controller is processing a command */
  572                 if (!(sts & SMBHST_BUSY) && (sts & SMBHST_INTR))
  573                         break;
  574         }
  575 
  576         VIAPM_DEBUG(printf("viapm: SMBHST=0x%x\n", sts));
  577 
  578         error = SMB_ENOERR;
  579 
  580         if (!count)
  581                 error |= SMB_ETIMEOUT;
  582 
  583         if (sts & SMBHST_FAILED)
  584                 error |= SMB_EABORT;
  585 
  586         if (sts & SMBHST_COLLID)
  587                 error |= SMB_ENOACK;
  588 
  589         if (sts & SMBHST_ERROR)
  590                 error |= SMB_EBUSERR;
  591 
  592         if (error != SMB_ENOERR)
  593                 viapm_abort(viapm);
  594 
  595         viapm_clear(viapm);
  596 
  597         return (error);
  598 }
  599 
  600 static int
  601 viasmb_callback(device_t dev, int index, caddr_t *data)
  602 {
  603         int error = 0;
  604 
  605         switch (index) {
  606         case SMB_REQUEST_BUS:
  607         case SMB_RELEASE_BUS:
  608                 /* ok, bus allocation accepted */
  609                 break;
  610         default:
  611                 error = EINVAL;
  612         }
  613 
  614         return (error);
  615 }
  616 
  617 static int
  618 viasmb_quick(device_t dev, u_char slave, int how)
  619 {
  620         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  621         int error;
  622 
  623         viapm_clear(viapm);
  624         if (viapm_busy(viapm))
  625                 return (EBUSY);
  626 
  627         switch (how) {
  628         case SMB_QWRITE:
  629                 VIAPM_DEBUG(printf("viapm: QWRITE to 0x%x", slave));
  630                 VIAPM_OUTB(SMBHADDR, slave & ~LSB);
  631                 break;
  632         case SMB_QREAD:
  633                 VIAPM_DEBUG(printf("viapm: QREAD to 0x%x", slave));
  634                 VIAPM_OUTB(SMBHADDR, slave | LSB);
  635                 break;
  636         default:
  637                 panic("%s: unknown QUICK command (%x)!", __func__, how);
  638         }
  639 
  640         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_QUICK);
  641 
  642         error = viapm_wait(viapm);
  643 
  644         return (error);
  645 }
  646 
  647 static int
  648 viasmb_sendb(device_t dev, u_char slave, char byte)
  649 {
  650         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  651         int error;
  652 
  653         viapm_clear(viapm);
  654         if (viapm_busy(viapm))
  655                 return (EBUSY);
  656 
  657         VIAPM_OUTB(SMBHADDR, slave & ~ LSB);
  658         VIAPM_OUTB(SMBHCMD, byte);
  659 
  660         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_SENDRECV);
  661 
  662         error = viapm_wait(viapm);
  663 
  664         VIAPM_DEBUG(printf("viapm: SENDB to 0x%x, byte=0x%x, error=0x%x\n", slave, byte, error));
  665 
  666         return (error);
  667 }
  668 
  669 static int
  670 viasmb_recvb(device_t dev, u_char slave, char *byte)
  671 {
  672         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  673         int error;
  674 
  675         viapm_clear(viapm);
  676         if (viapm_busy(viapm))
  677                 return (EBUSY);
  678 
  679         VIAPM_OUTB(SMBHADDR, slave | LSB);
  680 
  681         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_SENDRECV);
  682 
  683         if ((error = viapm_wait(viapm)) == SMB_ENOERR)
  684                 *byte = VIAPM_INB(SMBHDATA0);
  685 
  686         VIAPM_DEBUG(printf("viapm: RECVB from 0x%x, byte=0x%x, error=0x%x\n", slave, *byte, error));
  687 
  688         return (error);
  689 }
  690 
  691 static int
  692 viasmb_writeb(device_t dev, u_char slave, char cmd, char byte)
  693 {
  694         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  695         int error;
  696 
  697         viapm_clear(viapm);
  698         if (viapm_busy(viapm))
  699                 return (EBUSY);
  700 
  701         VIAPM_OUTB(SMBHADDR, slave & ~ LSB);
  702         VIAPM_OUTB(SMBHCMD, cmd);
  703         VIAPM_OUTB(SMBHDATA0, byte);
  704 
  705         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_BYTE);
  706 
  707         error = viapm_wait(viapm);
  708 
  709         VIAPM_DEBUG(printf("viapm: WRITEB to 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, byte, error));
  710 
  711         return (error);
  712 }
  713 
  714 static int
  715 viasmb_readb(device_t dev, u_char slave, char cmd, char *byte)
  716 {
  717         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  718         int error;
  719 
  720         viapm_clear(viapm);
  721         if (viapm_busy(viapm))
  722                 return (EBUSY);
  723 
  724         VIAPM_OUTB(SMBHADDR, slave | LSB);
  725         VIAPM_OUTB(SMBHCMD, cmd);
  726 
  727         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_BYTE);
  728 
  729         if ((error = viapm_wait(viapm)) == SMB_ENOERR)
  730                 *byte = VIAPM_INB(SMBHDATA0);
  731 
  732         VIAPM_DEBUG(printf("viapm: READB from 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, *byte, error));
  733 
  734         return (error);
  735 }
  736 
  737 static int
  738 viasmb_writew(device_t dev, u_char slave, char cmd, short word)
  739 {
  740         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  741         int error;
  742 
  743         viapm_clear(viapm);
  744         if (viapm_busy(viapm))
  745                 return (EBUSY);
  746 
  747         VIAPM_OUTB(SMBHADDR, slave & ~ LSB);
  748         VIAPM_OUTB(SMBHCMD, cmd);
  749         VIAPM_OUTB(SMBHDATA0, word & 0x00ff);
  750         VIAPM_OUTB(SMBHDATA1, (word & 0xff00) >> 8);
  751 
  752         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_WORD);
  753 
  754         error = viapm_wait(viapm);
  755 
  756         VIAPM_DEBUG(printf("viapm: WRITEW to 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, word, error));
  757 
  758         return (error);
  759 }
  760 
  761 static int
  762 viasmb_readw(device_t dev, u_char slave, char cmd, short *word)
  763 {
  764         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  765         int error;
  766         u_char high, low;
  767 
  768         viapm_clear(viapm);
  769         if (viapm_busy(viapm))
  770                 return (EBUSY);
  771 
  772         VIAPM_OUTB(SMBHADDR, slave | LSB);
  773         VIAPM_OUTB(SMBHCMD, cmd);
  774 
  775         VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_WORD);
  776 
  777         if ((error = viapm_wait(viapm)) == SMB_ENOERR) {
  778                 low = VIAPM_INB(SMBHDATA0);
  779                 high = VIAPM_INB(SMBHDATA1);
  780 
  781                 *word = ((high & 0xff) << 8) | (low & 0xff);
  782         }
  783 
  784         VIAPM_DEBUG(printf("viapm: READW from 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, *word, error));
  785 
  786         return (error);
  787 }
  788 
  789 static int
  790 viasmb_bwrite(device_t dev, u_char slave, char cmd, u_char count, char *buf)
  791 {
  792         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  793         u_char remain, len, i;
  794         int error = SMB_ENOERR;
  795 
  796         viapm_clear(viapm);
  797         if (viapm_busy(viapm))
  798                 return (EBUSY);
  799 
  800         remain = count;
  801         while (remain) {
  802                 len = min(remain, 32);
  803 
  804                 VIAPM_OUTB(SMBHADDR, slave & ~LSB);
  805                 VIAPM_OUTB(SMBHCMD, cmd);
  806                 VIAPM_OUTB(SMBHDATA0, len);
  807                 i = VIAPM_INB(SMBHCTRL);
  808 
  809                 /* fill the 32-byte internal buffer */
  810                 for (i=0; i<len; i++) {
  811                         VIAPM_OUTB(SMBHBLOCK, buf[count-remain+i]);
  812                         DELAY(2);
  813                 }
  814                 VIAPM_OUTB(SMBHCMD, cmd);
  815                 VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_BLOCK);
  816 
  817                 if ((error = viapm_wait(viapm)) != SMB_ENOERR)
  818                         goto error;
  819 
  820                 remain -= len;
  821         }
  822 
  823 error:
  824         VIAPM_DEBUG(printf("viapm: WRITEBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, count, cmd, error));
  825 
  826         return (error);
  827 
  828 }
  829 
  830 static int
  831 viasmb_bread(device_t dev, u_char slave, char cmd, u_char count, char *buf)
  832 {
  833         struct viapm_softc *viapm = (struct viapm_softc *)device_get_softc(dev);
  834         u_char remain, len, i;
  835         int error = SMB_ENOERR;
  836 
  837         viapm_clear(viapm);
  838         if (viapm_busy(viapm))
  839                 return (EBUSY);
  840 
  841         remain = count;
  842         while (remain) {
  843                 VIAPM_OUTB(SMBHADDR, slave | LSB);
  844                 VIAPM_OUTB(SMBHCMD, cmd);
  845                 VIAPM_OUTB(SMBHCTRL, SMBHCTRL_START | SMBHCTRL_BLOCK);
  846 
  847                 if ((error = viapm_wait(viapm)) != SMB_ENOERR)
  848                         goto error;
  849 
  850                 len = VIAPM_INB(SMBHDATA0);
  851                 i = VIAPM_INB(SMBHCTRL);                /* reset counter */
  852 
  853                 len = min(len, remain);
  854 
  855                 /* read the 32-byte internal buffer */
  856                 for (i=0; i<len; i++) {
  857                         buf[count-remain+i] = VIAPM_INB(SMBHBLOCK);
  858                         DELAY(2);
  859                 }
  860 
  861                 remain -= len;
  862         }
  863 error:
  864         VIAPM_DEBUG(printf("viapm: READBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, count, cmd, error));
  865 
  866         return (error);
  867 }
  868 
  869 static device_method_t viapm_methods[] = {
  870         /* device interface */
  871         DEVMETHOD(device_probe,         viapm_586b_probe),
  872         DEVMETHOD(device_attach,        viapm_586b_attach),
  873         DEVMETHOD(device_detach,        viapm_586b_detach),
  874 
  875         /* iicbb interface */
  876         DEVMETHOD(iicbb_callback,       viabb_callback),
  877         DEVMETHOD(iicbb_setscl,         viabb_setscl),
  878         DEVMETHOD(iicbb_setsda,         viabb_setsda),
  879         DEVMETHOD(iicbb_getscl,         viabb_getscl),
  880         DEVMETHOD(iicbb_getsda,         viabb_getsda),
  881         DEVMETHOD(iicbb_reset,          viabb_reset),
  882 
  883         { 0, 0 }
  884 };
  885 
  886 static driver_t viapm_driver = {
  887         "viapm",
  888         viapm_methods,
  889         sizeof(struct viapm_softc),
  890 };
  891 
  892 static device_method_t viapropm_methods[] = {
  893         /* device interface */
  894         DEVMETHOD(device_probe,         viapm_pro_probe),
  895         DEVMETHOD(device_attach,        viapm_pro_attach),
  896         DEVMETHOD(device_detach,        viapm_pro_detach),
  897 
  898         /* smbus interface */
  899         DEVMETHOD(smbus_callback,       viasmb_callback),
  900         DEVMETHOD(smbus_quick,          viasmb_quick),
  901         DEVMETHOD(smbus_sendb,          viasmb_sendb),
  902         DEVMETHOD(smbus_recvb,          viasmb_recvb),
  903         DEVMETHOD(smbus_writeb,         viasmb_writeb),
  904         DEVMETHOD(smbus_readb,          viasmb_readb),
  905         DEVMETHOD(smbus_writew,         viasmb_writew),
  906         DEVMETHOD(smbus_readw,          viasmb_readw),
  907         DEVMETHOD(smbus_bwrite,         viasmb_bwrite),
  908         DEVMETHOD(smbus_bread,          viasmb_bread),
  909         
  910         { 0, 0 }
  911 };
  912 
  913 static driver_t viapropm_driver = {
  914         "viapropm",
  915         viapropm_methods,
  916         sizeof(struct viapm_softc),
  917 };
  918 
  919 DRIVER_MODULE(viapm, pci, viapm_driver, viapm_devclass, 0, 0);
  920 DRIVER_MODULE(viapropm, pci, viapropm_driver, viapropm_devclass, 0, 0);
  921 
  922 MODULE_DEPEND(viapm, pci, 1, 1, 1);
  923 MODULE_DEPEND(viaprom, pci, 1, 1, 1);
  924 MODULE_DEPEND(viapm, iicbb, IICBB_MINVER, IICBB_PREFVER, IICBB_MAXVER);
  925 MODULE_DEPEND(viapropm, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER);
  926 MODULE_VERSION(viapm, 1);

Cache object: df4606362bea4d960c1798d7b5ac1212


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.