fbdev/savage/savagefb-i2c.c

47 	struct savagefb_i2c_chan *chan = data;
50 	r = readl(chan->ioaddr + chan->reg);
55 	writel(r, chan->ioaddr + chan->reg);
56 	readl(chan->ioaddr + chan->reg);	/* flush posted write */
61 	struct savagefb_i2c_chan *chan = data;
64 	r = readl(chan->ioaddr + chan->reg);
69 	writel(r, chan->ioaddr + chan->reg);
70 	readl(chan->ioaddr + chan->reg);	/* flush posted write */
75 	struct savagefb_i2c_chan *chan = data;
77 	return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SCL_IN));
82 	struct savagefb_i2c_chan *chan = data;
84 	return (0 != (readl(chan->ioaddr + chan->reg) & SAVAGE4_I2C_SDA_IN));
89 	struct savagefb_i2c_chan *chan = data;
92 	r = VGArCR(chan->reg, chan->par);
100 	VGAwCR(chan->reg, r, chan->par);
105 	struct savagefb_i2c_chan *chan = data;
108 	r = VGArCR(chan->reg, chan->par);
116 	VGAwCR(chan->reg, r, chan->par);
121 	struct savagefb_i2c_chan *chan = data;
123 	return (VGArCR(chan->reg, chan->par) & PROSAVAGE_I2C_SCL_IN) ? 1 : 0;
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,
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;
147 		i2c_set_adapdata(&chan->adapter, chan);
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,
160 			dev_warn(&chan->par->pcidev->dev,
170 	par->chan.par	= par;
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;
184 		par->chan.reg = CR_SERIAL1;
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;
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;
202 		par->chan.par = NULL;
205 	savage_setup_i2c_bus(&par->chan, "SAVAGE DDC2");
212 	if (par->chan.par)
213 		i2c_del_adapter(&par->chan.adapter);
215 	par->chan.par = NULL;
223 	if (par->chan.par)
224 		edid = fb_ddc_read(&par->chan.adapter);