i2c: Delete many unused adapter IDs
[linux-2.6] / drivers / video / aty / radeon_i2c.c
1 #include "radeonfb.h"
2
3 #include <linux/module.h>
4 #include <linux/kernel.h>
5 #include <linux/delay.h>
6 #include <linux/fb.h>
7
8
9 #include <linux/i2c.h>
10 #include <linux/i2c-id.h>
11 #include <linux/i2c-algo-bit.h>
12
13 #include <asm/io.h>
14
15 #include <video/radeon.h>
16 #include "../edid.h"
17
18 static void radeon_gpio_setscl(void* data, int state)
19 {
20         struct radeon_i2c_chan  *chan = data;
21         struct radeonfb_info    *rinfo = chan->rinfo;
22         u32                     val;
23         
24         val = INREG(chan->ddc_reg) & ~(VGA_DDC_CLK_OUT_EN);
25         if (!state)
26                 val |= VGA_DDC_CLK_OUT_EN;
27
28         OUTREG(chan->ddc_reg, val);
29         (void)INREG(chan->ddc_reg);
30 }
31
32 static void radeon_gpio_setsda(void* data, int state)
33 {
34         struct radeon_i2c_chan  *chan = data;
35         struct radeonfb_info    *rinfo = chan->rinfo;
36         u32                     val;
37         
38         val = INREG(chan->ddc_reg) & ~(VGA_DDC_DATA_OUT_EN);
39         if (!state)
40                 val |= VGA_DDC_DATA_OUT_EN;
41
42         OUTREG(chan->ddc_reg, val);
43         (void)INREG(chan->ddc_reg);
44 }
45
46 static int radeon_gpio_getscl(void* data)
47 {
48         struct radeon_i2c_chan  *chan = data;
49         struct radeonfb_info    *rinfo = chan->rinfo;
50         u32                     val;
51         
52         val = INREG(chan->ddc_reg);
53
54         return (val & VGA_DDC_CLK_INPUT) ? 1 : 0;
55 }
56
57 static int radeon_gpio_getsda(void* data)
58 {
59         struct radeon_i2c_chan  *chan = data;
60         struct radeonfb_info    *rinfo = chan->rinfo;
61         u32                     val;
62         
63         val = INREG(chan->ddc_reg);
64
65         return (val & VGA_DDC_DATA_INPUT) ? 1 : 0;
66 }
67
68 static int radeon_setup_i2c_bus(struct radeon_i2c_chan *chan, const char *name)
69 {
70         int rc;
71
72         snprintf(chan->adapter.name, sizeof(chan->adapter.name),
73                  "radeonfb %s", name);
74         chan->adapter.owner             = THIS_MODULE;
75         chan->adapter.algo_data         = &chan->algo;
76         chan->adapter.dev.parent        = &chan->rinfo->pdev->dev;
77         chan->algo.setsda               = radeon_gpio_setsda;
78         chan->algo.setscl               = radeon_gpio_setscl;
79         chan->algo.getsda               = radeon_gpio_getsda;
80         chan->algo.getscl               = radeon_gpio_getscl;
81         chan->algo.udelay               = 10;
82         chan->algo.timeout              = 20;
83         chan->algo.data                 = chan; 
84         
85         i2c_set_adapdata(&chan->adapter, chan);
86         
87         /* Raise SCL and SDA */
88         radeon_gpio_setsda(chan, 1);
89         radeon_gpio_setscl(chan, 1);
90         udelay(20);
91
92         rc = i2c_bit_add_bus(&chan->adapter);
93         if (rc == 0)
94                 dev_dbg(&chan->rinfo->pdev->dev, "I2C bus %s registered.\n", name);
95         else
96                 dev_warn(&chan->rinfo->pdev->dev, "Failed to register I2C bus %s.\n", name);
97         return rc;
98 }
99
100 void radeon_create_i2c_busses(struct radeonfb_info *rinfo)
101 {
102         rinfo->i2c[0].rinfo     = rinfo;
103         rinfo->i2c[0].ddc_reg   = GPIO_MONID;
104         radeon_setup_i2c_bus(&rinfo->i2c[0], "monid");
105
106         rinfo->i2c[1].rinfo     = rinfo;
107         rinfo->i2c[1].ddc_reg   = GPIO_DVI_DDC;
108         radeon_setup_i2c_bus(&rinfo->i2c[1], "dvi");
109
110         rinfo->i2c[2].rinfo     = rinfo;
111         rinfo->i2c[2].ddc_reg   = GPIO_VGA_DDC;
112         radeon_setup_i2c_bus(&rinfo->i2c[2], "vga");
113
114         rinfo->i2c[3].rinfo     = rinfo;
115         rinfo->i2c[3].ddc_reg   = GPIO_CRT2_DDC;
116         radeon_setup_i2c_bus(&rinfo->i2c[3], "crt2");
117 }
118
119 void radeon_delete_i2c_busses(struct radeonfb_info *rinfo)
120 {
121         if (rinfo->i2c[0].rinfo)
122                 i2c_del_adapter(&rinfo->i2c[0].adapter);
123         rinfo->i2c[0].rinfo = NULL;
124
125         if (rinfo->i2c[1].rinfo)
126                 i2c_del_adapter(&rinfo->i2c[1].adapter);
127         rinfo->i2c[1].rinfo = NULL;
128
129         if (rinfo->i2c[2].rinfo)
130                 i2c_del_adapter(&rinfo->i2c[2].adapter);
131         rinfo->i2c[2].rinfo = NULL;
132
133         if (rinfo->i2c[3].rinfo)
134                 i2c_del_adapter(&rinfo->i2c[3].adapter);
135         rinfo->i2c[3].rinfo = NULL;
136 }
137
138 int radeon_probe_i2c_connector(struct radeonfb_info *rinfo, int conn,
139                                u8 **out_edid)
140 {
141         u8 *edid;
142
143         edid = fb_ddc_read(&rinfo->i2c[conn-1].adapter);
144
145         if (out_edid)
146                 *out_edid = edid;
147         if (!edid) {
148                 pr_debug("radeonfb: I2C (port %d) ... not found\n", conn);
149                 return MT_NONE;
150         }
151         if (edid[0x14] & 0x80) {
152                 /* Fix detection using BIOS tables */
153                 if (rinfo->is_mobility /*&& conn == ddc_dvi*/ &&
154                     (INREG(LVDS_GEN_CNTL) & LVDS_ON)) {
155                         pr_debug("radeonfb: I2C (port %d) ... found LVDS panel\n", conn);
156                         return MT_LCD;
157                 } else {
158                         pr_debug("radeonfb: I2C (port %d) ... found TMDS panel\n", conn);
159                         return MT_DFP;
160                 }
161         }
162         pr_debug("radeonfb: I2C (port %d) ... found CRT display\n", conn);
163         return MT_CRT;
164 }
165