diff options
Diffstat (limited to 'drivers/video/aty/radeon_i2c.c')
-rw-r--r-- | drivers/video/aty/radeon_i2c.c | 265 |
1 files changed, 265 insertions, 0 deletions
diff --git a/drivers/video/aty/radeon_i2c.c b/drivers/video/aty/radeon_i2c.c new file mode 100644 index 000000000000..762244164c81 --- /dev/null +++ b/drivers/video/aty/radeon_i2c.c | |||
@@ -0,0 +1,265 @@ | |||
1 | #include <linux/config.h> | ||
2 | #include <linux/module.h> | ||
3 | #include <linux/kernel.h> | ||
4 | #include <linux/sched.h> | ||
5 | #include <linux/delay.h> | ||
6 | #include <linux/pci.h> | ||
7 | #include <linux/fb.h> | ||
8 | |||
9 | |||
10 | #include <linux/i2c.h> | ||
11 | #include <linux/i2c-id.h> | ||
12 | #include <linux/i2c-algo-bit.h> | ||
13 | |||
14 | #include <asm/io.h> | ||
15 | |||
16 | #include <video/radeon.h> | ||
17 | #include "radeonfb.h" | ||
18 | #include "../edid.h" | ||
19 | |||
20 | #define RADEON_DDC 0x50 | ||
21 | |||
22 | static void radeon_gpio_setscl(void* data, int state) | ||
23 | { | ||
24 | struct radeon_i2c_chan *chan = data; | ||
25 | struct radeonfb_info *rinfo = chan->rinfo; | ||
26 | u32 val; | ||
27 | |||
28 | val = INREG(chan->ddc_reg) & ~(VGA_DDC_CLK_OUT_EN); | ||
29 | if (!state) | ||
30 | val |= VGA_DDC_CLK_OUT_EN; | ||
31 | |||
32 | OUTREG(chan->ddc_reg, val); | ||
33 | (void)INREG(chan->ddc_reg); | ||
34 | } | ||
35 | |||
36 | static void radeon_gpio_setsda(void* data, int state) | ||
37 | { | ||
38 | struct radeon_i2c_chan *chan = data; | ||
39 | struct radeonfb_info *rinfo = chan->rinfo; | ||
40 | u32 val; | ||
41 | |||
42 | val = INREG(chan->ddc_reg) & ~(VGA_DDC_DATA_OUT_EN); | ||
43 | if (!state) | ||
44 | val |= VGA_DDC_DATA_OUT_EN; | ||
45 | |||
46 | OUTREG(chan->ddc_reg, val); | ||
47 | (void)INREG(chan->ddc_reg); | ||
48 | } | ||
49 | |||
50 | static int radeon_gpio_getscl(void* data) | ||
51 | { | ||
52 | struct radeon_i2c_chan *chan = data; | ||
53 | struct radeonfb_info *rinfo = chan->rinfo; | ||
54 | u32 val; | ||
55 | |||
56 | val = INREG(chan->ddc_reg); | ||
57 | |||
58 | return (val & VGA_DDC_CLK_INPUT) ? 1 : 0; | ||
59 | } | ||
60 | |||
61 | static int radeon_gpio_getsda(void* data) | ||
62 | { | ||
63 | struct radeon_i2c_chan *chan = data; | ||
64 | struct radeonfb_info *rinfo = chan->rinfo; | ||
65 | u32 val; | ||
66 | |||
67 | val = INREG(chan->ddc_reg); | ||
68 | |||
69 | return (val & VGA_DDC_DATA_INPUT) ? 1 : 0; | ||
70 | } | ||
71 | |||
72 | static int radeon_setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name) | ||
73 | { | ||
74 | int rc; | ||
75 | |||
76 | strcpy(chan->adapter.name, name); | ||
77 | chan->adapter.owner = THIS_MODULE; | ||
78 | chan->adapter.id = I2C_ALGO_ATI; | ||
79 | chan->adapter.algo_data = &chan->algo; | ||
80 | chan->adapter.dev.parent = &chan->rinfo->pdev->dev; | ||
81 | chan->algo.setsda = radeon_gpio_setsda; | ||
82 | chan->algo.setscl = radeon_gpio_setscl; | ||
83 | chan->algo.getsda = radeon_gpio_getsda; | ||
84 | chan->algo.getscl = radeon_gpio_getscl; | ||
85 | chan->algo.udelay = 40; | ||
86 | chan->algo.timeout = 20; | ||
87 | chan->algo.data = chan; | ||
88 | |||
89 | i2c_set_adapdata(&chan->adapter, chan); | ||
90 | |||
91 | /* Raise SCL and SDA */ | ||
92 | radeon_gpio_setsda(chan, 1); | ||
93 | radeon_gpio_setscl(chan, 1); | ||
94 | udelay(20); | ||
95 | |||
96 | rc = i2c_bit_add_bus(&chan->adapter); | ||
97 | if (rc == 0) | ||
98 | dev_dbg(&chan->rinfo->pdev->dev, "I2C bus %s registered.\n", name); | ||
99 | else | ||
100 | dev_warn(&chan->rinfo->pdev->dev, "Failed to register I2C bus %s.\n", name); | ||
101 | return rc; | ||
102 | } | ||
103 | |||
104 | void radeon_create_i2c_busses(struct radeonfb_info *rinfo) | ||
105 | { | ||
106 | rinfo->i2c[0].rinfo = rinfo; | ||
107 | rinfo->i2c[0].ddc_reg = GPIO_MONID; | ||
108 | radeon_setup_i2c_bus(&rinfo->i2c[0], "monid"); | ||
109 | |||
110 | rinfo->i2c[1].rinfo = rinfo; | ||
111 | rinfo->i2c[1].ddc_reg = GPIO_DVI_DDC; | ||
112 | radeon_setup_i2c_bus(&rinfo->i2c[1], "dvi"); | ||
113 | |||
114 | rinfo->i2c[2].rinfo = rinfo; | ||
115 | rinfo->i2c[2].ddc_reg = GPIO_VGA_DDC; | ||
116 | radeon_setup_i2c_bus(&rinfo->i2c[2], "vga"); | ||
117 | |||
118 | rinfo->i2c[3].rinfo = rinfo; | ||
119 | rinfo->i2c[3].ddc_reg = GPIO_CRT2_DDC; | ||
120 | radeon_setup_i2c_bus(&rinfo->i2c[3], "crt2"); | ||
121 | } | ||
122 | |||
123 | void radeon_delete_i2c_busses(struct radeonfb_info *rinfo) | ||
124 | { | ||
125 | if (rinfo->i2c[0].rinfo) | ||
126 | i2c_bit_del_bus(&rinfo->i2c[0].adapter); | ||
127 | rinfo->i2c[0].rinfo = NULL; | ||
128 | |||
129 | if (rinfo->i2c[1].rinfo) | ||
130 | i2c_bit_del_bus(&rinfo->i2c[1].adapter); | ||
131 | rinfo->i2c[1].rinfo = NULL; | ||
132 | |||
133 | if (rinfo->i2c[2].rinfo) | ||
134 | i2c_bit_del_bus(&rinfo->i2c[2].adapter); | ||
135 | rinfo->i2c[2].rinfo = NULL; | ||
136 | |||
137 | if (rinfo->i2c[3].rinfo) | ||
138 | i2c_bit_del_bus(&rinfo->i2c[3].adapter); | ||
139 | rinfo->i2c[3].rinfo = NULL; | ||
140 | } | ||
141 | |||
142 | |||
143 | static u8 *radeon_do_probe_i2c_edid(struct radeon_i2c_chan *chan) | ||
144 | { | ||
145 | u8 start = 0x0; | ||
146 | struct i2c_msg msgs[] = { | ||
147 | { | ||
148 | .addr = RADEON_DDC, | ||
149 | .len = 1, | ||
150 | .buf = &start, | ||
151 | }, { | ||
152 | .addr = RADEON_DDC, | ||
153 | .flags = I2C_M_RD, | ||
154 | .len = EDID_LENGTH, | ||
155 | }, | ||
156 | }; | ||
157 | u8 *buf; | ||
158 | |||
159 | buf = kmalloc(EDID_LENGTH, GFP_KERNEL); | ||
160 | if (!buf) { | ||
161 | dev_warn(&chan->rinfo->pdev->dev, "Out of memory!\n"); | ||
162 | return NULL; | ||
163 | } | ||
164 | msgs[1].buf = buf; | ||
165 | |||
166 | if (i2c_transfer(&chan->adapter, msgs, 2) == 2) | ||
167 | return buf; | ||
168 | dev_dbg(&chan->rinfo->pdev->dev, "Unable to read EDID block.\n"); | ||
169 | kfree(buf); | ||
170 | return NULL; | ||
171 | } | ||
172 | |||
173 | |||
174 | int radeon_probe_i2c_connector(struct radeonfb_info *rinfo, int conn, u8 **out_edid) | ||
175 | { | ||
176 | u32 reg = rinfo->i2c[conn-1].ddc_reg; | ||
177 | u8 *edid = NULL; | ||
178 | int i, j; | ||
179 | |||
180 | OUTREG(reg, INREG(reg) & | ||
181 | ~(VGA_DDC_DATA_OUTPUT | VGA_DDC_CLK_OUTPUT)); | ||
182 | |||
183 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_CLK_OUT_EN)); | ||
184 | (void)INREG(reg); | ||
185 | |||
186 | for (i = 0; i < 3; i++) { | ||
187 | /* For some old monitors we need the | ||
188 | * following process to initialize/stop DDC | ||
189 | */ | ||
190 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_DATA_OUT_EN)); | ||
191 | (void)INREG(reg); | ||
192 | msleep(13); | ||
193 | |||
194 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_CLK_OUT_EN)); | ||
195 | (void)INREG(reg); | ||
196 | for (j = 0; j < 5; j++) { | ||
197 | msleep(10); | ||
198 | if (INREG(reg) & VGA_DDC_CLK_INPUT) | ||
199 | break; | ||
200 | } | ||
201 | if (j == 5) | ||
202 | continue; | ||
203 | |||
204 | OUTREG(reg, INREG(reg) | VGA_DDC_DATA_OUT_EN); | ||
205 | (void)INREG(reg); | ||
206 | msleep(15); | ||
207 | OUTREG(reg, INREG(reg) | VGA_DDC_CLK_OUT_EN); | ||
208 | (void)INREG(reg); | ||
209 | msleep(15); | ||
210 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_DATA_OUT_EN)); | ||
211 | (void)INREG(reg); | ||
212 | msleep(15); | ||
213 | |||
214 | /* Do the real work */ | ||
215 | edid = radeon_do_probe_i2c_edid(&rinfo->i2c[conn-1]); | ||
216 | |||
217 | OUTREG(reg, INREG(reg) | | ||
218 | (VGA_DDC_DATA_OUT_EN | VGA_DDC_CLK_OUT_EN)); | ||
219 | (void)INREG(reg); | ||
220 | msleep(15); | ||
221 | |||
222 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_CLK_OUT_EN)); | ||
223 | (void)INREG(reg); | ||
224 | for (j = 0; j < 10; j++) { | ||
225 | msleep(10); | ||
226 | if (INREG(reg) & VGA_DDC_CLK_INPUT) | ||
227 | break; | ||
228 | } | ||
229 | |||
230 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_DATA_OUT_EN)); | ||
231 | (void)INREG(reg); | ||
232 | msleep(15); | ||
233 | OUTREG(reg, INREG(reg) | | ||
234 | (VGA_DDC_DATA_OUT_EN | VGA_DDC_CLK_OUT_EN)); | ||
235 | (void)INREG(reg); | ||
236 | if (edid) | ||
237 | break; | ||
238 | } | ||
239 | /* Release the DDC lines when done or the Apple Cinema HD display | ||
240 | * will switch off | ||
241 | */ | ||
242 | OUTREG(reg, INREG(reg) & ~(VGA_DDC_CLK_OUT_EN | VGA_DDC_DATA_OUT_EN)); | ||
243 | (void)INREG(reg); | ||
244 | |||
245 | if (out_edid) | ||
246 | *out_edid = edid; | ||
247 | if (!edid) { | ||
248 | RTRACE("radeonfb: I2C (port %d) ... not found\n", conn); | ||
249 | return MT_NONE; | ||
250 | } | ||
251 | if (edid[0x14] & 0x80) { | ||
252 | /* Fix detection using BIOS tables */ | ||
253 | if (rinfo->is_mobility /*&& conn == ddc_dvi*/ && | ||
254 | (INREG(LVDS_GEN_CNTL) & LVDS_ON)) { | ||
255 | RTRACE("radeonfb: I2C (port %d) ... found LVDS panel\n", conn); | ||
256 | return MT_LCD; | ||
257 | } else { | ||
258 | RTRACE("radeonfb: I2C (port %d) ... found TMDS panel\n", conn); | ||
259 | return MT_DFP; | ||
260 | } | ||
261 | } | ||
262 | RTRACE("radeonfb: I2C (port %d) ... found CRT display\n", conn); | ||
263 | return MT_CRT; | ||
264 | } | ||
265 | |||