src/superio/via/vt1211/vt1211.c

   1 /*
   2  * (C) Copyright 2004 Nick Barker <nick.barker9@btinternet.com>
   3  *
   4  *
   5  * This program is free software; you can redistribute it and/or
   6  * modify it under the terms of the GNU General Public License as
   7  * published by the Free Software Foundation; either version 2 of
   8  * the License, or (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
  18  * MA 02110-1301 USA
  19  */
  20
  21  /* vt1211 routines and defines*/
  22
  23
  24 #include <arch/io.h>
  25 #include <console/console.h>
  26 #include <device/device.h>
  27 #include <device/pnp.h>
  28 #include <uart8250.h>
  29 #include <stdlib.h>
  30
  31 #include "vt1211.h"
  32 #include "chip.h"
  33
  34
  35 static unsigned char vt1211hwmonitorinits[]={
  36  0x10,0x3, 0x11,0x10, 0x12,0xd, 0x13,0x7f,
  37  0x14,0x21, 0x15,0x81, 0x16,0xbd, 0x17,0x8a,
  38  0x18,0x0, 0x19,0x0, 0x1a,0x0, 0x1b,0x0,
  39  0x1d,0xff, 0x1e,0x0, 0x1f,0x73, 0x20,0x67,
  40  0x21,0xc1, 0x22,0xca, 0x23,0x74, 0x24,0xc2,
  41  0x25,0xc7, 0x26,0xc9, 0x27,0x7f, 0x29,0x0,
  42  0x2a,0x0, 0x2b,0xff, 0x2c,0x0, 0x2d,0xff,
  43  0x2e,0x0, 0x2f,0xff, 0x30,0x0, 0x31,0xff,
  44  0x32,0x0, 0x33,0xff, 0x34,0x0, 0x39,0xff,
  45  0x3a,0x0, 0x3b,0xff, 0x3c,0xff, 0x3d,0xff,
  46  0x3e,0x0, 0x3f,0xb0, 0x43,0xff, 0x44,0xff,
  47  0x46,0xff, 0x47,0x50, 0x4a,0x3, 0x4b,0xc0,
  48  0x4c,0x0, 0x4d,0x0, 0x4e,0xf, 0x5d,0x77,
  49  0x5c,0x0, 0x5f,0x33, 0x40,0x1};
  50
  51 static void pnp_enter_ext_func_mode(device_t dev)
  52 {
  53         outb(0x87, dev->path.pnp.port);
  54         outb(0x87, dev->path.pnp.port);
  55 }
  56
  57 static void pnp_exit_ext_func_mode(device_t dev)
  58 {
  59         outb(0xaa, dev->path.pnp.port);
  60 }
  61
  62 static void vt1211_set_iobase(device_t dev, unsigned index, unsigned iobase)
  63 {
  64
  65         switch (dev->path.pnp.device) {
  66                 case VT1211_FDC:
  67                 case VT1211_PP:
  68                 case VT1211_SP1:
  69                 case VT1211_SP2:
  70                         pnp_write_config(dev, index + 0, (iobase >> 2) & 0xff);
  71                         break;
  72                 case VT1211_HWM:
  73                 default:
  74                         pnp_write_config(dev, index + 0, (iobase >> 8) & 0xff);
  75                         pnp_write_config(dev, index + 1, iobase & 0xff);
  76                         break;
  77         }
  78
  79 }
  80
  81 static void init_hwm(unsigned long base)
  82 {
  83         int i;
  84
  85         // initialize vt1211 hardware monitor registers, which are at 0xECXX
  86         for(i = 0; i < sizeof(vt1211hwmonitorinits); i += 2) {
  87                         outb(vt1211hwmonitorinits[i + 1],
  88                                         base + vt1211hwmonitorinits[i]);
  89         }
  90 }
  91
  92 static void vt1211_init(struct device *dev)
  93 {
  94         struct superio_via_vt1211_config *conf = dev->chip_info;
  95         struct resource *res0;
  96
  97         if (!dev->enabled) {
  98                 return;
  99         }
 100
 101         switch (dev->path.pnp.device) {
 102         case VT1211_FDC:
 103         case VT1211_PP:
 104                 break;
 105         case VT1211_SP1:
 106                 res0 = find_resource(dev, PNP_IDX_IO0);
 107                 init_uart8250(res0->base, &conf->com1);
 108                 break;
 109         case VT1211_SP2:
 110                 res0 = find_resource(dev, PNP_IDX_IO0);
 111                 init_uart8250(res0->base, &conf->com2);
 112                 break;
 113         case VT1211_HWM:
 114                 res0 = find_resource(dev, PNP_IDX_IO0);
 115                 init_hwm(res0->base);
 116                 break;
 117         default:
 118                 printk_info("vt1211 asked to initialise unknown device!\n");
 119         }
 120
 121
 122 }
 123
 124 void vt1211_pnp_enable_resources(device_t dev)
 125 {
 126         printk_debug("%s - enabling\n",dev_path(dev));
 127         pnp_enter_ext_func_mode(dev);
 128         pnp_enable_resources(dev);
 129         pnp_exit_ext_func_mode(dev);
 130 }
 131
 132 void vt1211_pnp_set_resources(struct device *dev)
 133 {
 134         int i;
 135         struct resource *resource;
 136
 137 #if CONFIG_CONSOLE_SERIAL8250 == 1
 138         if( dev->path.pnp.device == 2 ){
 139                 for( i = 0 ; i < dev->resources; i++){
 140                         resource = &dev->resource[i];
 141                         resource->flags |= IORESOURCE_STORED;
 142                         report_resource_stored(dev, resource, "");
 143                 }
 144                 return;
 145         }
 146 #endif
 147         pnp_enter_ext_func_mode(dev);
 148         /* Select the device */
 149         pnp_set_logical_device(dev);
 150
 151         /* Paranoia says I should disable the device here... */
 152         for(i = 0; i < dev->resources; i++) {
 153                 resource = &dev->resource[i];
 154                 if (!(resource->flags & IORESOURCE_ASSIGNED)) {
 155                         printk_err("ERROR: %s %02x %s size: 0x%010Lx not assigned\n",
 156                                 dev_path(dev), dev->resource->index,
 157                                 resource_type(resource),
 158                                 resource->size);
 159                         continue;
 160                 }
 161
 162                 /* Now store the resource */
 163                 if (resource->flags & IORESOURCE_IO) {
 164                         vt1211_set_iobase(dev, resource->index, resource->base);
 165                 }
 166                 else if (resource->flags & IORESOURCE_DRQ) {
 167                         pnp_set_drq(dev, resource->index, resource->base);
 168                 }
 169                 else if (resource->flags  & IORESOURCE_IRQ) {
 170                         pnp_set_irq(dev, resource->index, resource->base);
 171                 }
 172                 else {
 173                         printk_err("ERROR: %s %02x unknown resource type\n",
 174                                 dev_path(dev), resource->index);
 175                         return;
 176                 }
 177                 resource->flags |= IORESOURCE_STORED;
 178
 179                 report_resource_stored(dev, resource, "");
 180         }
 181
 182         pnp_exit_ext_func_mode(dev);
 183 }
 184
 185 void vt1211_pnp_enable(device_t dev)
 186 {
 187         if (!dev->enabled) {
 188                 pnp_enter_ext_func_mode(dev);
 189                 pnp_set_logical_device(dev);
 190                 pnp_set_enable(dev, 0);
 191                 pnp_exit_ext_func_mode(dev);
 192         }
 193 }
 194
 195 struct device_operations ops = {
 196         .read_resources   = pnp_read_resources,
 197         .set_resources    = vt1211_pnp_set_resources,
 198         .enable_resources = vt1211_pnp_enable_resources,
 199         .enable           = vt1211_pnp_enable,
 200         .init             = vt1211_init,
 201 };
 202
 203 static struct pnp_info pnp_dev_info[] = {
 204         { &ops, VT1211_FDC, PNP_IO0 | PNP_IRQ0 | PNP_DRQ0, { 0x07f8, 0}, },
 205         { &ops, VT1211_PP,  PNP_IO0 | PNP_IRQ0 | PNP_DRQ0, { 0x07f8, 0}, },
 206         { &ops, VT1211_SP1, PNP_IO0 | PNP_IRQ0,            { 0x07f8, 0}, },
 207         { &ops, VT1211_SP2, PNP_IO0 | PNP_IRQ0,            { 0x07f8, 0}, },
 208         { &ops, VT1211_HWM, PNP_IO0 , { 0xff00, 0 }, },
 209 };
 210
 211 static void enable_dev(struct device *dev)
 212 {
 213         printk_debug("vt1211 enabling PNP devices.\n");
 214         pnp_enable_devices(dev,
 215                         &ops,
 216                         ARRAY_SIZE(pnp_dev_info),
 217                         pnp_dev_info);
 218 }
 219
 220 struct chip_operations superio_via_vt1211_ops = {
 221         CHIP_NAME("VIA VT1211 Super I/O")
 222         .enable_dev = enable_dev,
 223 };