1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/module.h>
14#include <linux/kernel.h>
15#include <linux/delay.h>
16#include <linux/gfp.h>
17#include <linux/pci.h>
18#include <linux/fb.h>
19
20#include <asm/io.h>
21#include "savagefb.h"
22
23#define SAVAGE_DDC 0x50
24
25#define VGA_CR_IX 0x3d4
26#define VGA_CR_DATA 0x3d5
27
28#define CR_SERIAL1 0xa0
29#define MM_SERIAL1 0xff20
30#define CR_SERIAL2 0xb1
31
32
33#define PROSAVAGE_I2C_ENAB 0x10
34#define PROSAVAGE_I2C_SCL_OUT 0x01
35#define PROSAVAGE_I2C_SDA_OUT 0x02
36#define PROSAVAGE_I2C_SCL_IN 0x04
37#define PROSAVAGE_I2C_SDA_IN 0x08
38
39#define SAVAGE4_I2C_ENAB 0x00000020
40#define SAVAGE4_I2C_SCL_OUT 0x00000001
41#define SAVAGE4_I2C_SDA_OUT 0x00000002
42#define SAVAGE4_I2C_SCL_IN 0x00000008
43#define SAVAGE4_I2C_SDA_IN 0x00000010
44
45static void savage4_gpio_setscl(void *data, int val)
46{
47 struct savagefb_i2c_chan *chan = data;
48 unsigned int r;
49
50 r = readl(chan->ioaddr + chan->reg);
51 if(val)
52 r |= SAVAGE4_I2C_SCL_OUT;
53 else
54 r &= ~SAVAGE4_I2C_SCL_OUT;
55 writel(r, chan->ioaddr + chan->reg);
56 readl(chan->ioaddr + chan->reg);
57}
58
59static void savage4_gpio_setsda(void *data, int val)
60{
61 struct savagefb_i2c_chan *chan = data;
62
63 unsigned int r;
64 r = readl(chan->ioaddr + chan->reg);
65 if(val)
66 r |= SAVAGE4_I2C_SDA_OUT;
67 else
68 r &= ~SAVAGE4_I2C_SDA_OUT;
69 writel(r, chan->ioaddr + chan->reg);
70 readl(chan->ioaddr + chan->reg);
71}
72
73static int savage4_gpio_getscl(void *data)
74{
75 struct savagefb_i2c_chan *chan = data;
76
77 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SCL_IN));
78}
79
80static int savage4_gpio_getsda(void *data)
81{
82 struct savagefb_i2c_chan *chan = data;
83
84 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SDA_IN));
85}
86
87static void prosavage_gpio_setscl(void* data, int val)
88{
89 struct savagefb_i2c_chan *chan = data;
90 u32 r;
91
92 r = VGArCR(chan->reg, chan->par);
93 r |= PROSAVAGE_I2C_ENAB;
94 if (val) {
95 r |= PROSAVAGE_I2C_SCL_OUT;
96 } else {
97 r &= ~PROSAVAGE_I2C_SCL_OUT;
98 }
99
100 VGAwCR(chan->reg, r, chan->par);
101}
102
103static void prosavage_gpio_setsda(void* data, int val)
104{
105 struct savagefb_i2c_chan *chan = data;
106 unsigned int r;
107
108 r = VGArCR(chan->reg, chan->par);
109 r |= PROSAVAGE_I2C_ENAB;
110 if (val) {
111 r |= PROSAVAGE_I2C_SDA_OUT;
112 } else {
113 r &= ~PROSAVAGE_I2C_SDA_OUT;
114 }
115
116 VGAwCR(chan->reg, r, chan->par);
117}
118
119static int prosavage_gpio_getscl(void* data)
120{
121 struct savagefb_i2c_chan *chan = data;
122
123 return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SCL_IN) ? 1 : 0;
124}
125
126static int prosavage_gpio_getsda(void* data)
127{
128 struct savagefb_i2c_chan *chan = data;
129
130 return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SDA_IN) ? 1 : 0;
131}
132
133static int savage_setup_i2c_bus(struct savagefb_i2c_chan *chan,
134 const char *name)
135{
136 int rc = 0;
137
138 if (chan->par) {
139 strcpy(chan->adapter.name, name);
140 chan->adapter.owner = THIS_MODULE;
141 chan->adapter.algo_data = &chan->algo;
142 chan->adapter.dev.parent = &chan->par->pcidev->dev;
143 chan->algo.udelay = 10;
144 chan->algo.timeout = 20;
145 chan->algo.data = chan;
146
147 i2c_set_adapdata(&chan->adapter, chan);
148
149
150 chan->algo.setsda(chan, 1);
151 chan->algo.setscl(chan, 1);
152 udelay(20);
153
154 rc = i2c_bit_add_bus(&chan->adapter);
155
156 if (rc == 0)
157 dev_dbg(&chan->par->pcidev->dev,
158 "I2C bus %s registered.\n", name);
159 else
160 dev_warn(&chan->par->pcidev->dev,
161 "Failed to register I2C bus %s.\n", name);
162 }
163
164 return rc;
165}
166
167void savagefb_create_i2c_busses(struct fb_info *info)
168{
169 struct savagefb_par *par = info->par;
170 par->chan.par = par;
171
172 switch (par->chip) {
173 case S3_PROSAVAGE:
174 case S3_PROSAVAGEDDR:
175 case S3_TWISTER:
176 par->chan.reg = CR_SERIAL2;
177 par->chan.ioaddr = par->mmio.vbase;
178 par->chan.algo.setsda = prosavage_gpio_setsda;
179 par->chan.algo.setscl = prosavage_gpio_setscl;
180 par->chan.algo.getsda = prosavage_gpio_getsda;
181 par->chan.algo.getscl = prosavage_gpio_getscl;
182 break;
183 case S3_SAVAGE4:
184 par->chan.reg = CR_SERIAL1;
185 if (par->pcidev->revision > 1 && !(VGArCR(0xa6, par) & 0x40))
186 par->chan.reg = CR_SERIAL2;
187 par->chan.ioaddr = par->mmio.vbase;
188 par->chan.algo.setsda = prosavage_gpio_setsda;
189 par->chan.algo.setscl = prosavage_gpio_setscl;
190 par->chan.algo.getsda = prosavage_gpio_getsda;
191 par->chan.algo.getscl = prosavage_gpio_getscl;
192 break;
193 case S3_SAVAGE2000:
194 par->chan.reg = MM_SERIAL1;
195 par->chan.ioaddr = par->mmio.vbase;
196 par->chan.algo.setsda = savage4_gpio_setsda;
197 par->chan.algo.setscl = savage4_gpio_setscl;
198 par->chan.algo.getsda = savage4_gpio_getsda;
199 par->chan.algo.getscl = savage4_gpio_getscl;
200 break;
201 default:
202 par->chan.par = NULL;
203 }
204
205 savage_setup_i2c_bus(&par->chan, "SAVAGE DDC2");
206}
207
208void savagefb_delete_i2c_busses(struct fb_info *info)
209{
210 struct savagefb_par *par = info->par;
211
212 if (par->chan.par)
213 i2c_del_adapter(&par->chan.adapter);
214
215 par->chan.par = NULL;
216}
217
218int savagefb_probe_i2c_connector(struct fb_info *info, u8 **out_edid)
219{
220 struct savagefb_par *par = info->par;
221 u8 *edid;
222
223 if (par->chan.par)
224 edid = fb_ddc_read(&par->chan.adapter);
225 else
226 edid = NULL;
227
228 if (!edid) {
229
230 const u8 *e = fb_firmware_edid(info->device);
231
232 if (e)
233 edid = kmemdup(e, EDID_LENGTH, GFP_KERNEL);
234 }
235
236 *out_edid = edid;
237
238 return (edid) ? 0 : 1;
239}
240
241MODULE_LICENSE("GPL");
242
