src/superio/nsc/pc8374/pc8374_early_init.c

   1 /*
   2  * This file is part of the coreboot project.
   3  *
   4  * Copyright (C) 2000 AG Electronics Ltd.
   5  * Copyright (C) 2003-2004 Linux Networx
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  20  */
  21
  22 #include <arch/romcc_io.h>
  23 #include "pc8374.h"
  24
  25 static void pc8374_enable(u16 iobase, u8 *init)
  26 {
  27         u8 val, count;
  28
  29         outb(0x29, iobase);
  30         val = inb(iobase + 1);
  31         val |= 0x91;
  32         outb(val, iobase + 1);
  33
  34         for (count = 0; count < 255; count++)
  35                 if (inb(iobase + 1) == 0x91)
  36                         break;
  37
  38         for (; *init; init++) {
  39                 outb(*init, iobase);
  40                 val = inb(iobase + 1);
  41                 init++;
  42                 val &= *init;
  43                 init++;
  44                 val |= *init;
  45                 outb(val, iobase + 1);
  46         }
  47 }
  48
  49 static void pc8374_enable_dev(device_t dev, u16 iobase)
  50 {
  51         pnp_set_logical_device(dev);
  52         pnp_set_enable(dev, 0);
  53         if (iobase)
  54                 pnp_set_iobase(dev, PNP_IDX_IO0, iobase);
  55         pnp_set_enable(dev, 1);
  56 }