2 * (C) Copyright 2004 Nick Barker <nick.barker9@btinternet.com>
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.
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.
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,
21 /* vt1211 routines and defines*/
25 #include <console/console.h>
26 #include <device/device.h>
27 #include <device/pnp.h>
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};
51 static void pnp_enter_ext_func_mode(device_t dev)
53 outb(0x87, dev->path.pnp.port);
54 outb(0x87, dev->path.pnp.port);
57 static void pnp_exit_ext_func_mode(device_t dev)
59 outb(0xaa, dev->path.pnp.port);
62 static void vt1211_set_iobase(device_t dev, unsigned index, unsigned iobase)
65 switch (dev->path.pnp.device) {
70 pnp_write_config(dev, index + 0, (iobase >> 2) & 0xff);
74 pnp_write_config(dev, index + 0, (iobase >> 8) & 0xff);
75 pnp_write_config(dev, index + 1, iobase & 0xff);
81 static void init_hwm(unsigned long base)
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]);
92 static void vt1211_init(struct device *dev)
94 struct superio_via_vt1211_config *conf = dev->chip_info;
95 struct resource *res0;
101 switch (dev->path.pnp.device) {
106 res0 = find_resource(dev, PNP_IDX_IO0);
107 init_uart8250(res0->base, &conf->com1);
110 res0 = find_resource(dev, PNP_IDX_IO0);
111 init_uart8250(res0->base, &conf->com2);
114 res0 = find_resource(dev, PNP_IDX_IO0);
115 init_hwm(res0->base);
118 printk_info("vt1211 asked to initialise unknown device!\n");
124 void vt1211_pnp_enable_resources(device_t dev)
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);
132 void vt1211_pnp_set_resources(struct device *dev)
135 struct resource *resource;
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, "");
147 pnp_enter_ext_func_mode(dev);
148 /* Select the device */
149 pnp_set_logical_device(dev);
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),
162 /* Now store the resource */
163 if (resource->flags & IORESOURCE_IO) {
164 vt1211_set_iobase(dev, resource->index, resource->base);
166 else if (resource->flags & IORESOURCE_DRQ) {
167 pnp_set_drq(dev, resource->index, resource->base);
169 else if (resource->flags & IORESOURCE_IRQ) {
170 pnp_set_irq(dev, resource->index, resource->base);
173 printk_err("ERROR: %s %02x unknown resource type\n",
174 dev_path(dev), resource->index);
177 resource->flags |= IORESOURCE_STORED;
179 report_resource_stored(dev, resource, "");
182 pnp_exit_ext_func_mode(dev);
185 void vt1211_pnp_enable(device_t dev)
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);
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,
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 }, },
211 static void enable_dev(struct device *dev)
213 printk_debug("vt1211 enabling PNP devices.\n");
214 pnp_enable_devices(dev,
216 ARRAY_SIZE(pnp_dev_info),
220 struct chip_operations superio_via_vt1211_ops = {
221 CHIP_NAME("VIA VT1211 Super I/O")
222 .enable_dev = enable_dev,