2 * linux/drivers/video/savage/savagefb-i2c.c - S3 Savage DDC2
4 * Copyright 2004 Antonino A. Daplas <adaplas @pol.net>
6 * Based partly on rivafb-i2c.c
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
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>
23 #define SAVAGE_DDC 0x50
25 #define VGA_CR_IX 0x3d4
26 #define VGA_CR_DATA 0x3d5
28 #define CR_SERIAL1 0xa0 /* I2C serial communications interface */
29 #define MM_SERIAL1 0xff20
30 #define CR_SERIAL2 0xb1 /* DDC2 monitor communications interface */
32 /* based on vt8365 documentation */
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
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
45 static void savage4_gpio_setscl(void *data, int val)
47 struct savagefb_i2c_chan *chan = data;
50 r = readl(chan->ioaddr + chan->reg);
52 r |= SAVAGE4_I2C_SCL_OUT;
54 r &= ~SAVAGE4_I2C_SCL_OUT;
55 writel(r, chan->ioaddr + chan->reg);
56 readl(chan->ioaddr + chan->reg); /* flush posted write */
59 static void savage4_gpio_setsda(void *data, int val)
61 struct savagefb_i2c_chan *chan = data;
64 r = readl(chan->ioaddr + chan->reg);
66 r |= SAVAGE4_I2C_SDA_OUT;
68 r &= ~SAVAGE4_I2C_SDA_OUT;
69 writel(r, chan->ioaddr + chan->reg);
70 readl(chan->ioaddr + chan->reg); /* flush posted write */
73 static int savage4_gpio_getscl(void *data)
75 struct savagefb_i2c_chan *chan = data;
77 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SCL_IN));
80 static int savage4_gpio_getsda(void *data)
82 struct savagefb_i2c_chan *chan = data;
84 return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SDA_IN));
87 static void prosavage_gpio_setscl(void* data, int val)
89 struct savagefb_i2c_chan *chan = data;
92 r = VGArCR(chan->reg, chan->par);
93 r |= PROSAVAGE_I2C_ENAB;
95 r |= PROSAVAGE_I2C_SCL_OUT;
97 r &= ~PROSAVAGE_I2C_SCL_OUT;
100 VGAwCR(chan->reg, r, chan->par);
103 static void prosavage_gpio_setsda(void* data, int val)
105 struct savagefb_i2c_chan *chan = data;
108 r = VGArCR(chan->reg, chan->par);
109 r |= PROSAVAGE_I2C_ENAB;
111 r |= PROSAVAGE_I2C_SDA_OUT;
113 r &= ~PROSAVAGE_I2C_SDA_OUT;
116 VGAwCR(chan->reg, r, chan->par);
119 static int prosavage_gpio_getscl(void* data)
121 struct savagefb_i2c_chan *chan = data;
123 return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SCL_IN) ? 1 : 0;
126 static int prosavage_gpio_getsda(void* data)
128 struct savagefb_i2c_chan *chan = data;
130 return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SDA_IN) ? 1 : 0;
133 static int savage_setup_i2c_bus(struct savagefb_i2c_chan *chan,
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;
147 i2c_set_adapdata(&chan->adapter, chan);
149 /* Raise SCL and SDA */
150 chan->algo.setsda(chan, 1);
151 chan->algo.setscl(chan, 1);
154 rc = i2c_bit_add_bus(&chan->adapter);
157 dev_dbg(&chan->par->pcidev->dev,
158 "I2C bus %s registered.\n", name);
160 dev_warn(&chan->par->pcidev->dev,
161 "Failed to register I2C bus %s.\n", name);
167 void savagefb_create_i2c_busses(struct fb_info *info)
169 struct savagefb_par *par = info->par;
174 par->chan.reg = CR_SERIAL2;
175 par->chan.ioaddr = par->mmio.vbase;
176 par->chan.algo.setsda = prosavage_gpio_setsda;
177 par->chan.algo.setscl = prosavage_gpio_setscl;
178 par->chan.algo.getsda = prosavage_gpio_getsda;
179 par->chan.algo.getscl = prosavage_gpio_getscl;
182 par->chan.reg = CR_SERIAL1;
183 if (par->pcidev->revision > 1 && !(VGArCR(0xa6, par) & 0x40))
184 par->chan.reg = CR_SERIAL2;
185 par->chan.ioaddr = par->mmio.vbase;
186 par->chan.algo.setsda = prosavage_gpio_setsda;
187 par->chan.algo.setscl = prosavage_gpio_setscl;
188 par->chan.algo.getsda = prosavage_gpio_getsda;
189 par->chan.algo.getscl = prosavage_gpio_getscl;
192 par->chan.reg = MM_SERIAL1;
193 par->chan.ioaddr = par->mmio.vbase;
194 par->chan.algo.setsda = savage4_gpio_setsda;
195 par->chan.algo.setscl = savage4_gpio_setscl;
196 par->chan.algo.getsda = savage4_gpio_getsda;
197 par->chan.algo.getscl = savage4_gpio_getscl;
200 par->chan.par = NULL;
203 savage_setup_i2c_bus(&par->chan, "SAVAGE DDC2");
206 void savagefb_delete_i2c_busses(struct fb_info *info)
208 struct savagefb_par *par = info->par;
211 i2c_del_adapter(&par->chan.adapter);
213 par->chan.par = NULL;
216 int savagefb_probe_i2c_connector(struct fb_info *info, u8 **out_edid)
218 struct savagefb_par *par = info->par;
222 edid = fb_ddc_read(&par->chan.adapter);
227 /* try to get from firmware */
228 const u8 *e = fb_firmware_edid(info->device);
231 edid = kmemdup(e, EDID_LENGTH, GFP_KERNEL);
236 return (edid) ? 0 : 1;
239 MODULE_LICENSE("GPL");