| Start/ | End/ | |||
| True | False | - | Line | Source |
| 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 | ||||
| 1464 | 1464 | 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); | |||
| 720 | 744 | 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 | ||||
| 888 | 888 | 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); | |||
| 576 | 312 | 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 | ||||
| 720 | 0 | 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; | |||
| 720 | 0 | - | 58 | ternary-?: ( val & ( 1 << 9 ) ) |
| 720 | 58 | return ( val & ( 1 << 9 ) ) ? 1 : 0 | ||
| 59 | } | |||
| 60 | ||||
| 72 | 0 | 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; | |||
| 72 | 0 | - | 69 | ternary-?: ( val & ( 1 << 8 ) ) |
| 72 | 69 | return ( val & ( 1 << 8 ) ) ? 1 : 0 | ||
| 70 | } | |||
| 71 | ||||
| 24 | 0 | 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_HW_B_RADEON; | |||
| 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); | |||
| 24 | 0 | - | 94 | ternary-?: __builtin_constant_p ( 20 ) |
| 0 | 24 | - | 94 | ternary-?: ( 20 ) > 20000 |
| 95 | ||||
| 96 | rc = i2c_bit_add_bus(&chan->adapter); | |||
| 24 | 0 | - | 97 | if (rc == 0) |
| 98 | dev_dbg(&chan->rinfo->pdev->dev, "I2C bus %s registered.\n", name); | |||
| 0 | 24 | - | 98 | do-while (0) |
| 99 | else | |||
| 100 | dev_warn(&chan->rinfo->pdev->dev, "Failed to register I2C bus %s.\n", name); | |||
| 0 | 0 | - | 100 | ternary-?: ( & chan -> rinfo -> pdev -> dev .. |
| 24 | 101 | return rc; | ||
| 102 | } | |||
| 103 | ||||
| 6 | 6 | 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 | ||||
| 0 | 0 | - | 123 | void radeon_delete_i2c_busses(struct radeonfb_info *rinfo) |
| 124 | { | |||
| 0 | 0 | - | 125 | if (rinfo->i2c[0].rinfo) |
| 126 | i2c_bit_del_bus(&rinfo->i2c[0].adapter); | |||
| 127 | rinfo->i2c[0].rinfo = NULL; | |||
| 128 | ||||
| 0 | 0 | - | 129 | if (rinfo->i2c[1].rinfo) |
| 130 | i2c_bit_del_bus(&rinfo->i2c[1].adapter); | |||
| 131 | rinfo->i2c[1].rinfo = NULL; | |||
| 132 | ||||
| 0 | 0 | - | 133 | if (rinfo->i2c[2].rinfo) |
| 134 | i2c_bit_del_bus(&rinfo->i2c[2].adapter); | |||
| 135 | rinfo->i2c[2].rinfo = NULL; | |||
| 136 | ||||
| 0 | 0 | - | 137 | if (rinfo->i2c[3].rinfo) |
| 138 | i2c_bit_del_bus(&rinfo->i2c[3].adapter); | |||
| 139 | rinfo->i2c[3].rinfo = NULL; | |||
| 140 | } | |||
| 141 | ||||
| 142 | ||||
| 18 | 0 | 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); | |||
| 0 | 18 | - | 160 | if (!buf) { |
| 161 | dev_warn(&chan->rinfo->pdev->dev, "Out of memory!\n"); | |||
| 0 | 0 | - | 161 | ternary-?: ( & chan -> rinfo -> pdev -> dev .. |
| 0 | - | 162 | return NULL; | |
| 163 | } | |||
| 164 | msgs[1].buf = buf; | |||
| 165 | ||||
| 0 | 18 | - | 166 | if (i2c_transfer(&chan->adapter, msgs, 2) == 2) |
| 0 | - | 167 | return buf; | |
| 168 | dev_dbg(&chan->rinfo->pdev->dev, "Unable to read EDID block.\n"); | |||
| 0 | 18 | - | 168 | do-while (0) |
| 169 | kfree(buf); | |||
| 18 | 170 | return NULL; | ||
| 171 | } | |||
| 172 | ||||
| 173 | ||||
| 24 | 0 | 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 | ||||
| 72 | 24 | 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); | |||
| 288 | 54 | 196 | for (j = 0; j < 5; j++) { | |
| 197 | msleep(10); | |||
| 18 | 270 | 198 | if (INREG(reg) & VGA_DDC_CLK_INPUT) | |
| 18 | 199 | break; | ||
| 200 | } | |||
| 54 | 18 | 201 | if (j == 5) | |
| 54 | 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); | |||
| 18 | 0 | - | 224 | for (j = 0; j < 10; j++) { |
| 225 | msleep(10); | |||
| 18 | 0 | - | 226 | if (INREG(reg) & VGA_DDC_CLK_INPUT) |
| 18 | 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); | |||
| 0 | 18 | - | 236 | if (edid) |
| 0 | - | 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 | ||||
| 24 | 0 | - | 245 | if (out_edid) |
| 246 | *out_edid = edid; | |||
| 24 | 0 | - | 247 | if (!edid) { |
| 0 | 24 | - | 248 | RTRACE("radeonfb: I2C (port %d) ... not found\n", conn); |
| 24 | 249 | return MT_NONE; | ||
| 250 | } | |||
| 0 | 0 | - | 251 | if (edid[0x14] & 0x80) { |
| 252 | /* Fix detection using BIOS tables */ | |||
| 253 | if (rinfo->is_mobility /*&& conn == ddc_dvi*/ && | |||
| 0 | 0 | - | 254 | (INREG(LVDS_GEN_CNTL) & LVDS_ON)) { |
| 0 | - | 254 | T && (T) | |
| 0 | - | 254 | T && (F) | |
| 0 | - | 254 | F && (_) | |
| 0 | 0 | - | 255 | RTRACE("radeonfb: I2C (port %d) ... found LVDS panel\n", conn); |
| 0 | - | 256 | return MT_LCD; | |
| 257 | } else { | |||
| 0 | 0 | - | 258 | RTRACE("radeonfb: I2C (port %d) ... found TMDS panel\n", conn); |
| 0 | - | 259 | return MT_DFP; | |
| 260 | } | |||
| 261 | } | |||
| 0 | 0 | - | 262 | RTRACE("radeonfb: I2C (port %d) ... found CRT display\n", conn); |
| 0 | - | 263 | return MT_CRT; | |
| 264 | } | |||
| 265 | ||||
| ***TER 48% (43/90) of SOURCE FILE radeon_i2c.c | ||||