]>
git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blob - drivers/video/i810/i810-i2c.c
2 * linux/drivers/video/i810-i2c.c -- Intel 810/815 I2C support
4 * Copyright (C) 2004 Antonino Daplas<adaplas@pol.net>
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
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/sched.h>
14 #include <linux/delay.h>
15 #include <linux/pci.h>
18 #include "i810_regs.h"
19 #include "i810_main.h"
23 /* bit locations in the registers */
24 #define SCL_DIR_MASK 0x0001
25 #define SCL_DIR 0x0002
26 #define SCL_VAL_MASK 0x0004
27 #define SCL_VAL_OUT 0x0008
28 #define SCL_VAL_IN 0x0010
29 #define SDA_DIR_MASK 0x0100
30 #define SDA_DIR 0x0200
31 #define SDA_VAL_MASK 0x0400
32 #define SDA_VAL_OUT 0x0800
33 #define SDA_VAL_IN 0x1000
35 #define DEBUG /* define this for verbose EDID parsing output */
38 #define DPRINTK(fmt, args...) printk(fmt,## args)
40 #define DPRINTK(fmt, args...)
43 static void i810i2c_setscl(void *data
, int state
)
45 struct i810fb_i2c_chan
*chan
= data
;
46 struct i810fb_par
*par
= chan
->par
;
47 u8 __iomem
*mmio
= par
->mmio_start_virtual
;
49 i810_writel(mmio
, chan
->ddc_base
, (state
? SCL_VAL_OUT
: 0) | SCL_DIR
|
50 SCL_DIR_MASK
| SCL_VAL_MASK
);
51 i810_readl(mmio
, chan
->ddc_base
); /* flush posted write */
54 static void i810i2c_setsda(void *data
, int state
)
56 struct i810fb_i2c_chan
*chan
= data
;
57 struct i810fb_par
*par
= chan
->par
;
58 u8 __iomem
*mmio
= par
->mmio_start_virtual
;
60 i810_writel(mmio
, chan
->ddc_base
, (state
? SDA_VAL_OUT
: 0) | SDA_DIR
|
61 SDA_DIR_MASK
| SDA_VAL_MASK
);
62 i810_readl(mmio
, chan
->ddc_base
); /* flush posted write */
65 static int i810i2c_getscl(void *data
)
67 struct i810fb_i2c_chan
*chan
= data
;
68 struct i810fb_par
*par
= chan
->par
;
69 u8 __iomem
*mmio
= par
->mmio_start_virtual
;
71 i810_writel(mmio
, chan
->ddc_base
, SCL_DIR_MASK
);
72 i810_writel(mmio
, chan
->ddc_base
, 0);
73 return ((i810_readl(mmio
, chan
->ddc_base
) & SCL_VAL_IN
) != 0);
76 static int i810i2c_getsda(void *data
)
78 struct i810fb_i2c_chan
*chan
= data
;
79 struct i810fb_par
*par
= chan
->par
;
80 u8 __iomem
*mmio
= par
->mmio_start_virtual
;
82 i810_writel(mmio
, chan
->ddc_base
, SDA_DIR_MASK
);
83 i810_writel(mmio
, chan
->ddc_base
, 0);
84 return ((i810_readl(mmio
, chan
->ddc_base
) & SDA_VAL_IN
) != 0);
87 static int i810_setup_i2c_bus(struct i810fb_i2c_chan
*chan
, const char *name
)
91 strcpy(chan
->adapter
.name
, name
);
92 chan
->adapter
.owner
= THIS_MODULE
;
93 chan
->adapter
.algo_data
= &chan
->algo
;
94 chan
->adapter
.dev
.parent
= &chan
->par
->dev
->dev
;
95 chan
->adapter
.id
= I2C_HW_B_I810
;
96 chan
->algo
.setsda
= i810i2c_setsda
;
97 chan
->algo
.setscl
= i810i2c_setscl
;
98 chan
->algo
.getsda
= i810i2c_getsda
;
99 chan
->algo
.getscl
= i810i2c_getscl
;
100 chan
->algo
.udelay
= 10;
101 chan
->algo
.timeout
= (HZ
/2);
102 chan
->algo
.data
= chan
;
104 i2c_set_adapdata(&chan
->adapter
, chan
);
106 /* Raise SCL and SDA */
107 chan
->algo
.setsda(chan
, 1);
108 chan
->algo
.setscl(chan
, 1);
111 rc
= i2c_bit_add_bus(&chan
->adapter
);
114 dev_dbg(&chan
->par
->dev
->dev
, "I2C bus %s registered.\n",name
);
116 dev_warn(&chan
->par
->dev
->dev
, "Failed to register I2C bus "
124 void i810_create_i2c_busses(struct i810fb_par
*par
)
126 par
->chan
[0].par
= par
;
127 par
->chan
[1].par
= par
;
128 par
->chan
[2].par
= par
;
130 par
->chan
[0].ddc_base
= GPIOA
;
131 i810_setup_i2c_bus(&par
->chan
[0], "I810-DDC");
132 par
->chan
[1].ddc_base
= GPIOB
;
133 i810_setup_i2c_bus(&par
->chan
[1], "I810-I2C");
134 par
->chan
[2].ddc_base
= GPIOC
;
135 i810_setup_i2c_bus(&par
->chan
[2], "I810-GPIOC");
138 void i810_delete_i2c_busses(struct i810fb_par
*par
)
140 if (par
->chan
[0].par
)
141 i2c_bit_del_bus(&par
->chan
[0].adapter
);
142 par
->chan
[0].par
= NULL
;
144 if (par
->chan
[1].par
)
145 i2c_bit_del_bus(&par
->chan
[1].adapter
);
146 par
->chan
[1].par
= NULL
;
148 if (par
->chan
[2].par
)
149 i2c_bit_del_bus(&par
->chan
[2].adapter
);
150 par
->chan
[2].par
= NULL
;
153 static u8
*i810_do_probe_i2c_edid(struct i810fb_i2c_chan
*chan
)
156 struct i2c_msg msgs
[] = {
169 buf
= kmalloc(EDID_LENGTH
, GFP_KERNEL
);
171 DPRINTK("i810-i2c: Failed to allocate memory\n");
176 if (i2c_transfer(&chan
->adapter
, msgs
, 2) == 2) {
177 DPRINTK("i810-i2c: I2C Transfer successful\n");
181 DPRINTK("i810-i2c: Unable to read EDID block.\n");
186 int i810_probe_i2c_connector(struct fb_info
*info
, u8
**out_edid
, int conn
)
188 struct i810fb_par
*par
= info
->par
;
192 DPRINTK("i810-i2c: Probe DDC%i Bus\n", conn
+1);
193 if (conn
< par
->ddc_num
) {
194 for (i
= 0; i
< 3; i
++) {
195 /* Do the real work */
196 edid
= i810_do_probe_i2c_edid(&par
->chan
[conn
]);
201 const u8
*e
= fb_firmware_edid(info
->device
);
204 DPRINTK("i810-i2c: Getting EDID from BIOS\n");
205 edid
= kmalloc(EDID_LENGTH
, GFP_KERNEL
);
207 memcpy(edid
, e
, EDID_LENGTH
);
213 return (edid
) ? 0 : 1;