aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/video/savage
diff options
context:
space:
mode:
authorLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
committerLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
commit1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch)
tree0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/video/savage
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip!
Diffstat (limited to 'drivers/video/savage')
-rw-r--r--drivers/video/savage/Makefile9
-rw-r--r--drivers/video/savage/savagefb-i2c.c282
-rw-r--r--drivers/video/savage/savagefb.h354
-rw-r--r--drivers/video/savage/savagefb_accel.c136
-rw-r--r--drivers/video/savage/savagefb_driver.c2279
5 files changed, 3060 insertions, 0 deletions
diff --git a/drivers/video/savage/Makefile b/drivers/video/savage/Makefile
new file mode 100644
index 000000000000..e09770fff8ea
--- /dev/null
+++ b/drivers/video/savage/Makefile
@@ -0,0 +1,9 @@
1#
2# Makefile for the S3 Savage framebuffer driver
3#
4
5obj-$(CONFIG_FB_SAVAGE) += savagefb.o
6
7savagefb-y += savagefb_driver.o
8savagefb-$(CONFIG_FB_SAVAGE_I2C) += savagefb-i2c.o
9savagefb-$(CONFIG_FB_SAVAGE_ACCEL) += savagefb_accel.o
diff --git a/drivers/video/savage/savagefb-i2c.c b/drivers/video/savage/savagefb-i2c.c
new file mode 100644
index 000000000000..024a0cecff15
--- /dev/null
+++ b/drivers/video/savage/savagefb-i2c.c
@@ -0,0 +1,282 @@
1/*
2 * linux/drivers/video/savage/savagefb-i2c.c - S3 Savage DDC2
3 *
4 * Copyright 2004 Antonino A. Daplas <adaplas @pol.net>
5 *
6 * Based partly on rivafb-i2c.c
7 *
8 * This file is subject to the terms and conditions of the GNU General Public
9 * License. See the file COPYING in the main directory of this archive
10 * for more details.
11 */
12
13#include <linux/config.h>
14#include <linux/module.h>
15#include <linux/kernel.h>
16#include <linux/sched.h>
17#include <linux/delay.h>
18#include <linux/pci.h>
19#include <linux/fb.h>
20
21#include <asm/io.h>
22#include "savagefb.h"
23
24#define SAVAGE_DDC 0x50
25
26#define VGA_CR_IX 0x3d4
27#define VGA_CR_DATA 0x3d5
28
29#define CR_SERIAL1 0xa0 /* I2C serial communications interface */
30#define MM_SERIAL1 0xff20
31#define CR_SERIAL2 0xb1 /* DDC2 monitor communications interface */
32
33/* based on vt8365 documentation */
34#define PROSAVAGE_I2C_ENAB 0x10
35#define PROSAVAGE_I2C_SCL_OUT 0x01
36#define PROSAVAGE_I2C_SDA_OUT 0x02
37#define PROSAVAGE_I2C_SCL_IN 0x04
38#define PROSAVAGE_I2C_SDA_IN 0x08
39
40#define SAVAGE4_I2C_ENAB 0x00000020
41#define SAVAGE4_I2C_SCL_OUT 0x00000001
42#define SAVAGE4_I2C_SDA_OUT 0x00000002
43#define SAVAGE4_I2C_SCL_IN 0x00000008
44#define SAVAGE4_I2C_SDA_IN 0x00000010
45
46#define SET_CR_IX(base, val) writeb((val), base + 0x8000 + VGA_CR_IX)
47#define SET_CR_DATA(base, val) writeb((val), base + 0x8000 + VGA_CR_DATA)
48#define GET_CR_DATA(base) readb(base + 0x8000 + VGA_CR_DATA)
49
50static void savage4_gpio_setscl(void *data, int val)
51{
52 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
53 unsigned int r;
54
55 r = readl(chan->ioaddr + chan->reg);
56 if(val)
57 r |= SAVAGE4_I2C_SCL_OUT;
58 else
59 r &= ~SAVAGE4_I2C_SCL_OUT;
60 writel(r, chan->ioaddr + chan->reg);
61 readl(chan->ioaddr + chan->reg); /* flush posted write */
62}
63
64static void savage4_gpio_setsda(void *data, int val)
65{
66 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
67
68 unsigned int r;
69 r = readl(chan->ioaddr + chan->reg);
70 if(val)
71 r |= SAVAGE4_I2C_SDA_OUT;
72 else
73 r &= ~SAVAGE4_I2C_SDA_OUT;
74 writel(r, chan->ioaddr + chan->reg);
75 readl(chan->ioaddr + chan->reg); /* flush posted write */
76}
77
78static int savage4_gpio_getscl(void *data)
79{
80 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
81
82 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SCL_IN));
83}
84
85static int savage4_gpio_getsda(void *data)
86{
87 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
88
89 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SDA_IN));
90}
91
92static void prosavage_gpio_setscl(void* data, int val)
93{
94 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
95 u32 r;
96
97 SET_CR_IX(chan->ioaddr, chan->reg);
98 r = GET_CR_DATA(chan->ioaddr);
99 r |= PROSAVAGE_I2C_ENAB;
100 if (val) {
101 r |= PROSAVAGE_I2C_SCL_OUT;
102 } else {
103 r &= ~PROSAVAGE_I2C_SCL_OUT;
104 }
105 SET_CR_DATA(chan->ioaddr, r);
106}
107
108static void prosavage_gpio_setsda(void* data, int val)
109{
110 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
111 unsigned int r;
112
113 SET_CR_IX(chan->ioaddr, chan->reg);
114 r = GET_CR_DATA(chan->ioaddr);
115 r |= PROSAVAGE_I2C_ENAB;
116 if (val) {
117 r |= PROSAVAGE_I2C_SDA_OUT;
118 } else {
119 r &= ~PROSAVAGE_I2C_SDA_OUT;
120 }
121 SET_CR_DATA(chan->ioaddr, r);
122}
123
124static int prosavage_gpio_getscl(void* data)
125{
126 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
127
128 SET_CR_IX(chan->ioaddr, chan->reg);
129 return (0 != (GET_CR_DATA(chan->ioaddr) & PROSAVAGE_I2C_SCL_IN));
130}
131
132static int prosavage_gpio_getsda(void* data)
133{
134 struct savagefb_i2c_chan *chan = (struct savagefb_i2c_chan *)data;
135
136 SET_CR_IX(chan->ioaddr, chan->reg);
137 return (0 != (GET_CR_DATA(chan->ioaddr) & PROSAVAGE_I2C_SDA_IN));
138}
139
140#define I2C_ALGO_SAVAGE 0x0f0000
141static int savage_setup_i2c_bus(struct savagefb_i2c_chan *chan,
142 const char *name)
143{
144 int (*add_bus)(struct i2c_adapter *) = symbol_get(i2c_bit_add_bus);
145 int rc = 0;
146
147 if (add_bus && chan->par) {
148 strcpy(chan->adapter.name, name);
149 chan->adapter.owner = THIS_MODULE;
150 chan->adapter.id = I2C_ALGO_SAVAGE;
151 chan->adapter.algo_data = &chan->algo;
152 chan->adapter.dev.parent = &chan->par->pcidev->dev;
153 chan->algo.udelay = 40;
154 chan->algo.mdelay = 5;
155 chan->algo.timeout = 20;
156 chan->algo.data = chan;
157
158 i2c_set_adapdata(&chan->adapter, chan);
159
160 /* Raise SCL and SDA */
161 chan->algo.setsda(chan, 1);
162 chan->algo.setscl(chan, 1);
163 udelay(20);
164
165 rc = add_bus(&chan->adapter);
166
167 if (rc == 0)
168 dev_dbg(&chan->par->pcidev->dev,
169 "I2C bus %s registered.\n", name);
170 else
171 dev_warn(&chan->par->pcidev->dev,
172 "Failed to register I2C bus %s.\n", name);
173
174 symbol_put(i2c_bit_add_bus);
175 } else
176 chan->par = NULL;
177
178 return rc;
179}
180
181void savagefb_create_i2c_busses(struct fb_info *info)
182{
183 struct savagefb_par *par = (struct savagefb_par *)info->par;
184 par->chan.par = par;
185
186 switch(info->fix.accel) {
187 case FB_ACCEL_PROSAVAGE_DDRK:
188 case FB_ACCEL_PROSAVAGE_PM:
189 par->chan.reg = CR_SERIAL2;
190 par->chan.ioaddr = par->mmio.vbase;
191 par->chan.algo.setsda = prosavage_gpio_setsda;
192 par->chan.algo.setscl = prosavage_gpio_setscl;
193 par->chan.algo.getsda = prosavage_gpio_getsda;
194 par->chan.algo.getscl = prosavage_gpio_getscl;
195 break;
196 case FB_ACCEL_SAVAGE4:
197 par->chan.reg = 0xff20;
198 par->chan.ioaddr = par->mmio.vbase;
199 par->chan.algo.setsda = savage4_gpio_setsda;
200 par->chan.algo.setscl = savage4_gpio_setscl;
201 par->chan.algo.getsda = savage4_gpio_getsda;
202 par->chan.algo.getscl = savage4_gpio_getscl;
203 break;
204 default:
205 par->chan.par = NULL;
206 }
207
208 savage_setup_i2c_bus(&par->chan, "SAVAGE DDC2");
209}
210
211void savagefb_delete_i2c_busses(struct fb_info *info)
212{
213 struct savagefb_par *par = (struct savagefb_par *)info->par;
214 int (*del_bus)(struct i2c_adapter *) =
215 symbol_get(i2c_bit_del_bus);
216
217 if (del_bus && par->chan.par) {
218 del_bus(&par->chan.adapter);
219 symbol_put(i2c_bit_del_bus);
220 }
221
222 par->chan.par = NULL;
223}
224
225static u8 *savage_do_probe_i2c_edid(struct savagefb_i2c_chan *chan)
226{
227 u8 start = 0x0;
228 int (*transfer)(struct i2c_adapter *, struct i2c_msg *, int) =
229 symbol_get(i2c_transfer);
230 struct i2c_msg msgs[] = {
231 {
232 .addr = SAVAGE_DDC,
233 .len = 1,
234 .buf = &start,
235 }, {
236 .addr = SAVAGE_DDC,
237 .flags = I2C_M_RD,
238 .len = EDID_LENGTH,
239 },
240 };
241 u8 *buf = NULL;
242
243 if (transfer && chan->par) {
244 buf = kmalloc(EDID_LENGTH, GFP_KERNEL);
245
246 if (buf) {
247 msgs[1].buf = buf;
248
249 if (transfer(&chan->adapter, msgs, 2) != 2) {
250 dev_dbg(&chan->par->pcidev->dev,
251 "Unable to read EDID block.\n");
252 kfree(buf);
253 buf = NULL;
254 }
255 }
256
257 symbol_put(i2c_transfer);
258 }
259
260 return buf;
261}
262
263int savagefb_probe_i2c_connector(struct savagefb_par *par, u8 **out_edid)
264{
265 u8 *edid = NULL;
266 int i;
267
268 for (i = 0; i < 3; i++) {
269 /* Do the real work */
270 edid = savage_do_probe_i2c_edid(&par->chan);
271 if (edid)
272 break;
273 }
274 if (out_edid)
275 *out_edid = edid;
276 if (!edid)
277 return 1;
278
279 return 0;
280}
281
282MODULE_LICENSE("GPL");
diff --git a/drivers/video/savage/savagefb.h b/drivers/video/savage/savagefb.h
new file mode 100644
index 000000000000..8594b1e42d71
--- /dev/null
+++ b/drivers/video/savage/savagefb.h
@@ -0,0 +1,354 @@
1/*
2 * linux/drivers/video/savagefb.h -- S3 Savage Framebuffer Driver
3 *
4 * Copyright (c) 2001 Denis Oliver Kropp <dok@convergence.de>
5 *
6 * This file is subject to the terms and conditions of the GNU General
7 * Public License. See the file COPYING in the main directory of this
8 * archive for more details.
9 */
10
11
12#ifndef __SAVAGEFB_H__
13#define __SAVAGEFB_H__
14
15#include <linux/i2c.h>
16#include <linux/i2c-id.h>
17#include <linux/i2c-algo-bit.h>
18#include "../edid.h"
19
20#ifdef SAVAGEFB_DEBUG
21# define DBG(x) printk (KERN_DEBUG "savagefb: %s\n", (x));
22#else
23# define DBG(x)
24# define SavagePrintRegs(...)
25#endif
26
27
28#define PCI_CHIP_SAVAGE4 0x8a22
29#define PCI_CHIP_SAVAGE3D 0x8a20
30#define PCI_CHIP_SAVAGE3D_MV 0x8a21
31#define PCI_CHIP_SAVAGE2000 0x9102
32#define PCI_CHIP_SAVAGE_MX_MV 0x8c10
33#define PCI_CHIP_SAVAGE_MX 0x8c11
34#define PCI_CHIP_SAVAGE_IX_MV 0x8c12
35#define PCI_CHIP_SAVAGE_IX 0x8c13
36#define PCI_CHIP_PROSAVAGE_PM 0x8a25
37#define PCI_CHIP_PROSAVAGE_KM 0x8a26
38 /* Twister is a code name; hope I get the real name soon. */
39#define PCI_CHIP_S3TWISTER_P 0x8d01
40#define PCI_CHIP_S3TWISTER_K 0x8d02
41#define PCI_CHIP_PROSAVAGE_DDR 0x8d03
42#define PCI_CHIP_PROSAVAGE_DDRK 0x8d04
43#define PCI_CHIP_SUPSAV_MX128 0x8c22
44#define PCI_CHIP_SUPSAV_MX64 0x8c24
45#define PCI_CHIP_SUPSAV_MX64C 0x8c26
46#define PCI_CHIP_SUPSAV_IX128SDR 0x8c2a
47#define PCI_CHIP_SUPSAV_IX128DDR 0x8c2b
48#define PCI_CHIP_SUPSAV_IX64SDR 0x8c2c
49#define PCI_CHIP_SUPSAV_IX64DDR 0x8c2d
50#define PCI_CHIP_SUPSAV_IXCSDR 0x8c2e
51#define PCI_CHIP_SUPSAV_IXCDDR 0x8c2f
52
53
54
55#define S3_SAVAGE3D_SERIES(chip) ((chip>=S3_SAVAGE3D) && (chip<=S3_SAVAGE_MX))
56
57#define S3_SAVAGE4_SERIES(chip) ((chip==S3_SAVAGE4) || (chip==S3_PROSAVAGE))
58
59#define S3_SAVAGE_MOBILE_SERIES(chip) ((chip==S3_SAVAGE_MX) || (chip==S3_SUPERSAVAGE))
60
61#define S3_SAVAGE_SERIES(chip) ((chip>=S3_SAVAGE3D) && (chip<=S3_SAVAGE2000))
62
63
64/* Chip tags. These are used to group the adapters into
65 * related families.
66 */
67
68typedef enum {
69 S3_UNKNOWN = 0,
70 S3_SAVAGE3D,
71 S3_SAVAGE_MX,
72 S3_SAVAGE4,
73 S3_PROSAVAGE,
74 S3_SUPERSAVAGE,
75 S3_SAVAGE2000,
76 S3_LAST
77} savage_chipset;
78
79#define BIOS_BSIZE 1024
80#define BIOS_BASE 0xc0000
81
82#define SAVAGE_NEWMMIO_REGBASE_S3 0x1000000 /* 16MB */
83#define SAVAGE_NEWMMIO_REGBASE_S4 0x0000000
84#define SAVAGE_NEWMMIO_REGSIZE 0x0080000 /* 512kb */
85#define SAVAGE_NEWMMIO_VGABASE 0x8000
86
87#define BASE_FREQ 14318
88#define HALF_BASE_FREQ 7159
89
90#define FIFO_CONTROL_REG 0x8200
91#define MIU_CONTROL_REG 0x8204
92#define STREAMS_TIMEOUT_REG 0x8208
93#define MISC_TIMEOUT_REG 0x820c
94
95#define MONO_PAT_0 0xa4e8
96#define MONO_PAT_1 0xa4ec
97
98#define MAXFIFO 0x7f00
99
100#define BCI_CMD_NOP 0x40000000
101#define BCI_CMD_SETREG 0x96000000
102#define BCI_CMD_RECT 0x48000000
103#define BCI_CMD_RECT_XP 0x01000000
104#define BCI_CMD_RECT_YP 0x02000000
105#define BCI_CMD_SEND_COLOR 0x00008000
106#define BCI_CMD_DEST_GBD 0x00000000
107#define BCI_CMD_SRC_GBD 0x00000020
108#define BCI_CMD_SRC_SOLID 0x00000000
109#define BCI_CMD_SRC_MONO 0x00000060
110#define BCI_CMD_CLIP_NEW 0x00006000
111#define BCI_CMD_CLIP_LR 0x00004000
112
113#define BCI_CLIP_LR(l, r) ((((r) << 16) | (l)) & 0x0FFF0FFF)
114#define BCI_CLIP_TL(t, l) ((((t) << 16) | (l)) & 0x0FFF0FFF)
115#define BCI_CLIP_BR(b, r) ((((b) << 16) | (r)) & 0x0FFF0FFF)
116#define BCI_W_H(w, h) (((h) << 16) | ((w) & 0xFFF))
117#define BCI_X_Y(x, y) (((y) << 16) | ((x) & 0xFFF))
118
119#define BCI_GBD1 0xE0
120#define BCI_GBD2 0xE1
121
122#define BCI_BUFFER_OFFSET 0x10000
123#define BCI_SIZE 0x4000
124
125#define BCI_SEND(dw) writel(dw, par->bci_base + par->bci_ptr++)
126
127#define BCI_CMD_GET_ROP(cmd) (((cmd) >> 16) & 0xFF)
128#define BCI_CMD_SET_ROP(cmd, rop) ((cmd) |= ((rop & 0xFF) << 16))
129#define BCI_CMD_SEND_COLOR 0x00008000
130
131struct xtimings {
132 unsigned int Clock;
133 unsigned int HDisplay;
134 unsigned int HSyncStart;
135 unsigned int HSyncEnd;
136 unsigned int HTotal;
137 unsigned int HAdjusted;
138 unsigned int VDisplay;
139 unsigned int VSyncStart;
140 unsigned int VSyncEnd;
141 unsigned int VTotal;
142 unsigned int sync;
143 int dblscan;
144 int interlaced;
145};
146
147
148/* --------------------------------------------------------------------- */
149
150#define NR_PALETTE 256
151
152
153struct savagefb_par;
154
155struct savagefb_i2c_chan {
156 struct savagefb_par *par;
157 struct i2c_adapter adapter;
158 struct i2c_algo_bit_data algo;
159 volatile u8 __iomem *ioaddr;
160 u32 reg;
161};
162
163struct savagefb_par {
164 struct pci_dev *pcidev;
165 savage_chipset chip;
166 struct savagefb_i2c_chan chan;
167 unsigned char *edid;
168 u32 pseudo_palette[16];
169 int dacSpeedBpp;
170 int maxClock;
171 int minClock;
172 int numClocks;
173 int clock[4];
174 struct {
175 u8 __iomem *vbase;
176 u32 pbase;
177 u32 len;
178#ifdef CONFIG_MTRR
179 int mtrr;
180#endif
181 } video;
182
183 struct {
184 volatile u8 __iomem *vbase;
185 u32 pbase;
186 u32 len;
187 } mmio;
188
189 volatile u32 __iomem *bci_base;
190 unsigned int bci_ptr;
191
192 u32 cob_offset;
193 u32 cob_size;
194 int cob_index;
195
196 void (*SavageWaitIdle) (struct savagefb_par *par);
197 void (*SavageWaitFifo) (struct savagefb_par *par, int space);
198
199 int MCLK, REFCLK, LCDclk;
200 int HorizScaleFactor;
201
202 /* Panels size */
203 int SavagePanelWidth;
204 int SavagePanelHeight;
205
206 struct {
207 u16 red, green, blue, transp;
208 } palette[NR_PALETTE];
209
210 int depth;
211 int vwidth;
212
213 unsigned char MiscOutReg; /* Misc */
214 unsigned char CRTC[25]; /* Crtc Controller */
215 unsigned char Sequencer[5]; /* Video Sequencer */
216 unsigned char Graphics[9]; /* Video Graphics */
217 unsigned char Attribute[21]; /* Video Atribute */
218
219 unsigned int mode, refresh;
220 unsigned char SR08, SR0E, SR0F;
221 unsigned char SR10, SR11, SR12, SR13, SR15, SR18, SR29, SR30;
222 unsigned char SR54[8];
223 unsigned char Clock;
224 unsigned char CR31, CR32, CR33, CR34, CR36, CR3A, CR3B, CR3C;
225 unsigned char CR40, CR41, CR42, CR43, CR45;
226 unsigned char CR50, CR51, CR53, CR55, CR58, CR5B, CR5D, CR5E;
227 unsigned char CR60, CR63, CR65, CR66, CR67, CR68, CR69, CR6D, CR6F;
228 unsigned char CR86, CR88;
229 unsigned char CR90, CR91, CRB0;
230 unsigned int STREAMS[22]; /* yuck, streams regs */
231 unsigned int MMPR0, MMPR1, MMPR2, MMPR3;
232};
233
234#define BCI_BD_BW_DISABLE 0x10000000
235#define BCI_BD_SET_BPP(bd, bpp) ((bd) |= (((bpp) & 0xFF) << 16))
236#define BCI_BD_SET_STRIDE(bd, st) ((bd) |= ((st) & 0xFFFF))
237
238
239/* IO functions */
240
241#define vga_in8(addr) (inb (addr))
242#define vga_in16(addr) (inw (addr))
243#define vga_in32(addr) (inl (addr))
244
245#define vga_out8(addr,val) (outb ((val), (addr)))
246#define vga_out16(addr,val) (outw ((val), (addr)))
247#define vga_out32(addr,val) (outl ((val), (addr)))
248
249#define savage_in16(addr) readw(par->mmio.vbase + (addr))
250#define savage_in32(addr) readl(par->mmio.vbase + (addr))
251
252#define savage_out16(addr,val) writew((val), par->mmio.vbase + (addr))
253#define savage_out32(addr,val) writel((val), par->mmio.vbase + (addr))
254
255static inline u8 VGArCR (u8 index)
256{
257 outb (index, 0x3d4);
258 return inb (0x3d5);
259}
260
261static inline u8 VGArGR (u8 index)
262{
263 outb (index, 0x3ce);
264 return inb (0x3cf);
265}
266
267static inline u8 VGArSEQ (u8 index)
268{
269 outb (index, 0x3c4);
270 return inb (0x3c5);
271}
272
273#define VGAwCR(index, val) \
274do { \
275 vga_out8 (0x3d4, index); \
276 vga_out8 (0x3d5, val); \
277} while (0)
278
279#define VGAwGR(index, val) \
280do { \
281 vga_out8 (0x3ce, index); \
282 vga_out8 (0x3cf, val); \
283} while (0)
284
285#define VGAwSEQ(index, val) \
286do { \
287 vga_out8 (0x3c4, index); \
288 vga_out8 (0x3c5, val); \
289} while (0)
290
291#define VGAenablePalette() \
292do { \
293 u8 tmp; \
294 \
295 tmp = vga_in8 (0x3da); \
296 vga_out8 (0x3c0, 0x00); \
297 paletteEnabled = 1; \
298} while (0)
299
300#define VGAdisablePalette() \
301do { \
302 u8 tmp; \
303 \
304 tmp = vga_in8 (0x3da); \
305 vga_out8 (0x3c0, 0x20); \
306 paletteEnabled = 0; \
307} while (0)
308
309#define VGAwATTR(index, value) \
310do { \
311 u8 tmp; \
312 \
313 if (paletteEnabled) \
314 index &= ~0x20; \
315 else \
316 index |= 0x20; \
317 \
318 tmp = vga_in8 (0x3da); \
319 vga_out8 (0x3c0, index); \
320 vga_out8 (0x3c0, value); \
321} while (0)
322
323#define VGAwMISC(value) \
324do { \
325 vga_out8 (0x3c2, value); \
326} while (0)
327
328#ifndef CONFIG_FB_SAVAGE_ACCEL
329#define savagefb_set_clip(x)
330#endif
331
332#define VerticalRetraceWait() \
333{ \
334 vga_out8 (0x3d4, 0x17); \
335 if (vga_in8 (0x3d5) & 0x80) { \
336 while ((vga_in8(0x3da) & 0x08) == 0x08) ; \
337 while ((vga_in8(0x3da) & 0x08) == 0x00) ; \
338 } \
339}
340
341extern int savagefb_probe_i2c_connector(struct savagefb_par *par,
342 u8 **out_edid);
343extern void savagefb_create_i2c_busses(struct fb_info *info);
344extern void savagefb_delete_i2c_busses(struct fb_info *info);
345extern int savagefb_sync(struct fb_info *info);
346extern void savagefb_copyarea(struct fb_info *info,
347 const struct fb_copyarea *region);
348extern void savagefb_fillrect(struct fb_info *info,
349 const struct fb_fillrect *rect);
350extern void savagefb_imageblit(struct fb_info *info,
351 const struct fb_image *image);
352
353
354#endif /* __SAVAGEFB_H__ */
diff --git a/drivers/video/savage/savagefb_accel.c b/drivers/video/savage/savagefb_accel.c
new file mode 100644
index 000000000000..bac8ea3a0108
--- /dev/null
+++ b/drivers/video/savage/savagefb_accel.c
@@ -0,0 +1,136 @@
1/*-*- linux-c -*-
2 * linux/drivers/video/savage/savage_accel.c -- Hardware Acceleration
3 *
4 * Copyright (C) 2004 Antonino Daplas<adaplas@pol.net>
5 * All Rights Reserved
6 *
7 * This file is subject to the terms and conditions of the GNU General Public
8 * License. See the file COPYING in the main directory of this archive for
9 * more details.
10 */
11#include <linux/kernel.h>
12#include <linux/string.h>
13#include <linux/fb.h>
14
15#include "savagefb.h"
16
17static u32 savagefb_rop[] = {
18 0xCC, /* ROP_COPY */
19 0x5A /* ROP_XOR */
20};
21
22int savagefb_sync(struct fb_info *info)
23{
24 struct savagefb_par *par = (struct savagefb_par *)info->par;
25
26 par->SavageWaitIdle(par);
27 return 0;
28}
29
30void savagefb_copyarea(struct fb_info *info, const struct fb_copyarea *region)
31{
32 struct savagefb_par *par = (struct savagefb_par *)info->par;
33 int sx = region->sx, dx = region->dx;
34 int sy = region->sy, dy = region->dy;
35 int cmd;
36
37 if (!region->width || !region->height)
38 return;
39 par->bci_ptr = 0;
40 cmd = BCI_CMD_RECT | BCI_CMD_DEST_GBD | BCI_CMD_SRC_GBD;
41 BCI_CMD_SET_ROP(cmd, savagefb_rop[0]);
42
43 if (dx <= sx) {
44 cmd |= BCI_CMD_RECT_XP;
45 } else {
46 sx += region->width - 1;
47 dx += region->width - 1;
48 }
49
50 if (dy <= sy) {
51 cmd |= BCI_CMD_RECT_YP;
52 } else {
53 sy += region->height - 1;
54 dy += region->height - 1;
55 }
56
57 par->SavageWaitFifo(par,4);
58 BCI_SEND(cmd);
59 BCI_SEND(BCI_X_Y(sx, sy));
60 BCI_SEND(BCI_X_Y(dx, dy));
61 BCI_SEND(BCI_W_H(region->width, region->height));
62}
63
64void savagefb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
65{
66 struct savagefb_par *par = (struct savagefb_par *)info->par;
67 int cmd, color;
68
69 if (!rect->width || !rect->height)
70 return;
71
72 if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR)
73 color = rect->color;
74 else
75 color = ((u32 *)info->pseudo_palette)[rect->color];
76
77 cmd = BCI_CMD_RECT | BCI_CMD_RECT_XP | BCI_CMD_RECT_YP |
78 BCI_CMD_DEST_GBD | BCI_CMD_SRC_SOLID |
79 BCI_CMD_SEND_COLOR;
80
81 par->bci_ptr = 0;
82 BCI_CMD_SET_ROP(cmd, savagefb_rop[rect->rop]);
83
84 par->SavageWaitFifo(par,4);
85 BCI_SEND(cmd);
86 BCI_SEND(color);
87 BCI_SEND( BCI_X_Y(rect->dx, rect->dy) );
88 BCI_SEND( BCI_W_H(rect->width, rect->height) );
89}
90
91void savagefb_imageblit(struct fb_info *info, const struct fb_image *image)
92{
93 struct savagefb_par *par = (struct savagefb_par *)info->par;
94 int fg, bg, size, i, width;
95 int cmd;
96 u32 *src = (u32 *) image->data;
97
98 if (!image->width || !image->height)
99 return;
100
101 if (image->depth != 1) {
102 cfb_imageblit(info, image);
103 return;
104 }
105
106 if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR) {
107 fg = image->fg_color;
108 bg = image->bg_color;
109 } else {
110 fg = ((u32 *)info->pseudo_palette)[image->fg_color];
111 bg = ((u32 *)info->pseudo_palette)[image->bg_color];
112 }
113
114 cmd = BCI_CMD_RECT | BCI_CMD_RECT_XP | BCI_CMD_RECT_YP |
115 BCI_CMD_CLIP_LR | BCI_CMD_DEST_GBD | BCI_CMD_SRC_MONO |
116 BCI_CMD_SEND_COLOR;
117
118 par->bci_ptr = 0;
119 BCI_CMD_SET_ROP(cmd, savagefb_rop[0]);
120
121 width = (image->width + 31) & ~31;
122 size = (width * image->height)/8;
123 size >>= 2;
124
125 par->SavageWaitFifo(par, size + 5);
126 BCI_SEND(cmd);
127 BCI_SEND(BCI_CLIP_LR(image->dx, image->dx + image->width - 1));
128 BCI_SEND(fg);
129 BCI_SEND(bg);
130 BCI_SEND(BCI_X_Y(image->dx, image->dy));
131 BCI_SEND(BCI_W_H(width, image->height));
132 for (i = 0; i < size; i++)
133 BCI_SEND(src[i]);
134}
135
136MODULE_LICENSE("GPL");
diff --git a/drivers/video/savage/savagefb_driver.c b/drivers/video/savage/savagefb_driver.c
new file mode 100644
index 000000000000..e1c9c946be2d
--- /dev/null
+++ b/drivers/video/savage/savagefb_driver.c
@@ -0,0 +1,2279 @@
1/*
2 * linux/drivers/video/savagefb.c -- S3 Savage Framebuffer Driver
3 *
4 * Copyright (c) 2001-2002 Denis Oliver Kropp <dok@directfb.org>
5 * Sven Neumann <neo@directfb.org>
6 *
7 *
8 * Card specific code is based on XFree86's savage driver.
9 * Framebuffer framework code is based on code of cyber2000fb and tdfxfb.
10 *
11 * This file is subject to the terms and conditions of the GNU General
12 * Public License. See the file COPYING in the main directory of this
13 * archive for more details.
14 *
15 * 0.4.0 (neo)
16 * - hardware accelerated clear and move
17 *
18 * 0.3.2 (dok)
19 * - wait for vertical retrace before writing to cr67
20 * at the beginning of savagefb_set_par
21 * - use synchronization registers cr23 and cr26
22 *
23 * 0.3.1 (dok)
24 * - reset 3D engine
25 * - don't return alpha bits for 32bit format
26 *
27 * 0.3.0 (dok)
28 * - added WaitIdle functions for all Savage types
29 * - do WaitIdle before mode switching
30 * - code cleanup
31 *
32 * 0.2.0 (dok)
33 * - first working version
34 *
35 *
36 * TODO
37 * - clock validations in decode_var
38 *
39 * BUGS
40 * - white margin on bootup
41 *
42 */
43
44#include <linux/config.h>
45#include <linux/module.h>
46#include <linux/kernel.h>
47#include <linux/errno.h>
48#include <linux/string.h>
49#include <linux/mm.h>
50#include <linux/tty.h>
51#include <linux/slab.h>
52#include <linux/delay.h>
53#include <linux/fb.h>
54#include <linux/pci.h>
55#include <linux/init.h>
56#include <linux/console.h>
57
58#include <asm/io.h>
59#include <asm/irq.h>
60#include <asm/pgtable.h>
61#include <asm/system.h>
62#include <asm/uaccess.h>
63
64#ifdef CONFIG_MTRR
65#include <asm/mtrr.h>
66#endif
67
68#include "savagefb.h"
69
70
71#define SAVAGEFB_VERSION "0.4.0_2.6"
72
73/* --------------------------------------------------------------------- */
74
75
76static char *mode_option __initdata = NULL;
77static int paletteEnabled = 0;
78
79#ifdef MODULE
80
81MODULE_AUTHOR("(c) 2001-2002 Denis Oliver Kropp <dok@directfb.org>");
82MODULE_LICENSE("GPL");
83MODULE_DESCRIPTION("FBDev driver for S3 Savage PCI/AGP Chips");
84
85#endif
86
87
88/* --------------------------------------------------------------------- */
89
90static void vgaHWSeqReset (struct savagefb_par *par, int start)
91{
92 if (start)
93 VGAwSEQ (0x00, 0x01); /* Synchronous Reset */
94 else
95 VGAwSEQ (0x00, 0x03); /* End Reset */
96}
97
98static void vgaHWProtect (struct savagefb_par *par, int on)
99{
100 unsigned char tmp;
101
102 if (on) {
103 /*
104 * Turn off screen and disable sequencer.
105 */
106 tmp = VGArSEQ (0x01);
107
108 vgaHWSeqReset (par, 1); /* start synchronous reset */
109 VGAwSEQ (0x01, tmp | 0x20); /* disable the display */
110
111 VGAenablePalette();
112 } else {
113 /*
114 * Reenable sequencer, then turn on screen.
115 */
116
117 tmp = VGArSEQ (0x01);
118
119 VGAwSEQ (0x01, tmp & ~0x20); /* reenable display */
120 vgaHWSeqReset (par, 0); /* clear synchronous reset */
121
122 VGAdisablePalette();
123 }
124}
125
126static void vgaHWRestore (struct savagefb_par *par)
127{
128 int i;
129
130 VGAwMISC (par->MiscOutReg);
131
132 for (i = 1; i < 5; i++)
133 VGAwSEQ (i, par->Sequencer[i]);
134
135 /* Ensure CRTC registers 0-7 are unlocked by clearing bit 7 or
136 CRTC[17] */
137 VGAwCR (17, par->CRTC[17] & ~0x80);
138
139 for (i = 0; i < 25; i++)
140 VGAwCR (i, par->CRTC[i]);
141
142 for (i = 0; i < 9; i++)
143 VGAwGR (i, par->Graphics[i]);
144
145 VGAenablePalette();
146
147 for (i = 0; i < 21; i++)
148 VGAwATTR (i, par->Attribute[i]);
149
150 VGAdisablePalette();
151}
152
153static void vgaHWInit (struct fb_var_screeninfo *var,
154 struct savagefb_par *par,
155 struct xtimings *timings)
156{
157 par->MiscOutReg = 0x23;
158
159 if (!(timings->sync & FB_SYNC_HOR_HIGH_ACT))
160 par->MiscOutReg |= 0x40;
161
162 if (!(timings->sync & FB_SYNC_VERT_HIGH_ACT))
163 par->MiscOutReg |= 0x80;
164
165 /*
166 * Time Sequencer
167 */
168 par->Sequencer[0x00] = 0x00;
169 par->Sequencer[0x01] = 0x01;
170 par->Sequencer[0x02] = 0x0F;
171 par->Sequencer[0x03] = 0x00; /* Font select */
172 par->Sequencer[0x04] = 0x0E; /* Misc */
173
174 /*
175 * CRTC Controller
176 */
177 par->CRTC[0x00] = (timings->HTotal >> 3) - 5;
178 par->CRTC[0x01] = (timings->HDisplay >> 3) - 1;
179 par->CRTC[0x02] = (timings->HSyncStart >> 3) - 1;
180 par->CRTC[0x03] = (((timings->HSyncEnd >> 3) - 1) & 0x1f) | 0x80;
181 par->CRTC[0x04] = (timings->HSyncStart >> 3);
182 par->CRTC[0x05] = ((((timings->HSyncEnd >> 3) - 1) & 0x20) << 2) |
183 (((timings->HSyncEnd >> 3)) & 0x1f);
184 par->CRTC[0x06] = (timings->VTotal - 2) & 0xFF;
185 par->CRTC[0x07] = (((timings->VTotal - 2) & 0x100) >> 8) |
186 (((timings->VDisplay - 1) & 0x100) >> 7) |
187 ((timings->VSyncStart & 0x100) >> 6) |
188 (((timings->VSyncStart - 1) & 0x100) >> 5) |
189 0x10 |
190 (((timings->VTotal - 2) & 0x200) >> 4) |
191 (((timings->VDisplay - 1) & 0x200) >> 3) |
192 ((timings->VSyncStart & 0x200) >> 2);
193 par->CRTC[0x08] = 0x00;
194 par->CRTC[0x09] = (((timings->VSyncStart - 1) & 0x200) >> 4) | 0x40;
195
196 if (timings->dblscan)
197 par->CRTC[0x09] |= 0x80;
198
199 par->CRTC[0x0a] = 0x00;
200 par->CRTC[0x0b] = 0x00;
201 par->CRTC[0x0c] = 0x00;
202 par->CRTC[0x0d] = 0x00;
203 par->CRTC[0x0e] = 0x00;
204 par->CRTC[0x0f] = 0x00;
205 par->CRTC[0x10] = timings->VSyncStart & 0xff;
206 par->CRTC[0x11] = (timings->VSyncEnd & 0x0f) | 0x20;
207 par->CRTC[0x12] = (timings->VDisplay - 1) & 0xff;
208 par->CRTC[0x13] = var->xres_virtual >> 4;
209 par->CRTC[0x14] = 0x00;
210 par->CRTC[0x15] = (timings->VSyncStart - 1) & 0xff;
211 par->CRTC[0x16] = (timings->VSyncEnd - 1) & 0xff;
212 par->CRTC[0x17] = 0xc3;
213 par->CRTC[0x18] = 0xff;
214
215 /*
216 * are these unnecessary?
217 * vgaHWHBlankKGA(mode, regp, 0, KGA_FIX_OVERSCAN|KGA_ENABLE_ON_ZERO);
218 * vgaHWVBlankKGA(mode, regp, 0, KGA_FIX_OVERSCAN|KGA_ENABLE_ON_ZERO);
219 */
220
221 /*
222 * Graphics Display Controller
223 */
224 par->Graphics[0x00] = 0x00;
225 par->Graphics[0x01] = 0x00;
226 par->Graphics[0x02] = 0x00;
227 par->Graphics[0x03] = 0x00;
228 par->Graphics[0x04] = 0x00;
229 par->Graphics[0x05] = 0x40;
230 par->Graphics[0x06] = 0x05; /* only map 64k VGA memory !!!! */
231 par->Graphics[0x07] = 0x0F;
232 par->Graphics[0x08] = 0xFF;
233
234
235 par->Attribute[0x00] = 0x00; /* standard colormap translation */
236 par->Attribute[0x01] = 0x01;
237 par->Attribute[0x02] = 0x02;
238 par->Attribute[0x03] = 0x03;
239 par->Attribute[0x04] = 0x04;
240 par->Attribute[0x05] = 0x05;
241 par->Attribute[0x06] = 0x06;
242 par->Attribute[0x07] = 0x07;
243 par->Attribute[0x08] = 0x08;
244 par->Attribute[0x09] = 0x09;
245 par->Attribute[0x0a] = 0x0A;
246 par->Attribute[0x0b] = 0x0B;
247 par->Attribute[0x0c] = 0x0C;
248 par->Attribute[0x0d] = 0x0D;
249 par->Attribute[0x0e] = 0x0E;
250 par->Attribute[0x0f] = 0x0F;
251 par->Attribute[0x10] = 0x41;
252 par->Attribute[0x11] = 0xFF;
253 par->Attribute[0x12] = 0x0F;
254 par->Attribute[0x13] = 0x00;
255 par->Attribute[0x14] = 0x00;
256}
257
258/* -------------------- Hardware specific routines ------------------------- */
259
260/*
261 * Hardware Acceleration for SavageFB
262 */
263
264/* Wait for fifo space */
265static void
266savage3D_waitfifo(struct savagefb_par *par, int space)
267{
268 int slots = MAXFIFO - space;
269
270 while ((savage_in32(0x48C00) & 0x0000ffff) > slots);
271}
272
273static void
274savage4_waitfifo(struct savagefb_par *par, int space)
275{
276 int slots = MAXFIFO - space;
277
278 while ((savage_in32(0x48C60) & 0x001fffff) > slots);
279}
280
281static void
282savage2000_waitfifo(struct savagefb_par *par, int space)
283{
284 int slots = MAXFIFO - space;
285
286 while ((savage_in32(0x48C60) & 0x0000ffff) > slots);
287}
288
289/* Wait for idle accelerator */
290static void
291savage3D_waitidle(struct savagefb_par *par)
292{
293 while ((savage_in32(0x48C00) & 0x0008ffff) != 0x80000);
294}
295
296static void
297savage4_waitidle(struct savagefb_par *par)
298{
299 while ((savage_in32(0x48C60) & 0x00a00000) != 0x00a00000);
300}
301
302static void
303savage2000_waitidle(struct savagefb_par *par)
304{
305 while ((savage_in32(0x48C60) & 0x009fffff));
306}
307
308
309static void
310SavageSetup2DEngine (struct savagefb_par *par)
311{
312 unsigned long GlobalBitmapDescriptor;
313
314 GlobalBitmapDescriptor = 1 | 8 | BCI_BD_BW_DISABLE;
315 BCI_BD_SET_BPP (GlobalBitmapDescriptor, par->depth);
316 BCI_BD_SET_STRIDE (GlobalBitmapDescriptor, par->vwidth);
317
318 switch(par->chip) {
319 case S3_SAVAGE3D:
320 case S3_SAVAGE_MX:
321 /* Disable BCI */
322 savage_out32(0x48C18, savage_in32(0x48C18) & 0x3FF0);
323 /* Setup BCI command overflow buffer */
324 savage_out32(0x48C14, (par->cob_offset >> 11) | (par->cob_index << 29));
325 /* Program shadow status update. */
326 savage_out32(0x48C10, 0x78207220);
327 savage_out32(0x48C0C, 0);
328 /* Enable BCI and command overflow buffer */
329 savage_out32(0x48C18, savage_in32(0x48C18) | 0x0C);
330 break;
331 case S3_SAVAGE4:
332 case S3_PROSAVAGE:
333 case S3_SUPERSAVAGE:
334 /* Disable BCI */
335 savage_out32(0x48C18, savage_in32(0x48C18) & 0x3FF0);
336 /* Program shadow status update */
337 savage_out32(0x48C10, 0x00700040);
338 savage_out32(0x48C0C, 0);
339 /* Enable BCI without the COB */
340 savage_out32(0x48C18, savage_in32(0x48C18) | 0x08);
341 break;
342 case S3_SAVAGE2000:
343 /* Disable BCI */
344 savage_out32(0x48C18, 0);
345 /* Setup BCI command overflow buffer */
346 savage_out32(0x48C18, (par->cob_offset >> 7) | (par->cob_index));
347 /* Disable shadow status update */
348 savage_out32(0x48A30, 0);
349 /* Enable BCI and command overflow buffer */
350 savage_out32(0x48C18, savage_in32(0x48C18) | 0x00280000 );
351 break;
352 default:
353 break;
354 }
355 /* Turn on 16-bit register access. */
356 vga_out8(0x3d4, 0x31);
357 vga_out8(0x3d5, 0x0c);
358
359 /* Set stride to use GBD. */
360 vga_out8 (0x3d4, 0x50);
361 vga_out8 (0x3d5, vga_in8 (0x3d5 ) | 0xC1);
362
363 /* Enable 2D engine. */
364 vga_out8 (0x3d4, 0x40 );
365 vga_out8 (0x3d5, 0x01 );
366
367 savage_out32 (MONO_PAT_0, ~0);
368 savage_out32 (MONO_PAT_1, ~0);
369
370 /* Setup plane masks */
371 savage_out32 (0x8128, ~0 ); /* enable all write planes */
372 savage_out32 (0x812C, ~0 ); /* enable all read planes */
373 savage_out16 (0x8134, 0x27 );
374 savage_out16 (0x8136, 0x07 );
375
376 /* Now set the GBD */
377 par->bci_ptr = 0;
378 par->SavageWaitFifo (par, 4);
379
380 BCI_SEND( BCI_CMD_SETREG | (1 << 16) | BCI_GBD1 );
381 BCI_SEND( 0 );
382 BCI_SEND( BCI_CMD_SETREG | (1 << 16) | BCI_GBD2 );
383 BCI_SEND( GlobalBitmapDescriptor );
384}
385
386
387static void SavageCalcClock(long freq, int min_m, int min_n1, int max_n1,
388 int min_n2, int max_n2, long freq_min,
389 long freq_max, unsigned int *mdiv,
390 unsigned int *ndiv, unsigned int *r)
391{
392 long diff, best_diff;
393 unsigned int m;
394 unsigned char n1, n2, best_n1=16+2, best_n2=2, best_m=125+2;
395
396 if (freq < freq_min / (1 << max_n2)) {
397 printk (KERN_ERR "invalid frequency %ld Khz\n", freq);
398 freq = freq_min / (1 << max_n2);
399 }
400 if (freq > freq_max / (1 << min_n2)) {
401 printk (KERN_ERR "invalid frequency %ld Khz\n", freq);
402 freq = freq_max / (1 << min_n2);
403 }
404
405 /* work out suitable timings */
406 best_diff = freq;
407
408 for (n2=min_n2; n2<=max_n2; n2++) {
409 for (n1=min_n1+2; n1<=max_n1+2; n1++) {
410 m = (freq * n1 * (1 << n2) + HALF_BASE_FREQ) /
411 BASE_FREQ;
412 if (m < min_m+2 || m > 127+2)
413 continue;
414 if ((m * BASE_FREQ >= freq_min * n1) &&
415 (m * BASE_FREQ <= freq_max * n1)) {
416 diff = freq * (1 << n2) * n1 - BASE_FREQ * m;
417 if (diff < 0)
418 diff = -diff;
419 if (diff < best_diff) {
420 best_diff = diff;
421 best_m = m;
422 best_n1 = n1;
423 best_n2 = n2;
424 }
425 }
426 }
427 }
428
429 *ndiv = best_n1 - 2;
430 *r = best_n2;
431 *mdiv = best_m - 2;
432}
433
434static int common_calc_clock(long freq, int min_m, int min_n1, int max_n1,
435 int min_n2, int max_n2, long freq_min,
436 long freq_max, unsigned char *mdiv,
437 unsigned char *ndiv)
438{
439 long diff, best_diff;
440 unsigned int m;
441 unsigned char n1, n2;
442 unsigned char best_n1 = 16+2, best_n2 = 2, best_m = 125+2;
443
444 best_diff = freq;
445
446 for (n2 = min_n2; n2 <= max_n2; n2++) {
447 for (n1 = min_n1+2; n1 <= max_n1+2; n1++) {
448 m = (freq * n1 * (1 << n2) + HALF_BASE_FREQ) /
449 BASE_FREQ;
450 if (m < min_m + 2 || m > 127+2)
451 continue;
452 if((m * BASE_FREQ >= freq_min * n1) &&
453 (m * BASE_FREQ <= freq_max * n1)) {
454 diff = freq * (1 << n2) * n1 - BASE_FREQ * m;
455 if(diff < 0)
456 diff = -diff;
457 if(diff < best_diff) {
458 best_diff = diff;
459 best_m = m;
460 best_n1 = n1;
461 best_n2 = n2;
462 }
463 }
464 }
465 }
466
467 if(max_n1 == 63)
468 *ndiv = (best_n1 - 2) | (best_n2 << 6);
469 else
470 *ndiv = (best_n1 - 2) | (best_n2 << 5);
471
472 *mdiv = best_m - 2;
473
474 return 0;
475}
476
477#ifdef SAVAGEFB_DEBUG
478/* This function is used to debug, it prints out the contents of s3 regs */
479
480static void SavagePrintRegs(void)
481{
482 unsigned char i;
483 int vgaCRIndex = 0x3d4;
484 int vgaCRReg = 0x3d5;
485
486 printk(KERN_DEBUG "SR x0 x1 x2 x3 x4 x5 x6 x7 x8 x9 xA xB xC xD xE "
487 "xF" );
488
489 for( i = 0; i < 0x70; i++ ) {
490 if( !(i % 16) )
491 printk(KERN_DEBUG "\nSR%xx ", i >> 4 );
492 vga_out8( 0x3c4, i );
493 printk(KERN_DEBUG " %02x", vga_in8(0x3c5) );
494 }
495
496 printk(KERN_DEBUG "\n\nCR x0 x1 x2 x3 x4 x5 x6 x7 x8 x9 xA xB xC "
497 "xD xE xF" );
498
499 for( i = 0; i < 0xB7; i++ ) {
500 if( !(i % 16) )
501 printk(KERN_DEBUG "\nCR%xx ", i >> 4 );
502 vga_out8( vgaCRIndex, i );
503 printk(KERN_DEBUG " %02x", vga_in8(vgaCRReg) );
504 }
505
506 printk(KERN_DEBUG "\n\n");
507}
508#endif
509
510/* --------------------------------------------------------------------- */
511
512static void savage_get_default_par(struct savagefb_par *par)
513{
514 unsigned char cr3a, cr53, cr66;
515
516 vga_out16 (0x3d4, 0x4838);
517 vga_out16 (0x3d4, 0xa039);
518 vga_out16 (0x3c4, 0x0608);
519
520 vga_out8 (0x3d4, 0x66);
521 cr66 = vga_in8 (0x3d5);
522 vga_out8 (0x3d5, cr66 | 0x80);
523 vga_out8 (0x3d4, 0x3a);
524 cr3a = vga_in8 (0x3d5);
525 vga_out8 (0x3d5, cr3a | 0x80);
526 vga_out8 (0x3d4, 0x53);
527 cr53 = vga_in8 (0x3d5);
528 vga_out8 (0x3d5, cr53 & 0x7f);
529
530 vga_out8 (0x3d4, 0x66);
531 vga_out8 (0x3d5, cr66);
532 vga_out8 (0x3d4, 0x3a);
533 vga_out8 (0x3d5, cr3a);
534
535 vga_out8 (0x3d4, 0x66);
536 vga_out8 (0x3d5, cr66);
537 vga_out8 (0x3d4, 0x3a);
538 vga_out8 (0x3d5, cr3a);
539
540 /* unlock extended seq regs */
541 vga_out8 (0x3c4, 0x08);
542 par->SR08 = vga_in8 (0x3c5);
543 vga_out8 (0x3c5, 0x06);
544
545 /* now save all the extended regs we need */
546 vga_out8 (0x3d4, 0x31);
547 par->CR31 = vga_in8 (0x3d5);
548 vga_out8 (0x3d4, 0x32);
549 par->CR32 = vga_in8 (0x3d5);
550 vga_out8 (0x3d4, 0x34);
551 par->CR34 = vga_in8 (0x3d5);
552 vga_out8 (0x3d4, 0x36);
553 par->CR36 = vga_in8 (0x3d5);
554 vga_out8 (0x3d4, 0x3a);
555 par->CR3A = vga_in8 (0x3d5);
556 vga_out8 (0x3d4, 0x40);
557 par->CR40 = vga_in8 (0x3d5);
558 vga_out8 (0x3d4, 0x42);
559 par->CR42 = vga_in8 (0x3d5);
560 vga_out8 (0x3d4, 0x45);
561 par->CR45 = vga_in8 (0x3d5);
562 vga_out8 (0x3d4, 0x50);
563 par->CR50 = vga_in8 (0x3d5);
564 vga_out8 (0x3d4, 0x51);
565 par->CR51 = vga_in8 (0x3d5);
566 vga_out8 (0x3d4, 0x53);
567 par->CR53 = vga_in8 (0x3d5);
568 vga_out8 (0x3d4, 0x58);
569 par->CR58 = vga_in8 (0x3d5);
570 vga_out8 (0x3d4, 0x60);
571 par->CR60 = vga_in8 (0x3d5);
572 vga_out8 (0x3d4, 0x66);
573 par->CR66 = vga_in8 (0x3d5);
574 vga_out8 (0x3d4, 0x67);
575 par->CR67 = vga_in8 (0x3d5);
576 vga_out8 (0x3d4, 0x68);
577 par->CR68 = vga_in8 (0x3d5);
578 vga_out8 (0x3d4, 0x69);
579 par->CR69 = vga_in8 (0x3d5);
580 vga_out8 (0x3d4, 0x6f);
581 par->CR6F = vga_in8 (0x3d5);
582
583 vga_out8 (0x3d4, 0x33);
584 par->CR33 = vga_in8 (0x3d5);
585 vga_out8 (0x3d4, 0x86);
586 par->CR86 = vga_in8 (0x3d5);
587 vga_out8 (0x3d4, 0x88);
588 par->CR88 = vga_in8 (0x3d5);
589 vga_out8 (0x3d4, 0x90);
590 par->CR90 = vga_in8 (0x3d5);
591 vga_out8 (0x3d4, 0x91);
592 par->CR91 = vga_in8 (0x3d5);
593 vga_out8 (0x3d4, 0xb0);
594 par->CRB0 = vga_in8 (0x3d5) | 0x80;
595
596 /* extended mode timing regs */
597 vga_out8 (0x3d4, 0x3b);
598 par->CR3B = vga_in8 (0x3d5);
599 vga_out8 (0x3d4, 0x3c);
600 par->CR3C = vga_in8 (0x3d5);
601 vga_out8 (0x3d4, 0x43);
602 par->CR43 = vga_in8 (0x3d5);
603 vga_out8 (0x3d4, 0x5d);
604 par->CR5D = vga_in8 (0x3d5);
605 vga_out8 (0x3d4, 0x5e);
606 par->CR5E = vga_in8 (0x3d5);
607 vga_out8 (0x3d4, 0x65);
608 par->CR65 = vga_in8 (0x3d5);
609
610 /* save seq extended regs for DCLK PLL programming */
611 vga_out8 (0x3c4, 0x0e);
612 par->SR0E = vga_in8 (0x3c5);
613 vga_out8 (0x3c4, 0x0f);
614 par->SR0F = vga_in8 (0x3c5);
615 vga_out8 (0x3c4, 0x10);
616 par->SR10 = vga_in8 (0x3c5);
617 vga_out8 (0x3c4, 0x11);
618 par->SR11 = vga_in8 (0x3c5);
619 vga_out8 (0x3c4, 0x12);
620 par->SR12 = vga_in8 (0x3c5);
621 vga_out8 (0x3c4, 0x13);
622 par->SR13 = vga_in8 (0x3c5);
623 vga_out8 (0x3c4, 0x29);
624 par->SR29 = vga_in8 (0x3c5);
625
626 vga_out8 (0x3c4, 0x15);
627 par->SR15 = vga_in8 (0x3c5);
628 vga_out8 (0x3c4, 0x30);
629 par->SR30 = vga_in8 (0x3c5);
630 vga_out8 (0x3c4, 0x18);
631 par->SR18 = vga_in8 (0x3c5);
632
633 /* Save flat panel expansion regsters. */
634 if (par->chip == S3_SAVAGE_MX) {
635 int i;
636
637 for (i = 0; i < 8; i++) {
638 vga_out8 (0x3c4, 0x54+i);
639 par->SR54[i] = vga_in8 (0x3c5);
640 }
641 }
642
643 vga_out8 (0x3d4, 0x66);
644 cr66 = vga_in8 (0x3d5);
645 vga_out8 (0x3d5, cr66 | 0x80);
646 vga_out8 (0x3d4, 0x3a);
647 cr3a = vga_in8 (0x3d5);
648 vga_out8 (0x3d5, cr3a | 0x80);
649
650 /* now save MIU regs */
651 if (par->chip != S3_SAVAGE_MX) {
652 par->MMPR0 = savage_in32(FIFO_CONTROL_REG);
653 par->MMPR1 = savage_in32(MIU_CONTROL_REG);
654 par->MMPR2 = savage_in32(STREAMS_TIMEOUT_REG);
655 par->MMPR3 = savage_in32(MISC_TIMEOUT_REG);
656 }
657
658 vga_out8 (0x3d4, 0x3a);
659 vga_out8 (0x3d5, cr3a);
660 vga_out8 (0x3d4, 0x66);
661 vga_out8 (0x3d5, cr66);
662}
663
664static void savage_update_var(struct fb_var_screeninfo *var, struct fb_videomode *modedb)
665{
666 var->xres = var->xres_virtual = modedb->xres;
667 var->yres = modedb->yres;
668 if (var->yres_virtual < var->yres)
669 var->yres_virtual = var->yres;
670 var->xoffset = var->yoffset = 0;
671 var->pixclock = modedb->pixclock;
672 var->left_margin = modedb->left_margin;
673 var->right_margin = modedb->right_margin;
674 var->upper_margin = modedb->upper_margin;
675 var->lower_margin = modedb->lower_margin;
676 var->hsync_len = modedb->hsync_len;
677 var->vsync_len = modedb->vsync_len;
678 var->sync = modedb->sync;
679 var->vmode = modedb->vmode;
680}
681
682static int savagefb_check_var (struct fb_var_screeninfo *var,
683 struct fb_info *info)
684{
685 struct savagefb_par *par = (struct savagefb_par *)info->par;
686 int memlen, vramlen, mode_valid = 0;
687
688 DBG("savagefb_check_var");
689
690 var->transp.offset = 0;
691 var->transp.length = 0;
692 switch (var->bits_per_pixel) {
693 case 8:
694 var->red.offset = var->green.offset =
695 var->blue.offset = 0;
696 var->red.length = var->green.length =
697 var->blue.length = var->bits_per_pixel;
698 break;
699 case 16:
700 var->red.offset = 11;
701 var->red.length = 5;
702 var->green.offset = 5;
703 var->green.length = 6;
704 var->blue.offset = 0;
705 var->blue.length = 5;
706 break;
707 case 32:
708 var->transp.offset = 24;
709 var->transp.length = 8;
710 var->red.offset = 16;
711 var->red.length = 8;
712 var->green.offset = 8;
713 var->green.length = 8;
714 var->blue.offset = 0;
715 var->blue.length = 8;
716 break;
717
718 default:
719 return -EINVAL;
720 }
721
722 if (!info->monspecs.hfmax || !info->monspecs.vfmax ||
723 !info->monspecs.dclkmax || !fb_validate_mode(var, info))
724 mode_valid = 1;
725
726 /* calculate modeline if supported by monitor */
727 if (!mode_valid && info->monspecs.gtf) {
728 if (!fb_get_mode(FB_MAXTIMINGS, 0, var, info))
729 mode_valid = 1;
730 }
731
732 if (!mode_valid) {
733 struct fb_videomode *mode;
734
735 mode = fb_find_best_mode(var, &info->modelist);
736 if (mode) {
737 savage_update_var(var, mode);
738 mode_valid = 1;
739 }
740 }
741
742 if (!mode_valid && info->monspecs.modedb_len)
743 return -EINVAL;
744
745 /* Is the mode larger than the LCD panel? */
746 if (par->SavagePanelWidth &&
747 (var->xres > par->SavagePanelWidth ||
748 var->yres > par->SavagePanelHeight)) {
749 printk (KERN_INFO "Mode (%dx%d) larger than the LCD panel "
750 "(%dx%d)\n", var->xres, var->yres,
751 par->SavagePanelWidth,
752 par->SavagePanelHeight);
753 return -1;
754 }
755
756 if (var->yres_virtual < var->yres)
757 var->yres_virtual = var->yres;
758 if (var->xres_virtual < var->xres)
759 var->xres_virtual = var->xres;
760
761 vramlen = info->fix.smem_len;
762
763 memlen = var->xres_virtual * var->bits_per_pixel *
764 var->yres_virtual / 8;
765 if (memlen > vramlen) {
766 var->yres_virtual = vramlen * 8 /
767 (var->xres_virtual * var->bits_per_pixel);
768 memlen = var->xres_virtual * var->bits_per_pixel *
769 var->yres_virtual / 8;
770 }
771
772 /* we must round yres/xres down, we already rounded y/xres_virtual up
773 if it was possible. We should return -EINVAL, but I disagree */
774 if (var->yres_virtual < var->yres)
775 var->yres = var->yres_virtual;
776 if (var->xres_virtual < var->xres)
777 var->xres = var->xres_virtual;
778 if (var->xoffset + var->xres > var->xres_virtual)
779 var->xoffset = var->xres_virtual - var->xres;
780 if (var->yoffset + var->yres > var->yres_virtual)
781 var->yoffset = var->yres_virtual - var->yres;
782
783 return 0;
784}
785
786
787static int savagefb_decode_var (struct fb_var_screeninfo *var,
788 struct savagefb_par *par)
789{
790 struct xtimings timings;
791 int width, dclk, i, j; /*, refresh; */
792 unsigned int m, n, r;
793 unsigned char tmp = 0;
794 unsigned int pixclock = var->pixclock;
795
796 DBG("savagefb_decode_var");
797
798 memset (&timings, 0, sizeof(timings));
799
800 if (!pixclock) pixclock = 10000; /* 10ns = 100MHz */
801 timings.Clock = 1000000000 / pixclock;
802 if (timings.Clock < 1) timings.Clock = 1;
803 timings.dblscan = var->vmode & FB_VMODE_DOUBLE;
804 timings.interlaced = var->vmode & FB_VMODE_INTERLACED;
805 timings.HDisplay = var->xres;
806 timings.HSyncStart = timings.HDisplay + var->right_margin;
807 timings.HSyncEnd = timings.HSyncStart + var->hsync_len;
808 timings.HTotal = timings.HSyncEnd + var->left_margin;
809 timings.VDisplay = var->yres;
810 timings.VSyncStart = timings.VDisplay + var->lower_margin;
811 timings.VSyncEnd = timings.VSyncStart + var->vsync_len;
812 timings.VTotal = timings.VSyncEnd + var->upper_margin;
813 timings.sync = var->sync;
814
815
816 par->depth = var->bits_per_pixel;
817 par->vwidth = var->xres_virtual;
818
819 if (var->bits_per_pixel == 16 && par->chip == S3_SAVAGE3D) {
820 timings.HDisplay *= 2;
821 timings.HSyncStart *= 2;
822 timings.HSyncEnd *= 2;
823 timings.HTotal *= 2;
824 }
825
826 /*
827 * This will allocate the datastructure and initialize all of the
828 * generic VGA registers.
829 */
830 vgaHWInit (var, par, &timings);
831
832 /* We need to set CR67 whether or not we use the BIOS. */
833
834 dclk = timings.Clock;
835 par->CR67 = 0x00;
836
837 switch( var->bits_per_pixel ) {
838 case 8:
839 if( (par->chip == S3_SAVAGE2000) && (dclk >= 230000) )
840 par->CR67 = 0x10; /* 8bpp, 2 pixels/clock */
841 else
842 par->CR67 = 0x00; /* 8bpp, 1 pixel/clock */
843 break;
844 case 15:
845 if ( S3_SAVAGE_MOBILE_SERIES(par->chip) ||
846 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) )
847 par->CR67 = 0x30; /* 15bpp, 2 pixel/clock */
848 else
849 par->CR67 = 0x20; /* 15bpp, 1 pixels/clock */
850 break;
851 case 16:
852 if( S3_SAVAGE_MOBILE_SERIES(par->chip) ||
853 ((par->chip == S3_SAVAGE2000) && (dclk >= 230000)) )
854 par->CR67 = 0x50; /* 16bpp, 2 pixel/clock */
855 else
856 par->CR67 = 0x40; /* 16bpp, 1 pixels/clock */
857 break;
858 case 24:
859 par->CR67 = 0x70;
860 break;
861 case 32:
862 par->CR67 = 0xd0;
863 break;
864 }
865
866 /*
867 * Either BIOS use is disabled, or we failed to find a suitable
868 * match. Fall back to traditional register-crunching.
869 */
870
871 vga_out8 (0x3d4, 0x3a);
872 tmp = vga_in8 (0x3d5);
873 if (1 /*FIXME:psav->pci_burst*/)
874 par->CR3A = (tmp & 0x7f) | 0x15;
875 else
876 par->CR3A = tmp | 0x95;
877
878 par->CR53 = 0x00;
879 par->CR31 = 0x8c;
880 par->CR66 = 0x89;
881
882 vga_out8 (0x3d4, 0x58);
883 par->CR58 = vga_in8 (0x3d5) & 0x80;
884 par->CR58 |= 0x13;
885
886 par->SR15 = 0x03 | 0x80;
887 par->SR18 = 0x00;
888 par->CR43 = par->CR45 = par->CR65 = 0x00;
889
890 vga_out8 (0x3d4, 0x40);
891 par->CR40 = vga_in8 (0x3d5) & ~0x01;
892
893 par->MMPR0 = 0x010400;
894 par->MMPR1 = 0x00;
895 par->MMPR2 = 0x0808;
896 par->MMPR3 = 0x08080810;
897
898 SavageCalcClock (dclk, 1, 1, 127, 0, 4, 180000, 360000, &m, &n, &r);
899 /* m = 107; n = 4; r = 2; */
900
901 if (par->MCLK <= 0) {
902 par->SR10 = 255;
903 par->SR11 = 255;
904 } else {
905 common_calc_clock (par->MCLK, 1, 1, 31, 0, 3, 135000, 270000,
906 &par->SR11, &par->SR10);
907 /* par->SR10 = 80; // MCLK == 286000 */
908 /* par->SR11 = 125; */
909 }
910
911 par->SR12 = (r << 6) | (n & 0x3f);
912 par->SR13 = m & 0xff;
913 par->SR29 = (r & 4) | (m & 0x100) >> 5 | (n & 0x40) >> 2;
914
915 if (var->bits_per_pixel < 24)
916 par->MMPR0 -= 0x8000;
917 else
918 par->MMPR0 -= 0x4000;
919
920 if (timings.interlaced)
921 par->CR42 = 0x20;
922 else
923 par->CR42 = 0x00;
924
925 par->CR34 = 0x10; /* display fifo */
926
927 i = ((((timings.HTotal >> 3) - 5) & 0x100) >> 8) |
928 ((((timings.HDisplay >> 3) - 1) & 0x100) >> 7) |
929 ((((timings.HSyncStart >> 3) - 1) & 0x100) >> 6) |
930 ((timings.HSyncStart & 0x800) >> 7);
931
932 if ((timings.HSyncEnd >> 3) - (timings.HSyncStart >> 3) > 64)
933 i |= 0x08;
934 if ((timings.HSyncEnd >> 3) - (timings.HSyncStart >> 3) > 32)
935 i |= 0x20;
936
937 j = (par->CRTC[0] + ((i & 0x01) << 8) +
938 par->CRTC[4] + ((i & 0x10) << 4) + 1) / 2;
939
940 if (j - (par->CRTC[4] + ((i & 0x10) << 4)) < 4) {
941 if (par->CRTC[4] + ((i & 0x10) << 4) + 4 <=
942 par->CRTC[0] + ((i & 0x01) << 8))
943 j = par->CRTC[4] + ((i & 0x10) << 4) + 4;
944 else
945 j = par->CRTC[0] + ((i & 0x01) << 8) + 1;
946 }
947
948 par->CR3B = j & 0xff;
949 i |= (j & 0x100) >> 2;
950 par->CR3C = (par->CRTC[0] + ((i & 0x01) << 8)) / 2;
951 par->CR5D = i;
952 par->CR5E = (((timings.VTotal - 2) & 0x400) >> 10) |
953 (((timings.VDisplay - 1) & 0x400) >> 9) |
954 (((timings.VSyncStart) & 0x400) >> 8) |
955 (((timings.VSyncStart) & 0x400) >> 6) | 0x40;
956 width = (var->xres_virtual * ((var->bits_per_pixel+7) / 8)) >> 3;
957 par->CR91 = par->CRTC[19] = 0xff & width;
958 par->CR51 = (0x300 & width) >> 4;
959 par->CR90 = 0x80 | (width >> 8);
960 par->MiscOutReg |= 0x0c;
961
962 /* Set frame buffer description. */
963
964 if (var->bits_per_pixel <= 8)
965 par->CR50 = 0;
966 else if (var->bits_per_pixel <= 16)
967 par->CR50 = 0x10;
968 else
969 par->CR50 = 0x30;
970
971 if (var->xres_virtual <= 640)
972 par->CR50 |= 0x40;
973 else if (var->xres_virtual == 800)
974 par->CR50 |= 0x80;
975 else if (var->xres_virtual == 1024)
976 par->CR50 |= 0x00;
977 else if (var->xres_virtual == 1152)
978 par->CR50 |= 0x01;
979 else if (var->xres_virtual == 1280)
980 par->CR50 |= 0xc0;
981 else if (var->xres_virtual == 1600)
982 par->CR50 |= 0x81;
983 else
984 par->CR50 |= 0xc1; /* Use GBD */
985
986 if( par->chip == S3_SAVAGE2000 )
987 par->CR33 = 0x08;
988 else
989 par->CR33 = 0x20;
990
991 par->CRTC[0x17] = 0xeb;
992
993 par->CR67 |= 1;
994
995 vga_out8(0x3d4, 0x36);
996 par->CR36 = vga_in8 (0x3d5);
997 vga_out8 (0x3d4, 0x68);
998 par->CR68 = vga_in8 (0x3d5);
999 par->CR69 = 0;
1000 vga_out8 (0x3d4, 0x6f);
1001 par->CR6F = vga_in8 (0x3d5);
1002 vga_out8 (0x3d4, 0x86);
1003 par->CR86 = vga_in8 (0x3d5);
1004 vga_out8 (0x3d4, 0x88);
1005 par->CR88 = vga_in8 (0x3d5) | 0x08;
1006 vga_out8 (0x3d4, 0xb0);
1007 par->CRB0 = vga_in8 (0x3d5) | 0x80;
1008
1009 return 0;
1010}
1011
1012/* --------------------------------------------------------------------- */
1013
1014/*
1015 * Set a single color register. Return != 0 for invalid regno.
1016 */
1017static int savagefb_setcolreg(unsigned regno,
1018 unsigned red,
1019 unsigned green,
1020 unsigned blue,
1021 unsigned transp,
1022 struct fb_info *info)
1023{
1024 struct savagefb_par *par = (struct savagefb_par *)info->par;
1025
1026 if (regno >= NR_PALETTE)
1027 return -EINVAL;
1028
1029 par->palette[regno].red = red;
1030 par->palette[regno].green = green;
1031 par->palette[regno].blue = blue;
1032 par->palette[regno].transp = transp;
1033
1034 switch (info->var.bits_per_pixel) {
1035 case 8:
1036 vga_out8 (0x3c8, regno);
1037
1038 vga_out8 (0x3c9, red >> 10);
1039 vga_out8 (0x3c9, green >> 10);
1040 vga_out8 (0x3c9, blue >> 10);
1041 break;
1042
1043 case 16:
1044 if (regno < 16)
1045 ((u32 *)info->pseudo_palette)[regno] =
1046 ((red & 0xf800) ) |
1047 ((green & 0xfc00) >> 5) |
1048 ((blue & 0xf800) >> 11);
1049 break;
1050
1051 case 24:
1052 if (regno < 16)
1053 ((u32 *)info->pseudo_palette)[regno] =
1054 ((red & 0xff00) << 8) |
1055 ((green & 0xff00) ) |
1056 ((blue & 0xff00) >> 8);
1057 break;
1058 case 32:
1059 if (regno < 16)
1060 ((u32 *)info->pseudo_palette)[regno] =
1061 ((transp & 0xff00) << 16) |
1062 ((red & 0xff00) << 8) |
1063 ((green & 0xff00) ) |
1064 ((blue & 0xff00) >> 8);
1065 break;
1066
1067 default:
1068 return 1;
1069 }
1070
1071 return 0;
1072}
1073
1074static void savagefb_set_par_int (struct savagefb_par *par)
1075{
1076 unsigned char tmp, cr3a, cr66, cr67;
1077
1078 DBG ("savagefb_set_par_int");
1079
1080 par->SavageWaitIdle (par);
1081
1082 vga_out8 (0x3c2, 0x23);
1083
1084 vga_out16 (0x3d4, 0x4838);
1085 vga_out16 (0x3d4, 0xa539);
1086 vga_out16 (0x3c4, 0x0608);
1087
1088 vgaHWProtect (par, 1);
1089
1090 /*
1091 * Some Savage/MX and /IX systems go nuts when trying to exit the
1092 * server after WindowMaker has displayed a gradient background. I
1093 * haven't been able to find what causes it, but a non-destructive
1094 * switch to mode 3 here seems to eliminate the issue.
1095 */
1096
1097 VerticalRetraceWait();
1098 vga_out8 (0x3d4, 0x67);
1099 cr67 = vga_in8 (0x3d5);
1100 vga_out8 (0x3d5, cr67/*par->CR67*/ & ~0x0c); /* no STREAMS yet */
1101
1102 vga_out8 (0x3d4, 0x23);
1103 vga_out8 (0x3d5, 0x00);
1104 vga_out8 (0x3d4, 0x26);
1105 vga_out8 (0x3d5, 0x00);
1106
1107 /* restore extended regs */
1108 vga_out8 (0x3d4, 0x66);
1109 vga_out8 (0x3d5, par->CR66);
1110 vga_out8 (0x3d4, 0x3a);
1111 vga_out8 (0x3d5, par->CR3A);
1112 vga_out8 (0x3d4, 0x31);
1113 vga_out8 (0x3d5, par->CR31);
1114 vga_out8 (0x3d4, 0x32);
1115 vga_out8 (0x3d5, par->CR32);
1116 vga_out8 (0x3d4, 0x58);
1117 vga_out8 (0x3d5, par->CR58);
1118 vga_out8 (0x3d4, 0x53);
1119 vga_out8 (0x3d5, par->CR53 & 0x7f);
1120
1121 vga_out16 (0x3c4, 0x0608);
1122
1123 /* Restore DCLK registers. */
1124
1125 vga_out8 (0x3c4, 0x0e);
1126 vga_out8 (0x3c5, par->SR0E);
1127 vga_out8 (0x3c4, 0x0f);
1128 vga_out8 (0x3c5, par->SR0F);
1129 vga_out8 (0x3c4, 0x29);
1130 vga_out8 (0x3c5, par->SR29);
1131 vga_out8 (0x3c4, 0x15);
1132 vga_out8 (0x3c5, par->SR15);
1133
1134 /* Restore flat panel expansion regsters. */
1135 if( par->chip == S3_SAVAGE_MX ) {
1136 int i;
1137
1138 for( i = 0; i < 8; i++ ) {
1139 vga_out8 (0x3c4, 0x54+i);
1140 vga_out8 (0x3c5, par->SR54[i]);
1141 }
1142 }
1143
1144 vgaHWRestore (par);
1145
1146 /* extended mode timing registers */
1147 vga_out8 (0x3d4, 0x53);
1148 vga_out8 (0x3d5, par->CR53);
1149 vga_out8 (0x3d4, 0x5d);
1150 vga_out8 (0x3d5, par->CR5D);
1151 vga_out8 (0x3d4, 0x5e);
1152 vga_out8 (0x3d5, par->CR5E);
1153 vga_out8 (0x3d4, 0x3b);
1154 vga_out8 (0x3d5, par->CR3B);
1155 vga_out8 (0x3d4, 0x3c);
1156 vga_out8 (0x3d5, par->CR3C);
1157 vga_out8 (0x3d4, 0x43);
1158 vga_out8 (0x3d5, par->CR43);
1159 vga_out8 (0x3d4, 0x65);
1160 vga_out8 (0x3d5, par->CR65);
1161
1162 /* restore the desired video mode with cr67 */
1163 vga_out8 (0x3d4, 0x67);
1164 /* following part not present in X11 driver */
1165 cr67 = vga_in8 (0x3d5) & 0xf;
1166 vga_out8 (0x3d5, 0x50 | cr67);
1167 udelay (10000);
1168 vga_out8 (0x3d4, 0x67);
1169 /* end of part */
1170 vga_out8 (0x3d5, par->CR67 & ~0x0c);
1171
1172 /* other mode timing and extended regs */
1173 vga_out8 (0x3d4, 0x34);
1174 vga_out8 (0x3d5, par->CR34);
1175 vga_out8 (0x3d4, 0x40);
1176 vga_out8 (0x3d5, par->CR40);
1177 vga_out8 (0x3d4, 0x42);
1178 vga_out8 (0x3d5, par->CR42);
1179 vga_out8 (0x3d4, 0x45);
1180 vga_out8 (0x3d5, par->CR45);
1181 vga_out8 (0x3d4, 0x50);
1182 vga_out8 (0x3d5, par->CR50);
1183 vga_out8 (0x3d4, 0x51);
1184 vga_out8 (0x3d5, par->CR51);
1185
1186 /* memory timings */
1187 vga_out8 (0x3d4, 0x36);
1188 vga_out8 (0x3d5, par->CR36);
1189 vga_out8 (0x3d4, 0x60);
1190 vga_out8 (0x3d5, par->CR60);
1191 vga_out8 (0x3d4, 0x68);
1192 vga_out8 (0x3d5, par->CR68);
1193 vga_out8 (0x3d4, 0x69);
1194 vga_out8 (0x3d5, par->CR69);
1195 vga_out8 (0x3d4, 0x6f);
1196 vga_out8 (0x3d5, par->CR6F);
1197
1198 vga_out8 (0x3d4, 0x33);
1199 vga_out8 (0x3d5, par->CR33);
1200 vga_out8 (0x3d4, 0x86);
1201 vga_out8 (0x3d5, par->CR86);
1202 vga_out8 (0x3d4, 0x88);
1203 vga_out8 (0x3d5, par->CR88);
1204 vga_out8 (0x3d4, 0x90);
1205 vga_out8 (0x3d5, par->CR90);
1206 vga_out8 (0x3d4, 0x91);
1207 vga_out8 (0x3d5, par->CR91);
1208
1209 if (par->chip == S3_SAVAGE4) {
1210 vga_out8 (0x3d4, 0xb0);
1211 vga_out8 (0x3d5, par->CRB0);
1212 }
1213
1214 vga_out8 (0x3d4, 0x32);
1215 vga_out8 (0x3d5, par->CR32);
1216
1217 /* unlock extended seq regs */
1218 vga_out8 (0x3c4, 0x08);
1219 vga_out8 (0x3c5, 0x06);
1220
1221 /* Restore extended sequencer regs for MCLK. SR10 == 255 indicates
1222 * that we should leave the default SR10 and SR11 values there.
1223 */
1224 if (par->SR10 != 255) {
1225 vga_out8 (0x3c4, 0x10);
1226 vga_out8 (0x3c5, par->SR10);
1227 vga_out8 (0x3c4, 0x11);
1228 vga_out8 (0x3c5, par->SR11);
1229 }
1230
1231 /* restore extended seq regs for dclk */
1232 vga_out8 (0x3c4, 0x0e);
1233 vga_out8 (0x3c5, par->SR0E);
1234 vga_out8 (0x3c4, 0x0f);
1235 vga_out8 (0x3c5, par->SR0F);
1236 vga_out8 (0x3c4, 0x12);
1237 vga_out8 (0x3c5, par->SR12);
1238 vga_out8 (0x3c4, 0x13);
1239 vga_out8 (0x3c5, par->SR13);
1240 vga_out8 (0x3c4, 0x29);
1241 vga_out8 (0x3c5, par->SR29);
1242
1243 vga_out8 (0x3c4, 0x18);
1244 vga_out8 (0x3c5, par->SR18);
1245
1246 /* load new m, n pll values for dclk & mclk */
1247 vga_out8 (0x3c4, 0x15);
1248 tmp = vga_in8 (0x3c5) & ~0x21;
1249
1250 vga_out8 (0x3c5, tmp | 0x03);
1251 vga_out8 (0x3c5, tmp | 0x23);
1252 vga_out8 (0x3c5, tmp | 0x03);
1253 vga_out8 (0x3c5, par->SR15);
1254 udelay (100);
1255
1256 vga_out8 (0x3c4, 0x30);
1257 vga_out8 (0x3c5, par->SR30);
1258 vga_out8 (0x3c4, 0x08);
1259 vga_out8 (0x3c5, par->SR08);
1260
1261 /* now write out cr67 in full, possibly starting STREAMS */
1262 VerticalRetraceWait();
1263 vga_out8 (0x3d4, 0x67);
1264 vga_out8 (0x3d5, par->CR67);
1265
1266 vga_out8 (0x3d4, 0x66);
1267 cr66 = vga_in8 (0x3d5);
1268 vga_out8 (0x3d5, cr66 | 0x80);
1269 vga_out8 (0x3d4, 0x3a);
1270 cr3a = vga_in8 (0x3d5);
1271 vga_out8 (0x3d5, cr3a | 0x80);
1272
1273 if (par->chip != S3_SAVAGE_MX) {
1274 VerticalRetraceWait();
1275 savage_out32 (FIFO_CONTROL_REG, par->MMPR0);
1276 par->SavageWaitIdle (par);
1277 savage_out32 (MIU_CONTROL_REG, par->MMPR1);
1278 par->SavageWaitIdle (par);
1279 savage_out32 (STREAMS_TIMEOUT_REG, par->MMPR2);
1280 par->SavageWaitIdle (par);
1281 savage_out32 (MISC_TIMEOUT_REG, par->MMPR3);
1282 }
1283
1284 vga_out8 (0x3d4, 0x66);
1285 vga_out8 (0x3d5, cr66);
1286 vga_out8 (0x3d4, 0x3a);
1287 vga_out8 (0x3d5, cr3a);
1288
1289 SavageSetup2DEngine (par);
1290 vgaHWProtect (par, 0);
1291}
1292
1293static void savagefb_update_start (struct savagefb_par *par,
1294 struct fb_var_screeninfo *var)
1295{
1296 int base;
1297
1298 base = ((var->yoffset * var->xres_virtual + (var->xoffset & ~1))
1299 * ((var->bits_per_pixel+7) / 8)) >> 2;
1300
1301 /* now program the start address registers */
1302 vga_out16(0x3d4, (base & 0x00ff00) | 0x0c);
1303 vga_out16(0x3d4, ((base & 0x00ff) << 8) | 0x0d);
1304 vga_out8 (0x3d4, 0x69);
1305 vga_out8 (0x3d5, (base & 0x7f0000) >> 16);
1306}
1307
1308
1309static void savagefb_set_fix(struct fb_info *info)
1310{
1311 info->fix.line_length = info->var.xres_virtual *
1312 info->var.bits_per_pixel / 8;
1313
1314 if (info->var.bits_per_pixel == 8)
1315 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
1316 else
1317 info->fix.visual = FB_VISUAL_TRUECOLOR;
1318}
1319
1320#if defined(CONFIG_FB_SAVAGE_ACCEL)
1321static void savagefb_set_clip(struct fb_info *info)
1322{
1323 struct savagefb_par *par = (struct savagefb_par *)info->par;
1324 int cmd;
1325
1326 cmd = BCI_CMD_NOP | BCI_CMD_CLIP_NEW;
1327 par->bci_ptr = 0;
1328 par->SavageWaitFifo(par,3);
1329 BCI_SEND(cmd);
1330 BCI_SEND(BCI_CLIP_TL(0, 0));
1331 BCI_SEND(BCI_CLIP_BR(0xfff, 0xfff));
1332}
1333#endif
1334
1335static int savagefb_set_par (struct fb_info *info)
1336{
1337 struct savagefb_par *par = (struct savagefb_par *)info->par;
1338 struct fb_var_screeninfo *var = &info->var;
1339 int err;
1340
1341 DBG("savagefb_set_par");
1342 err = savagefb_decode_var (var, par);
1343 if (err)
1344 return err;
1345
1346 if (par->dacSpeedBpp <= 0) {
1347 if (var->bits_per_pixel > 24)
1348 par->dacSpeedBpp = par->clock[3];
1349 else if (var->bits_per_pixel >= 24)
1350 par->dacSpeedBpp = par->clock[2];
1351 else if ((var->bits_per_pixel > 8) && (var->bits_per_pixel < 24))
1352 par->dacSpeedBpp = par->clock[1];
1353 else if (var->bits_per_pixel <= 8)
1354 par->dacSpeedBpp = par->clock[0];
1355 }
1356
1357 /* Set ramdac limits */
1358 par->maxClock = par->dacSpeedBpp;
1359 par->minClock = 10000;
1360
1361 savagefb_set_par_int (par);
1362 savagefb_update_start (par, var);
1363 fb_set_cmap (&info->cmap, info);
1364 savagefb_set_fix(info);
1365 savagefb_set_clip(info);
1366
1367 SavagePrintRegs();
1368 return 0;
1369}
1370
1371/*
1372 * Pan or Wrap the Display
1373 */
1374static int savagefb_pan_display (struct fb_var_screeninfo *var,
1375 struct fb_info *info)
1376{
1377 struct savagefb_par *par = (struct savagefb_par *)info->par;
1378 u_int y_bottom;
1379
1380 y_bottom = var->yoffset;
1381
1382 if (!(var->vmode & FB_VMODE_YWRAP))
1383 y_bottom += var->yres;
1384
1385 if (var->xoffset > (var->xres_virtual - var->xres))
1386 return -EINVAL;
1387 if (y_bottom > info->var.yres_virtual)
1388 return -EINVAL;
1389
1390 savagefb_update_start (par, var);
1391
1392 info->var.xoffset = var->xoffset;
1393 info->var.yoffset = var->yoffset;
1394
1395 if (var->vmode & FB_VMODE_YWRAP)
1396 info->var.vmode |= FB_VMODE_YWRAP;
1397 else
1398 info->var.vmode &= ~FB_VMODE_YWRAP;
1399
1400 return 0;
1401}
1402
1403
1404static struct fb_ops savagefb_ops = {
1405 .owner = THIS_MODULE,
1406 .fb_check_var = savagefb_check_var,
1407 .fb_set_par = savagefb_set_par,
1408 .fb_setcolreg = savagefb_setcolreg,
1409 .fb_pan_display = savagefb_pan_display,
1410#if defined(CONFIG_FB_SAVAGE_ACCEL)
1411 .fb_fillrect = savagefb_fillrect,
1412 .fb_copyarea = savagefb_copyarea,
1413 .fb_imageblit = savagefb_imageblit,
1414 .fb_sync = savagefb_sync,
1415#else
1416 .fb_fillrect = cfb_fillrect,
1417 .fb_copyarea = cfb_copyarea,
1418 .fb_imageblit = cfb_imageblit,
1419#endif
1420 .fb_cursor = soft_cursor,
1421};
1422
1423/* --------------------------------------------------------------------- */
1424
1425static struct fb_var_screeninfo __devinitdata savagefb_var800x600x8 = {
1426 .accel_flags = FB_ACCELF_TEXT,
1427 .xres = 800,
1428 .yres = 600,
1429 .xres_virtual = 800,
1430 .yres_virtual = 600,
1431 .bits_per_pixel = 8,
1432 .pixclock = 25000,
1433 .left_margin = 88,
1434 .right_margin = 40,
1435 .upper_margin = 23,
1436 .lower_margin = 1,
1437 .hsync_len = 128,
1438 .vsync_len = 4,
1439 .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
1440 .vmode = FB_VMODE_NONINTERLACED
1441};
1442
1443static void savage_enable_mmio (struct savagefb_par *par)
1444{
1445 unsigned char val;
1446
1447 DBG ("savage_enable_mmio\n");
1448
1449 val = vga_in8 (0x3c3);
1450 vga_out8 (0x3c3, val | 0x01);
1451 val = vga_in8 (0x3cc);
1452 vga_out8 (0x3c2, val | 0x01);
1453
1454 if (par->chip >= S3_SAVAGE4) {
1455 vga_out8 (0x3d4, 0x40);
1456 val = vga_in8 (0x3d5);
1457 vga_out8 (0x3d5, val | 1);
1458 }
1459}
1460
1461
1462static void savage_disable_mmio (struct savagefb_par *par)
1463{
1464 unsigned char val;
1465
1466 DBG ("savage_disable_mmio\n");
1467
1468 if(par->chip >= S3_SAVAGE4 ) {
1469 vga_out8 (0x3d4, 0x40);
1470 val = vga_in8 (0x3d5);
1471 vga_out8 (0x3d5, val | 1);
1472 }
1473}
1474
1475
1476static int __devinit savage_map_mmio (struct fb_info *info)
1477{
1478 struct savagefb_par *par = (struct savagefb_par *)info->par;
1479 DBG ("savage_map_mmio");
1480
1481 if (S3_SAVAGE3D_SERIES (par->chip))
1482 par->mmio.pbase = pci_resource_start (par->pcidev, 0) +
1483 SAVAGE_NEWMMIO_REGBASE_S3;
1484 else
1485 par->mmio.pbase = pci_resource_start (par->pcidev, 0) +
1486 SAVAGE_NEWMMIO_REGBASE_S4;
1487
1488 par->mmio.len = SAVAGE_NEWMMIO_REGSIZE;
1489
1490 par->mmio.vbase = ioremap (par->mmio.pbase, par->mmio.len);
1491 if (!par->mmio.vbase) {
1492 printk ("savagefb: unable to map memory mapped IO\n");
1493 return -ENOMEM;
1494 } else
1495 printk (KERN_INFO "savagefb: mapped io at %p\n",
1496 par->mmio.vbase);
1497
1498 info->fix.mmio_start = par->mmio.pbase;
1499 info->fix.mmio_len = par->mmio.len;
1500
1501 par->bci_base = (u32*)(par->mmio.vbase + BCI_BUFFER_OFFSET);
1502 par->bci_ptr = 0;
1503
1504 savage_enable_mmio (par);
1505
1506 return 0;
1507}
1508
1509static void __devinit savage_unmap_mmio (struct fb_info *info)
1510{
1511 struct savagefb_par *par = (struct savagefb_par *)info->par;
1512 DBG ("savage_unmap_mmio");
1513
1514 savage_disable_mmio(par);
1515
1516 if (par->mmio.vbase) {
1517 iounmap ((void *)par->mmio.vbase);
1518 par->mmio.vbase = NULL;
1519 }
1520}
1521
1522static int __devinit savage_map_video (struct fb_info *info,
1523 int video_len)
1524{
1525 struct savagefb_par *par = (struct savagefb_par *)info->par;
1526 int resource;
1527
1528 DBG("savage_map_video");
1529
1530 if (S3_SAVAGE3D_SERIES (par->chip))
1531 resource = 0;
1532 else
1533 resource = 1;
1534
1535 par->video.pbase = pci_resource_start (par->pcidev, resource);
1536 par->video.len = video_len;
1537 par->video.vbase = ioremap (par->video.pbase, par->video.len);
1538
1539 if (!par->video.vbase) {
1540 printk ("savagefb: unable to map screen memory\n");
1541 return -ENOMEM;
1542 } else
1543 printk (KERN_INFO "savagefb: mapped framebuffer at %p, "
1544 "pbase == %x\n", par->video.vbase, par->video.pbase);
1545
1546 info->fix.smem_start = par->video.pbase;
1547 info->fix.smem_len = par->video.len - par->cob_size;
1548 info->screen_base = par->video.vbase;
1549
1550#ifdef CONFIG_MTRR
1551 par->video.mtrr = mtrr_add (par->video.pbase, video_len,
1552 MTRR_TYPE_WRCOMB, 1);
1553#endif
1554
1555 /* Clear framebuffer, it's all white in memory after boot */
1556 memset (par->video.vbase, 0, par->video.len);
1557
1558 return 0;
1559}
1560
1561static void __devinit savage_unmap_video (struct fb_info *info)
1562{
1563 struct savagefb_par *par = (struct savagefb_par *)info->par;
1564
1565 DBG("savage_unmap_video");
1566
1567 if (par->video.vbase) {
1568#ifdef CONFIG_MTRR
1569 mtrr_del (par->video.mtrr, par->video.pbase, par->video.len);
1570#endif
1571
1572 iounmap (par->video.vbase);
1573 par->video.vbase = NULL;
1574 info->screen_base = NULL;
1575 }
1576}
1577
1578static int __devinit savage_init_hw (struct savagefb_par *par)
1579{
1580 unsigned char config1, m, n, n1, n2, sr8, cr3f, cr66 = 0, tmp;
1581
1582 static unsigned char RamSavage3D[] = { 8, 4, 4, 2 };
1583 static unsigned char RamSavage4[] = { 2, 4, 8, 12, 16, 32, 64, 32 };
1584 static unsigned char RamSavageMX[] = { 2, 8, 4, 16, 8, 16, 4, 16 };
1585 static unsigned char RamSavageNB[] = { 0, 2, 4, 8, 16, 32, 2, 2 };
1586
1587 int videoRam, videoRambytes;
1588
1589 DBG("savage_init_hw");
1590
1591 /* unprotect CRTC[0-7] */
1592 vga_out8(0x3d4, 0x11);
1593 tmp = vga_in8(0x3d5);
1594 vga_out8(0x3d5, tmp & 0x7f);
1595
1596 /* unlock extended regs */
1597 vga_out16(0x3d4, 0x4838);
1598 vga_out16(0x3d4, 0xa039);
1599 vga_out16(0x3c4, 0x0608);
1600
1601 vga_out8(0x3d4, 0x40);
1602 tmp = vga_in8(0x3d5);
1603 vga_out8(0x3d5, tmp & ~0x01);
1604
1605 /* unlock sys regs */
1606 vga_out8(0x3d4, 0x38);
1607 vga_out8(0x3d5, 0x48);
1608
1609 /* Unlock system registers. */
1610 vga_out16(0x3d4, 0x4838);
1611
1612 /* Next go on to detect amount of installed ram */
1613
1614 vga_out8(0x3d4, 0x36); /* for register CR36 (CONFG_REG1), */
1615 config1 = vga_in8(0x3d5); /* get amount of vram installed */
1616
1617 /* Compute the amount of video memory and offscreen memory. */
1618
1619 switch (par->chip) {
1620 case S3_SAVAGE3D:
1621 videoRam = RamSavage3D[ (config1 & 0xC0) >> 6 ] * 1024;
1622 break;
1623
1624 case S3_SAVAGE4:
1625 /*
1626 * The Savage4 has one ugly special case to consider. On
1627 * systems with 4 banks of 2Mx32 SDRAM, the BIOS says 4MB
1628 * when it really means 8MB. Why do it the same when you
1629 * can do it different...
1630 */
1631 vga_out8(0x3d4, 0x68); /* memory control 1 */
1632 if( (vga_in8(0x3d5) & 0xC0) == (0x01 << 6) )
1633 RamSavage4[1] = 8;
1634
1635 /*FALLTHROUGH*/
1636
1637 case S3_SAVAGE2000:
1638 videoRam = RamSavage4[ (config1 & 0xE0) >> 5 ] * 1024;
1639 break;
1640
1641 case S3_SAVAGE_MX:
1642 case S3_SUPERSAVAGE:
1643 videoRam = RamSavageMX[ (config1 & 0x0E) >> 1 ] * 1024;
1644 break;
1645
1646 case S3_PROSAVAGE:
1647 videoRam = RamSavageNB[ (config1 & 0xE0) >> 5 ] * 1024;
1648 break;
1649
1650 default:
1651 /* How did we get here? */
1652 videoRam = 0;
1653 break;
1654 }
1655
1656 videoRambytes = videoRam * 1024;
1657
1658 printk (KERN_INFO "savagefb: probed videoram: %dk\n", videoRam);
1659
1660 /* reset graphics engine to avoid memory corruption */
1661 vga_out8 (0x3d4, 0x66);
1662 cr66 = vga_in8 (0x3d5);
1663 vga_out8 (0x3d5, cr66 | 0x02);
1664 udelay (10000);
1665
1666 vga_out8 (0x3d4, 0x66);
1667 vga_out8 (0x3d5, cr66 & ~0x02); /* clear reset flag */
1668 udelay (10000);
1669
1670
1671 /*
1672 * reset memory interface, 3D engine, AGP master, PCI master,
1673 * master engine unit, motion compensation/LPB
1674 */
1675 vga_out8 (0x3d4, 0x3f);
1676 cr3f = vga_in8 (0x3d5);
1677 vga_out8 (0x3d5, cr3f | 0x08);
1678 udelay (10000);
1679
1680 vga_out8 (0x3d4, 0x3f);
1681 vga_out8 (0x3d5, cr3f & ~0x08); /* clear reset flags */
1682 udelay (10000);
1683
1684 /* Savage ramdac speeds */
1685 par->numClocks = 4;
1686 par->clock[0] = 250000;
1687 par->clock[1] = 250000;
1688 par->clock[2] = 220000;
1689 par->clock[3] = 220000;
1690
1691 /* detect current mclk */
1692 vga_out8(0x3c4, 0x08);
1693 sr8 = vga_in8(0x3c5);
1694 vga_out8(0x3c5, 0x06);
1695 vga_out8(0x3c4, 0x10);
1696 n = vga_in8(0x3c5);
1697 vga_out8(0x3c4, 0x11);
1698 m = vga_in8(0x3c5);
1699 vga_out8(0x3c4, 0x08);
1700 vga_out8(0x3c5, sr8);
1701 m &= 0x7f;
1702 n1 = n & 0x1f;
1703 n2 = (n >> 5) & 0x03;
1704 par->MCLK = ((1431818 * (m+2)) / (n1+2) / (1 << n2) + 50) / 100;
1705 printk (KERN_INFO "savagefb: Detected current MCLK value of %d kHz\n",
1706 par->MCLK);
1707
1708 /* Check LCD panel parrmation */
1709
1710 if (par->chip == S3_SAVAGE_MX) {
1711 unsigned char cr6b = VGArCR( 0x6b );
1712
1713 int panelX = (VGArSEQ (0x61) +
1714 ((VGArSEQ (0x66) & 0x02) << 7) + 1) * 8;
1715 int panelY = (VGArSEQ (0x69) +
1716 ((VGArSEQ (0x6e) & 0x70) << 4) + 1);
1717
1718 char * sTechnology = "Unknown";
1719
1720 /* OK, I admit it. I don't know how to limit the max dot clock
1721 * for LCD panels of various sizes. I thought I copied the
1722 * formula from the BIOS, but many users have parrmed me of
1723 * my folly.
1724 *
1725 * Instead, I'll abandon any attempt to automatically limit the
1726 * clock, and add an LCDClock option to XF86Config. Some day,
1727 * I should come back to this.
1728 */
1729
1730 enum ACTIVE_DISPLAYS { /* These are the bits in CR6B */
1731 ActiveCRT = 0x01,
1732 ActiveLCD = 0x02,
1733 ActiveTV = 0x04,
1734 ActiveCRT2 = 0x20,
1735 ActiveDUO = 0x80
1736 };
1737
1738 if ((VGArSEQ (0x39) & 0x03) == 0) {
1739 sTechnology = "TFT";
1740 } else if ((VGArSEQ (0x30) & 0x01) == 0) {
1741 sTechnology = "DSTN";
1742 } else {
1743 sTechnology = "STN";
1744 }
1745
1746 printk (KERN_INFO "savagefb: %dx%d %s LCD panel detected %s\n",
1747 panelX, panelY, sTechnology,
1748 cr6b & ActiveLCD ? "and active" : "but not active");
1749
1750 if( cr6b & ActiveLCD ) {
1751 /*
1752 * If the LCD is active and panel expansion is enabled,
1753 * we probably want to kill the HW cursor.
1754 */
1755
1756 printk (KERN_INFO "savagefb: Limiting video mode to "
1757 "%dx%d\n", panelX, panelY );
1758
1759 par->SavagePanelWidth = panelX;
1760 par->SavagePanelHeight = panelY;
1761
1762 }
1763 }
1764
1765 savage_get_default_par (par);
1766
1767 if( S3_SAVAGE4_SERIES(par->chip) ) {
1768 /*
1769 * The Savage4 and ProSavage have COB coherency bugs which
1770 * render the buffer useless. We disable it.
1771 */
1772 par->cob_index = 2;
1773 par->cob_size = 0x8000 << par->cob_index;
1774 par->cob_offset = videoRambytes;
1775 } else {
1776 /* We use 128kB for the COB on all chips. */
1777
1778 par->cob_index = 7;
1779 par->cob_size = 0x400 << par->cob_index;
1780 par->cob_offset = videoRambytes - par->cob_size;
1781 }
1782
1783 return videoRambytes;
1784}
1785
1786static int __devinit savage_init_fb_info (struct fb_info *info,
1787 struct pci_dev *dev,
1788 const struct pci_device_id *id)
1789{
1790 struct savagefb_par *par = (struct savagefb_par *)info->par;
1791 int err = 0;
1792
1793 par->pcidev = dev;
1794
1795 info->fix.type = FB_TYPE_PACKED_PIXELS;
1796 info->fix.type_aux = 0;
1797 info->fix.xpanstep = 2;
1798 info->fix.ypanstep = 1;
1799 info->fix.ywrapstep = 0;
1800 info->fix.accel = id->driver_data;
1801
1802 switch (info->fix.accel) {
1803 case FB_ACCEL_SUPERSAVAGE:
1804 par->chip = S3_SUPERSAVAGE;
1805 snprintf (info->fix.id, 16, "SuperSavage");
1806 break;
1807 case FB_ACCEL_SAVAGE4:
1808 par->chip = S3_SAVAGE4;
1809 snprintf (info->fix.id, 16, "Savage4");
1810 break;
1811 case FB_ACCEL_SAVAGE3D:
1812 par->chip = S3_SAVAGE3D;
1813 snprintf (info->fix.id, 16, "Savage3D");
1814 break;
1815 case FB_ACCEL_SAVAGE3D_MV:
1816 par->chip = S3_SAVAGE3D;
1817 snprintf (info->fix.id, 16, "Savage3D-MV");
1818 break;
1819 case FB_ACCEL_SAVAGE2000:
1820 par->chip = S3_SAVAGE2000;
1821 snprintf (info->fix.id, 16, "Savage2000");
1822 break;
1823 case FB_ACCEL_SAVAGE_MX_MV:
1824 par->chip = S3_SAVAGE_MX;
1825 snprintf (info->fix.id, 16, "Savage/MX-MV");
1826 break;
1827 case FB_ACCEL_SAVAGE_MX:
1828 par->chip = S3_SAVAGE_MX;
1829 snprintf (info->fix.id, 16, "Savage/MX");
1830 break;
1831 case FB_ACCEL_SAVAGE_IX_MV:
1832 par->chip = S3_SAVAGE_MX;
1833 snprintf (info->fix.id, 16, "Savage/IX-MV");
1834 break;
1835 case FB_ACCEL_SAVAGE_IX:
1836 par->chip = S3_SAVAGE_MX;
1837 snprintf (info->fix.id, 16, "Savage/IX");
1838 break;
1839 case FB_ACCEL_PROSAVAGE_PM:
1840 par->chip = S3_PROSAVAGE;
1841 snprintf (info->fix.id, 16, "ProSavagePM");
1842 break;
1843 case FB_ACCEL_PROSAVAGE_KM:
1844 par->chip = S3_PROSAVAGE;
1845 snprintf (info->fix.id, 16, "ProSavageKM");
1846 break;
1847 case FB_ACCEL_S3TWISTER_P:
1848 par->chip = S3_PROSAVAGE;
1849 snprintf (info->fix.id, 16, "TwisterP");
1850 break;
1851 case FB_ACCEL_S3TWISTER_K:
1852 par->chip = S3_PROSAVAGE;
1853 snprintf (info->fix.id, 16, "TwisterK");
1854 break;
1855 case FB_ACCEL_PROSAVAGE_DDR:
1856 par->chip = S3_PROSAVAGE;
1857 snprintf (info->fix.id, 16, "ProSavageDDR");
1858 break;
1859 case FB_ACCEL_PROSAVAGE_DDRK:
1860 par->chip = S3_PROSAVAGE;
1861 snprintf (info->fix.id, 16, "ProSavage8");
1862 break;
1863 }
1864
1865 if (S3_SAVAGE3D_SERIES(par->chip)) {
1866 par->SavageWaitIdle = savage3D_waitidle;
1867 par->SavageWaitFifo = savage3D_waitfifo;
1868 } else if (S3_SAVAGE4_SERIES(par->chip) ||
1869 S3_SUPERSAVAGE == par->chip) {
1870 par->SavageWaitIdle = savage4_waitidle;
1871 par->SavageWaitFifo = savage4_waitfifo;
1872 } else {
1873 par->SavageWaitIdle = savage2000_waitidle;
1874 par->SavageWaitFifo = savage2000_waitfifo;
1875 }
1876
1877 info->var.nonstd = 0;
1878 info->var.activate = FB_ACTIVATE_NOW;
1879 info->var.width = -1;
1880 info->var.height = -1;
1881 info->var.accel_flags = 0;
1882
1883 info->fbops = &savagefb_ops;
1884 info->flags = FBINFO_DEFAULT |
1885 FBINFO_HWACCEL_YPAN |
1886 FBINFO_HWACCEL_XPAN;
1887
1888 info->pseudo_palette = par->pseudo_palette;
1889
1890#if defined(CONFIG_FB_SAVAGE_ACCEL)
1891 /* FIFO size + padding for commands */
1892 info->pixmap.addr = kmalloc(8*1024, GFP_KERNEL);
1893
1894 err = -ENOMEM;
1895 if (info->pixmap.addr) {
1896 memset(info->pixmap.addr, 0, 8*1024);
1897 info->pixmap.size = 8*1024;
1898 info->pixmap.scan_align = 4;
1899 info->pixmap.buf_align = 4;
1900 info->pixmap.access_align = 4;
1901
1902 fb_alloc_cmap (&info->cmap, NR_PALETTE, 0);
1903 info->flags |= FBINFO_HWACCEL_COPYAREA |
1904 FBINFO_HWACCEL_FILLRECT |
1905 FBINFO_HWACCEL_IMAGEBLIT;
1906
1907 err = 0;
1908 }
1909#endif
1910 return err;
1911}
1912
1913/* --------------------------------------------------------------------- */
1914
1915static int __devinit savagefb_probe (struct pci_dev* dev,
1916 const struct pci_device_id* id)
1917{
1918 struct fb_info *info;
1919 struct savagefb_par *par;
1920 u_int h_sync, v_sync;
1921 int err, lpitch;
1922 int video_len;
1923
1924 DBG("savagefb_probe");
1925 SavagePrintRegs();
1926
1927 info = framebuffer_alloc(sizeof(struct savagefb_par), &dev->dev);
1928 if (!info)
1929 return -ENOMEM;
1930 par = info->par;
1931 err = pci_enable_device(dev);
1932 if (err)
1933 goto failed_enable;
1934
1935 if (pci_request_regions(dev, "savagefb")) {
1936 printk(KERN_ERR "cannot request PCI regions\n");
1937 goto failed_enable;
1938 }
1939
1940 err = -ENOMEM;
1941
1942 if (savage_init_fb_info(info, dev, id))
1943 goto failed_init;
1944
1945 err = savage_map_mmio(info);
1946 if (err)
1947 goto failed_mmio;
1948
1949 video_len = savage_init_hw(par);
1950 if (video_len < 0) {
1951 err = video_len;
1952 goto failed_mmio;
1953 }
1954
1955 err = savage_map_video(info, video_len);
1956 if (err)
1957 goto failed_video;
1958
1959 INIT_LIST_HEAD(&info->modelist);
1960#if defined(CONFIG_FB_SAVAGE_I2C)
1961 savagefb_create_i2c_busses(info);
1962 savagefb_probe_i2c_connector(par, &par->edid);
1963 fb_edid_to_monspecs(par->edid, &info->monspecs);
1964 fb_videomode_to_modelist(info->monspecs.modedb,
1965 info->monspecs.modedb_len,
1966 &info->modelist);
1967#endif
1968 info->var = savagefb_var800x600x8;
1969
1970 if (mode_option) {
1971 fb_find_mode(&info->var, info, mode_option,
1972 info->monspecs.modedb, info->monspecs.modedb_len,
1973 NULL, 8);
1974 } else if (info->monspecs.modedb != NULL) {
1975 struct fb_monspecs *specs = &info->monspecs;
1976 struct fb_videomode modedb;
1977
1978 if (info->monspecs.misc & FB_MISC_1ST_DETAIL) {
1979 int i;
1980
1981 for (i = 0; i < specs->modedb_len; i++) {
1982 if (specs->modedb[i].flag & FB_MODE_IS_FIRST) {
1983 modedb = specs->modedb[i];
1984 break;
1985 }
1986 }
1987 } else {
1988 /* otherwise, get first mode in database */
1989 modedb = specs->modedb[0];
1990 }
1991
1992 savage_update_var(&info->var, &modedb);
1993 }
1994
1995 /* maximize virtual vertical length */
1996 lpitch = info->var.xres_virtual*((info->var.bits_per_pixel + 7) >> 3);
1997 info->var.yres_virtual = info->fix.smem_len/lpitch;
1998
1999 if (info->var.yres_virtual < info->var.yres)
2000 goto failed;
2001
2002#if defined(CONFIG_FB_SAVAGE_ACCEL)
2003 /*
2004 * The clipping coordinates are masked with 0xFFF, so limit our
2005 * virtual resolutions to these sizes.
2006 */
2007 if (info->var.yres_virtual > 0x1000)
2008 info->var.yres_virtual = 0x1000;
2009
2010 if (info->var.xres_virtual > 0x1000)
2011 info->var.xres_virtual = 0x1000;
2012#endif
2013 savagefb_check_var(&info->var, info);
2014 savagefb_set_fix(info);
2015
2016 /*
2017 * Calculate the hsync and vsync frequencies. Note that
2018 * we split the 1e12 constant up so that we can preserve
2019 * the precision and fit the results into 32-bit registers.
2020 * (1953125000 * 512 = 1e12)
2021 */
2022 h_sync = 1953125000 / info->var.pixclock;
2023 h_sync = h_sync * 512 / (info->var.xres + info->var.left_margin +
2024 info->var.right_margin +
2025 info->var.hsync_len);
2026 v_sync = h_sync / (info->var.yres + info->var.upper_margin +
2027 info->var.lower_margin + info->var.vsync_len);
2028
2029 printk(KERN_INFO "savagefb v" SAVAGEFB_VERSION ": "
2030 "%dkB VRAM, using %dx%d, %d.%03dkHz, %dHz\n",
2031 info->fix.smem_len >> 10,
2032 info->var.xres, info->var.yres,
2033 h_sync / 1000, h_sync % 1000, v_sync);
2034
2035
2036 fb_destroy_modedb(info->monspecs.modedb);
2037 info->monspecs.modedb = NULL;
2038
2039 err = register_framebuffer (info);
2040 if (err < 0)
2041 goto failed;
2042
2043 printk (KERN_INFO "fb: S3 %s frame buffer device\n",
2044 info->fix.id);
2045
2046 /*
2047 * Our driver data
2048 */
2049 pci_set_drvdata(dev, info);
2050
2051 return 0;
2052
2053 failed:
2054#ifdef CONFIG_FB_SAVAGE_I2C
2055 savagefb_delete_i2c_busses(info);
2056#endif
2057 fb_alloc_cmap (&info->cmap, 0, 0);
2058 savage_unmap_video(info);
2059 failed_video:
2060 savage_unmap_mmio (info);
2061 failed_mmio:
2062 kfree(info->pixmap.addr);
2063 failed_init:
2064 pci_release_regions(dev);
2065 failed_enable:
2066 framebuffer_release(info);
2067
2068 return err;
2069}
2070
2071static void __devexit savagefb_remove (struct pci_dev *dev)
2072{
2073 struct fb_info *info =
2074 (struct fb_info *)pci_get_drvdata(dev);
2075
2076 DBG("savagefb_remove");
2077
2078 if (info) {
2079 /*
2080 * If unregister_framebuffer fails, then
2081 * we will be leaving hooks that could cause
2082 * oopsen laying around.
2083 */
2084 if (unregister_framebuffer (info))
2085 printk (KERN_WARNING "savagefb: danger danger! "
2086 "Oopsen imminent!\n");
2087
2088#ifdef CONFIG_FB_SAVAGE_I2C
2089 savagefb_delete_i2c_busses(info);
2090#endif
2091 fb_alloc_cmap (&info->cmap, 0, 0);
2092 savage_unmap_video (info);
2093 savage_unmap_mmio (info);
2094 kfree(info->pixmap.addr);
2095 pci_release_regions(dev);
2096 framebuffer_release(info);
2097
2098 /*
2099 * Ensure that the driver data is no longer
2100 * valid.
2101 */
2102 pci_set_drvdata(dev, NULL);
2103 }
2104}
2105
2106static int savagefb_suspend (struct pci_dev* dev, u32 state)
2107{
2108 struct fb_info *info =
2109 (struct fb_info *)pci_get_drvdata(dev);
2110 struct savagefb_par *par = (struct savagefb_par *)info->par;
2111
2112 DBG("savagefb_suspend");
2113 printk(KERN_DEBUG "state: %u\n", state);
2114
2115 acquire_console_sem();
2116 fb_set_suspend(info, state);
2117 savage_disable_mmio(par);
2118 release_console_sem();
2119
2120 pci_disable_device(dev);
2121 pci_set_power_state(dev, state);
2122
2123 return 0;
2124}
2125
2126static int savagefb_resume (struct pci_dev* dev)
2127{
2128 struct fb_info *info =
2129 (struct fb_info *)pci_get_drvdata(dev);
2130 struct savagefb_par *par = (struct savagefb_par *)info->par;
2131
2132 DBG("savage_resume");
2133
2134 pci_set_power_state(dev, 0);
2135 pci_restore_state(dev);
2136 if(pci_enable_device(dev))
2137 DBG("err");
2138
2139 SavagePrintRegs();
2140
2141 acquire_console_sem();
2142
2143 savage_enable_mmio(par);
2144 savage_init_hw(par);
2145 savagefb_set_par (info);
2146
2147 fb_set_suspend (info, 0);
2148 release_console_sem();
2149
2150 return 0;
2151}
2152
2153
2154static struct pci_device_id savagefb_devices[] __devinitdata = {
2155 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_MX128,
2156 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2157
2158 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_MX64,
2159 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2160
2161 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_MX64C,
2162 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2163
2164 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IX128SDR,
2165 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2166
2167 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IX128DDR,
2168 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2169
2170 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IX64SDR,
2171 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2172
2173 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IX64DDR,
2174 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2175
2176 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IXCSDR,
2177 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2178
2179 {PCI_VENDOR_ID_S3, PCI_CHIP_SUPSAV_IXCDDR,
2180 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SUPERSAVAGE},
2181
2182 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE4,
2183 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE4},
2184
2185 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE3D,
2186 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE3D},
2187
2188 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE3D_MV,
2189 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE3D_MV},
2190
2191 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE2000,
2192 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE2000},
2193
2194 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE_MX_MV,
2195 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE_MX_MV},
2196
2197 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE_MX,
2198 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE_MX},
2199
2200 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE_IX_MV,
2201 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE_IX_MV},
2202
2203 {PCI_VENDOR_ID_S3, PCI_CHIP_SAVAGE_IX,
2204 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_SAVAGE_IX},
2205
2206 {PCI_VENDOR_ID_S3, PCI_CHIP_PROSAVAGE_PM,
2207 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_PROSAVAGE_PM},
2208
2209 {PCI_VENDOR_ID_S3, PCI_CHIP_PROSAVAGE_KM,
2210 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_PROSAVAGE_KM},
2211
2212 {PCI_VENDOR_ID_S3, PCI_CHIP_S3TWISTER_P,
2213 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_S3TWISTER_P},
2214
2215 {PCI_VENDOR_ID_S3, PCI_CHIP_S3TWISTER_K,
2216 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_S3TWISTER_K},
2217
2218 {PCI_VENDOR_ID_S3, PCI_CHIP_PROSAVAGE_DDR,
2219 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_PROSAVAGE_DDR},
2220
2221 {PCI_VENDOR_ID_S3, PCI_CHIP_PROSAVAGE_DDRK,
2222 PCI_ANY_ID, PCI_ANY_ID, 0, 0, FB_ACCEL_PROSAVAGE_DDRK},
2223
2224 {0, 0, 0, 0, 0, 0, 0}
2225};
2226
2227MODULE_DEVICE_TABLE(pci, savagefb_devices);
2228
2229static struct pci_driver savagefb_driver = {
2230 .name = "savagefb",
2231 .id_table = savagefb_devices,
2232 .probe = savagefb_probe,
2233 .suspend = savagefb_suspend,
2234 .resume = savagefb_resume,
2235 .remove = __devexit_p(savagefb_remove)
2236};
2237
2238/* **************************** exit-time only **************************** */
2239
2240static void __exit savage_done (void)
2241{
2242 DBG("savage_done");
2243 pci_unregister_driver (&savagefb_driver);
2244}
2245
2246
2247/* ************************* init in-kernel code ************************** */
2248
2249static int __init savagefb_setup(char *options)
2250{
2251#ifndef MODULE
2252 char *this_opt;
2253
2254 if (!options || !*options)
2255 return 0;
2256
2257 while ((this_opt = strsep(&options, ",")) != NULL) {
2258 mode_option = this_opt;
2259 }
2260#endif /* !MODULE */
2261 return 0;
2262}
2263
2264static int __init savagefb_init(void)
2265{
2266 char *option;
2267
2268 DBG("savagefb_init");
2269
2270 if (fb_get_options("savagefb", &option))
2271 return -ENODEV;
2272
2273 savagefb_setup(option);
2274 return pci_register_driver (&savagefb_driver);
2275
2276}
2277
2278module_init(savagefb_init);
2279module_exit(savage_done);
generated by cgit v1.2.2 (git 2.25.0) at 2024-09-24 19:25:57 -0400