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