Merge branch 'linus' into timers/core
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / gpu / drm / i915 / intel_i2c.c
CommitLineData
79e53945
JB
1/*
2 * Copyright (c) 2006 Dave Airlie <airlied@linux.ie>
f899fc64 3 * Copyright © 2006-2008,2010 Intel Corporation
79e53945
JB
4 * Jesse Barnes <jesse.barnes@intel.com>
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a
7 * copy of this software and associated documentation files (the "Software"),
8 * to deal in the Software without restriction, including without limitation
9 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10 * and/or sell copies of the Software, and to permit persons to whom the
11 * Software is furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice (including the next
14 * paragraph) shall be included in all copies or substantial portions of the
15 * Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
22 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
23 * DEALINGS IN THE SOFTWARE.
24 *
25 * Authors:
26 * Eric Anholt <eric@anholt.net>
f899fc64 27 * Chris Wilson <chris@chris-wilson.co.uk>
79e53945
JB
28 */
29#include <linux/i2c.h>
79e53945 30#include <linux/i2c-algo-bit.h>
2d1a8a48 31#include <linux/export.h>
760285e7 32#include <drm/drmP.h>
79e53945 33#include "intel_drv.h"
760285e7 34#include <drm/i915_drm.h>
79e53945
JB
35#include "i915_drv.h"
36
2ed06c93
DK
37struct gmbus_port {
38 const char *name;
39 int reg;
40};
41
42static const struct gmbus_port gmbus_ports[] = {
43 { "ssc", GPIOB },
44 { "vga", GPIOA },
45 { "panel", GPIOC },
46 { "dpc", GPIOD },
47 { "dpb", GPIOE },
48 { "dpd", GPIOF },
49};
50
f899fc64
CW
51/* Intel GPIO access functions */
52
1849ecb2 53#define I2C_RISEFALL_TIME 10
f899fc64 54
e957d772
CW
55static inline struct intel_gmbus *
56to_intel_gmbus(struct i2c_adapter *i2c)
57{
58 return container_of(i2c, struct intel_gmbus, adapter);
59}
60
f899fc64
CW
61void
62intel_i2c_reset(struct drm_device *dev)
0ba0e9e1
SL
63{
64 struct drm_i915_private *dev_priv = dev->dev_private;
110447fc 65 I915_WRITE(dev_priv->gpio_mmio_base + GMBUS0, 0);
28c70f16 66 I915_WRITE(dev_priv->gpio_mmio_base + GMBUS4, 0);
f899fc64
CW
67}
68
69static void intel_i2c_quirk_set(struct drm_i915_private *dev_priv, bool enable)
70{
b222f267 71 u32 val;
0ba0e9e1
SL
72
73 /* When using bit bashing for I2C, this bit needs to be set to 1 */
f899fc64 74 if (!IS_PINEVIEW(dev_priv->dev))
0ba0e9e1 75 return;
b222f267
CW
76
77 val = I915_READ(DSPCLK_GATE_D);
0ba0e9e1 78 if (enable)
b222f267 79 val |= DPCUNIT_CLOCK_GATE_DISABLE;
0ba0e9e1 80 else
b222f267
CW
81 val &= ~DPCUNIT_CLOCK_GATE_DISABLE;
82 I915_WRITE(DSPCLK_GATE_D, val);
0ba0e9e1
SL
83}
84
36c785f0 85static u32 get_reserved(struct intel_gmbus *bus)
e957d772 86{
36c785f0 87 struct drm_i915_private *dev_priv = bus->dev_priv;
e957d772
CW
88 struct drm_device *dev = dev_priv->dev;
89 u32 reserved = 0;
90
91 /* On most chips, these bits must be preserved in software. */
92 if (!IS_I830(dev) && !IS_845G(dev))
36c785f0 93 reserved = I915_READ_NOTRACE(bus->gpio_reg) &
db5e4172
YL
94 (GPIO_DATA_PULLUP_DISABLE |
95 GPIO_CLOCK_PULLUP_DISABLE);
e957d772
CW
96
97 return reserved;
98}
99
79e53945
JB
100static int get_clock(void *data)
101{
36c785f0
DV
102 struct intel_gmbus *bus = data;
103 struct drm_i915_private *dev_priv = bus->dev_priv;
104 u32 reserved = get_reserved(bus);
105 I915_WRITE_NOTRACE(bus->gpio_reg, reserved | GPIO_CLOCK_DIR_MASK);
106 I915_WRITE_NOTRACE(bus->gpio_reg, reserved);
107 return (I915_READ_NOTRACE(bus->gpio_reg) & GPIO_CLOCK_VAL_IN) != 0;
79e53945
JB
108}
109
110static int get_data(void *data)
111{
36c785f0
DV
112 struct intel_gmbus *bus = data;
113 struct drm_i915_private *dev_priv = bus->dev_priv;
114 u32 reserved = get_reserved(bus);
115 I915_WRITE_NOTRACE(bus->gpio_reg, reserved | GPIO_DATA_DIR_MASK);
116 I915_WRITE_NOTRACE(bus->gpio_reg, reserved);
117 return (I915_READ_NOTRACE(bus->gpio_reg) & GPIO_DATA_VAL_IN) != 0;
79e53945
JB
118}
119
120static void set_clock(void *data, int state_high)
121{
36c785f0
DV
122 struct intel_gmbus *bus = data;
123 struct drm_i915_private *dev_priv = bus->dev_priv;
124 u32 reserved = get_reserved(bus);
e957d772 125 u32 clock_bits;
79e53945
JB
126
127 if (state_high)
128 clock_bits = GPIO_CLOCK_DIR_IN | GPIO_CLOCK_DIR_MASK;
129 else
130 clock_bits = GPIO_CLOCK_DIR_OUT | GPIO_CLOCK_DIR_MASK |
131 GPIO_CLOCK_VAL_MASK;
f899fc64 132
36c785f0
DV
133 I915_WRITE_NOTRACE(bus->gpio_reg, reserved | clock_bits);
134 POSTING_READ(bus->gpio_reg);
79e53945
JB
135}
136
137static void set_data(void *data, int state_high)
138{
36c785f0
DV
139 struct intel_gmbus *bus = data;
140 struct drm_i915_private *dev_priv = bus->dev_priv;
141 u32 reserved = get_reserved(bus);
e957d772 142 u32 data_bits;
79e53945
JB
143
144 if (state_high)
145 data_bits = GPIO_DATA_DIR_IN | GPIO_DATA_DIR_MASK;
146 else
147 data_bits = GPIO_DATA_DIR_OUT | GPIO_DATA_DIR_MASK |
148 GPIO_DATA_VAL_MASK;
149
36c785f0
DV
150 I915_WRITE_NOTRACE(bus->gpio_reg, reserved | data_bits);
151 POSTING_READ(bus->gpio_reg);
79e53945
JB
152}
153
489fbc10
DK
154static int
155intel_gpio_pre_xfer(struct i2c_adapter *adapter)
156{
157 struct intel_gmbus *bus = container_of(adapter,
158 struct intel_gmbus,
159 adapter);
160 struct drm_i915_private *dev_priv = bus->dev_priv;
161
162 intel_i2c_reset(dev_priv->dev);
163 intel_i2c_quirk_set(dev_priv, true);
164 set_data(bus, 1);
165 set_clock(bus, 1);
166 udelay(I2C_RISEFALL_TIME);
167 return 0;
168}
169
170static void
171intel_gpio_post_xfer(struct i2c_adapter *adapter)
172{
173 struct intel_gmbus *bus = container_of(adapter,
174 struct intel_gmbus,
175 adapter);
176 struct drm_i915_private *dev_priv = bus->dev_priv;
177
178 set_data(bus, 1);
179 set_clock(bus, 1);
180 intel_i2c_quirk_set(dev_priv, false);
181}
182
2ed06c93 183static void
f6f808c8 184intel_gpio_setup(struct intel_gmbus *bus, u32 pin)
f0217c42 185{
36c785f0 186 struct drm_i915_private *dev_priv = bus->dev_priv;
36c785f0 187 struct i2c_algo_bit_data *algo;
f0217c42 188
c167a6fc 189 algo = &bus->bit_algo;
36c785f0 190
2ed06c93
DK
191 /* -1 to map pin pair to gmbus index */
192 bus->gpio_reg = dev_priv->gpio_mmio_base + gmbus_ports[pin - 1].reg;
79e53945 193
c167a6fc 194 bus->adapter.algo_data = algo;
36c785f0
DV
195 algo->setsda = set_data;
196 algo->setscl = set_clock;
197 algo->getsda = get_data;
198 algo->getscl = get_clock;
489fbc10
DK
199 algo->pre_xfer = intel_gpio_pre_xfer;
200 algo->post_xfer = intel_gpio_post_xfer;
36c785f0
DV
201 algo->udelay = I2C_RISEFALL_TIME;
202 algo->timeout = usecs_to_jiffies(2200);
203 algo->data = bus;
79e53945
JB
204}
205
c12aba5a
JK
206/*
207 * gmbus on gen4 seems to be able to generate legacy interrupts even when in MSI
208 * mode. This results in spurious interrupt warnings if the legacy irq no. is
209 * shared with another device. The kernel then disables that interrupt source
210 * and so prevents the other device from working properly.
211 */
212#define HAS_GMBUS_IRQ(dev) (INTEL_INFO(dev)->gen >= 5)
61168c53
DV
213static int
214gmbus_wait_hw_status(struct drm_i915_private *dev_priv,
28c70f16
DV
215 u32 gmbus2_status,
216 u32 gmbus4_irq_en)
61168c53 217{
28c70f16 218 int i;
61168c53 219 int reg_offset = dev_priv->gpio_mmio_base;
28c70f16
DV
220 u32 gmbus2 = 0;
221 DEFINE_WAIT(wait);
222
c12aba5a
JK
223 if (!HAS_GMBUS_IRQ(dev_priv->dev))
224 gmbus4_irq_en = 0;
225
28c70f16
DV
226 /* Important: The hw handles only the first bit, so set only one! Since
227 * we also need to check for NAKs besides the hw ready/idle signal, we
228 * need to wake up periodically and check that ourselves. */
229 I915_WRITE(GMBUS4 + reg_offset, gmbus4_irq_en);
230
231 for (i = 0; i < msecs_to_jiffies(50) + 1; i++) {
232 prepare_to_wait(&dev_priv->gmbus_wait_queue, &wait,
233 TASK_UNINTERRUPTIBLE);
234
ef04f00d 235 gmbus2 = I915_READ_NOTRACE(GMBUS2 + reg_offset);
28c70f16
DV
236 if (gmbus2 & (GMBUS_SATOER | gmbus2_status))
237 break;
61168c53 238
28c70f16
DV
239 schedule_timeout(1);
240 }
241 finish_wait(&dev_priv->gmbus_wait_queue, &wait);
242
243 I915_WRITE(GMBUS4 + reg_offset, 0);
61168c53
DV
244
245 if (gmbus2 & GMBUS_SATOER)
246 return -ENXIO;
28c70f16
DV
247 if (gmbus2 & gmbus2_status)
248 return 0;
249 return -ETIMEDOUT;
61168c53
DV
250}
251
2c438c02
DV
252static int
253gmbus_wait_idle(struct drm_i915_private *dev_priv)
254{
255 int ret;
256 int reg_offset = dev_priv->gpio_mmio_base;
257
ef04f00d 258#define C ((I915_READ_NOTRACE(GMBUS2 + reg_offset) & GMBUS_ACTIVE) == 0)
2c438c02
DV
259
260 if (!HAS_GMBUS_IRQ(dev_priv->dev))
261 return wait_for(C, 10);
262
263 /* Important: The hw handles only the first bit, so set only one! */
264 I915_WRITE(GMBUS4 + reg_offset, GMBUS_IDLE_EN);
265
266 ret = wait_event_timeout(dev_priv->gmbus_wait_queue, C, 10);
267
268 I915_WRITE(GMBUS4 + reg_offset, 0);
269
270 if (ret)
271 return 0;
272 else
273 return -ETIMEDOUT;
274#undef C
275}
276
924a93ed 277static int
56f9eac0
DK
278gmbus_xfer_read(struct drm_i915_private *dev_priv, struct i2c_msg *msg,
279 u32 gmbus1_index)
924a93ed
DK
280{
281 int reg_offset = dev_priv->gpio_mmio_base;
282 u16 len = msg->len;
283 u8 *buf = msg->buf;
284
285 I915_WRITE(GMBUS1 + reg_offset,
56f9eac0 286 gmbus1_index |
924a93ed 287 GMBUS_CYCLE_WAIT |
924a93ed
DK
288 (len << GMBUS_BYTE_COUNT_SHIFT) |
289 (msg->addr << GMBUS_SLAVE_ADDR_SHIFT) |
290 GMBUS_SLAVE_READ | GMBUS_SW_RDY);
79985eee 291 while (len) {
90e6b26d 292 int ret;
924a93ed
DK
293 u32 val, loop = 0;
294
28c70f16
DV
295 ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_RDY,
296 GMBUS_HW_RDY_EN);
90e6b26d 297 if (ret)
61168c53 298 return ret;
924a93ed
DK
299
300 val = I915_READ(GMBUS3 + reg_offset);
301 do {
302 *buf++ = val & 0xff;
303 val >>= 8;
304 } while (--len && ++loop < 4);
79985eee 305 }
924a93ed
DK
306
307 return 0;
308}
309
310static int
72d66afd 311gmbus_xfer_write(struct drm_i915_private *dev_priv, struct i2c_msg *msg)
924a93ed
DK
312{
313 int reg_offset = dev_priv->gpio_mmio_base;
314 u16 len = msg->len;
315 u8 *buf = msg->buf;
316 u32 val, loop;
317
318 val = loop = 0;
26883c31
DK
319 while (len && loop < 4) {
320 val |= *buf++ << (8 * loop++);
321 len -= 1;
322 }
924a93ed
DK
323
324 I915_WRITE(GMBUS3 + reg_offset, val);
325 I915_WRITE(GMBUS1 + reg_offset,
326 GMBUS_CYCLE_WAIT |
924a93ed
DK
327 (msg->len << GMBUS_BYTE_COUNT_SHIFT) |
328 (msg->addr << GMBUS_SLAVE_ADDR_SHIFT) |
329 GMBUS_SLAVE_WRITE | GMBUS_SW_RDY);
924a93ed 330 while (len) {
90e6b26d 331 int ret;
90e6b26d 332
924a93ed
DK
333 val = loop = 0;
334 do {
335 val |= *buf++ << (8 * loop);
336 } while (--len && ++loop < 4);
337
338 I915_WRITE(GMBUS3 + reg_offset, val);
7a39a9d4 339
28c70f16
DV
340 ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_RDY,
341 GMBUS_HW_RDY_EN);
90e6b26d 342 if (ret)
61168c53 343 return ret;
924a93ed
DK
344 }
345 return 0;
346}
347
56f9eac0
DK
348/*
349 * The gmbus controller can combine a 1 or 2 byte write with a read that
350 * immediately follows it by using an "INDEX" cycle.
351 */
352static bool
353gmbus_is_index_read(struct i2c_msg *msgs, int i, int num)
354{
355 return (i + 1 < num &&
356 !(msgs[i].flags & I2C_M_RD) && msgs[i].len <= 2 &&
357 (msgs[i + 1].flags & I2C_M_RD));
358}
359
360static int
361gmbus_xfer_index_read(struct drm_i915_private *dev_priv, struct i2c_msg *msgs)
362{
363 int reg_offset = dev_priv->gpio_mmio_base;
364 u32 gmbus1_index = 0;
365 u32 gmbus5 = 0;
366 int ret;
367
368 if (msgs[0].len == 2)
369 gmbus5 = GMBUS_2BYTE_INDEX_EN |
370 msgs[0].buf[1] | (msgs[0].buf[0] << 8);
371 if (msgs[0].len == 1)
372 gmbus1_index = GMBUS_CYCLE_INDEX |
373 (msgs[0].buf[0] << GMBUS_SLAVE_INDEX_SHIFT);
374
375 /* GMBUS5 holds 16-bit index */
376 if (gmbus5)
377 I915_WRITE(GMBUS5 + reg_offset, gmbus5);
378
379 ret = gmbus_xfer_read(dev_priv, &msgs[1], gmbus1_index);
380
381 /* Clear GMBUS5 after each index transfer */
382 if (gmbus5)
383 I915_WRITE(GMBUS5 + reg_offset, 0);
384
385 return ret;
386}
387
f899fc64
CW
388static int
389gmbus_xfer(struct i2c_adapter *adapter,
390 struct i2c_msg *msgs,
391 int num)
392{
393 struct intel_gmbus *bus = container_of(adapter,
394 struct intel_gmbus,
395 adapter);
c2b9152f 396 struct drm_i915_private *dev_priv = bus->dev_priv;
72d66afd
DK
397 int i, reg_offset;
398 int ret = 0;
f899fc64 399
8a8ed1f5
YS
400 mutex_lock(&dev_priv->gmbus_mutex);
401
402 if (bus->force_bit) {
489fbc10 403 ret = i2c_bit_algo.master_xfer(adapter, msgs, num);
8a8ed1f5
YS
404 goto out;
405 }
f899fc64 406
110447fc 407 reg_offset = dev_priv->gpio_mmio_base;
f899fc64 408
e957d772 409 I915_WRITE(GMBUS0 + reg_offset, bus->reg0);
f899fc64
CW
410
411 for (i = 0; i < num; i++) {
56f9eac0
DK
412 if (gmbus_is_index_read(msgs, i, num)) {
413 ret = gmbus_xfer_index_read(dev_priv, &msgs[i]);
414 i += 1; /* set i to the index of the read xfer */
415 } else if (msgs[i].flags & I2C_M_RD) {
416 ret = gmbus_xfer_read(dev_priv, &msgs[i], 0);
417 } else {
72d66afd 418 ret = gmbus_xfer_write(dev_priv, &msgs[i]);
56f9eac0 419 }
924a93ed
DK
420
421 if (ret == -ETIMEDOUT)
422 goto timeout;
423 if (ret == -ENXIO)
424 goto clear_err;
425
28c70f16
DV
426 ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_WAIT_PHASE,
427 GMBUS_HW_WAIT_EN);
61168c53
DV
428 if (ret == -ENXIO)
429 goto clear_err;
90e6b26d 430 if (ret)
f899fc64 431 goto timeout;
f899fc64
CW
432 }
433
72d66afd
DK
434 /* Generate a STOP condition on the bus. Note that gmbus can't generata
435 * a STOP on the very first cycle. To simplify the code we
436 * unconditionally generate the STOP condition with an additional gmbus
437 * cycle. */
438 I915_WRITE(GMBUS1 + reg_offset, GMBUS_CYCLE_STOP | GMBUS_SW_RDY);
439
e646d577
DK
440 /* Mark the GMBUS interface as disabled after waiting for idle.
441 * We will re-enable it at the start of the next xfer,
442 * till then let it sleep.
443 */
2c438c02 444 if (gmbus_wait_idle(dev_priv)) {
56fa6d6f 445 DRM_DEBUG_KMS("GMBUS [%s] timed out waiting for idle\n",
e646d577 446 adapter->name);
72d66afd
DK
447 ret = -ETIMEDOUT;
448 }
e646d577 449 I915_WRITE(GMBUS0 + reg_offset, 0);
72d66afd 450 ret = ret ?: i;
e646d577 451 goto out;
7f58aabc
CW
452
453clear_err:
e646d577
DK
454 /*
455 * Wait for bus to IDLE before clearing NAK.
456 * If we clear the NAK while bus is still active, then it will stay
457 * active and the next transaction may fail.
65e81866
DV
458 *
459 * If no ACK is received during the address phase of a transaction, the
460 * adapter must report -ENXIO. It is not clear what to return if no ACK
461 * is received at other times. But we have to be careful to not return
462 * spurious -ENXIO because that will prevent i2c and drm edid functions
463 * from retrying. So return -ENXIO only when gmbus properly quiescents -
464 * timing out seems to happen when there _is_ a ddc chip present, but
465 * it's slow responding and only answers on the 2nd retry.
e646d577 466 */
65e81866 467 ret = -ENXIO;
2c438c02 468 if (gmbus_wait_idle(dev_priv)) {
56fa6d6f
DK
469 DRM_DEBUG_KMS("GMBUS [%s] timed out after NAK\n",
470 adapter->name);
65e81866
DV
471 ret = -ETIMEDOUT;
472 }
e646d577 473
7f58aabc
CW
474 /* Toggle the Software Clear Interrupt bit. This has the effect
475 * of resetting the GMBUS controller and so clearing the
476 * BUS_ERROR raised by the slave's NAK.
477 */
478 I915_WRITE(GMBUS1 + reg_offset, GMBUS_SW_CLR_INT);
479 I915_WRITE(GMBUS1 + reg_offset, 0);
e646d577 480 I915_WRITE(GMBUS0 + reg_offset, 0);
7f58aabc 481
56fa6d6f 482 DRM_DEBUG_KMS("GMBUS [%s] NAK for addr: %04x %c(%d)\n",
e646d577
DK
483 adapter->name, msgs[i].addr,
484 (msgs[i].flags & I2C_M_RD) ? 'r' : 'w', msgs[i].len);
485
8a8ed1f5 486 goto out;
f899fc64
CW
487
488timeout:
874e3cc9
DK
489 DRM_INFO("GMBUS [%s] timed out, falling back to bit banging on pin %d\n",
490 bus->adapter.name, bus->reg0 & 0xff);
7f58aabc
CW
491 I915_WRITE(GMBUS0 + reg_offset, 0);
492
2ed06c93 493 /* Hardware may not support GMBUS over these pins? Try GPIO bitbanging instead. */
f2ce9faf 494 bus->force_bit = 1;
2ed06c93 495 ret = i2c_bit_algo.master_xfer(adapter, msgs, num);
489fbc10 496
8a8ed1f5
YS
497out:
498 mutex_unlock(&dev_priv->gmbus_mutex);
499 return ret;
f899fc64
CW
500}
501
502static u32 gmbus_func(struct i2c_adapter *adapter)
503{
f6f808c8
DV
504 return i2c_bit_algo.functionality(adapter) &
505 (I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL |
f899fc64
CW
506 /* I2C_FUNC_10BIT_ADDR | */
507 I2C_FUNC_SMBUS_READ_BLOCK_DATA |
508 I2C_FUNC_SMBUS_BLOCK_PROC_CALL);
509}
510
511static const struct i2c_algorithm gmbus_algorithm = {
512 .master_xfer = gmbus_xfer,
513 .functionality = gmbus_func
514};
515
79e53945 516/**
f899fc64
CW
517 * intel_gmbus_setup - instantiate all Intel i2c GMBuses
518 * @dev: DRM device
79e53945 519 */
f899fc64
CW
520int intel_setup_gmbus(struct drm_device *dev)
521{
f899fc64
CW
522 struct drm_i915_private *dev_priv = dev->dev_private;
523 int ret, i;
524
110447fc
DV
525 if (HAS_PCH_SPLIT(dev))
526 dev_priv->gpio_mmio_base = PCH_GPIOA - GPIOA;
d8112150
VS
527 else if (IS_VALLEYVIEW(dev))
528 dev_priv->gpio_mmio_base = VLV_DISPLAY_BASE;
110447fc
DV
529 else
530 dev_priv->gpio_mmio_base = 0;
531
8a8ed1f5 532 mutex_init(&dev_priv->gmbus_mutex);
28c70f16 533 init_waitqueue_head(&dev_priv->gmbus_wait_queue);
8a8ed1f5 534
f899fc64
CW
535 for (i = 0; i < GMBUS_NUM_PORTS; i++) {
536 struct intel_gmbus *bus = &dev_priv->gmbus[i];
2ed06c93 537 u32 port = i + 1; /* +1 to map gmbus index to pin pair */
f899fc64
CW
538
539 bus->adapter.owner = THIS_MODULE;
540 bus->adapter.class = I2C_CLASS_DDC;
541 snprintf(bus->adapter.name,
69669455
JD
542 sizeof(bus->adapter.name),
543 "i915 gmbus %s",
2ed06c93 544 gmbus_ports[i].name);
f899fc64
CW
545
546 bus->adapter.dev.parent = &dev->pdev->dev;
c2b9152f 547 bus->dev_priv = dev_priv;
f899fc64
CW
548
549 bus->adapter.algo = &gmbus_algorithm;
f899fc64 550
e957d772 551 /* By default use a conservative clock rate */
2ed06c93 552 bus->reg0 = port | GMBUS_RATE_100KHZ;
cb8ea752 553
83ee9e64
DV
554 /* gmbus seems to be broken on i830 */
555 if (IS_I830(dev))
f2ce9faf 556 bus->force_bit = 1;
83ee9e64 557
2ed06c93 558 intel_gpio_setup(bus, port);
cee25168
JN
559
560 ret = i2c_add_adapter(&bus->adapter);
561 if (ret)
562 goto err;
f899fc64
CW
563 }
564
565 intel_i2c_reset(dev_priv->dev);
566
567 return 0;
568
569err:
570 while (--i) {
571 struct intel_gmbus *bus = &dev_priv->gmbus[i];
572 i2c_del_adapter(&bus->adapter);
573 }
f899fc64
CW
574 return ret;
575}
576
3bd7d909
DK
577struct i2c_adapter *intel_gmbus_get_adapter(struct drm_i915_private *dev_priv,
578 unsigned port)
579{
580 WARN_ON(!intel_gmbus_is_port_valid(port));
2ed06c93 581 /* -1 to map pin pair to gmbus index */
3bd7d909 582 return (intel_gmbus_is_port_valid(port)) ?
2ed06c93 583 &dev_priv->gmbus[port - 1].adapter : NULL;
3bd7d909
DK
584}
585
e957d772
CW
586void intel_gmbus_set_speed(struct i2c_adapter *adapter, int speed)
587{
588 struct intel_gmbus *bus = to_intel_gmbus(adapter);
589
d5090b96 590 bus->reg0 = (bus->reg0 & ~(0x3 << 8)) | speed;
e957d772
CW
591}
592
593void intel_gmbus_force_bit(struct i2c_adapter *adapter, bool force_bit)
594{
595 struct intel_gmbus *bus = to_intel_gmbus(adapter);
596
f2ce9faf
CW
597 bus->force_bit += force_bit ? 1 : -1;
598 DRM_DEBUG_KMS("%sabling bit-banging on %s. force bit now %d\n",
599 force_bit ? "en" : "dis", adapter->name,
600 bus->force_bit);
e957d772
CW
601}
602
f899fc64 603void intel_teardown_gmbus(struct drm_device *dev)
79e53945 604{
f899fc64
CW
605 struct drm_i915_private *dev_priv = dev->dev_private;
606 int i;
f9c10a9b 607
f899fc64
CW
608 for (i = 0; i < GMBUS_NUM_PORTS; i++) {
609 struct intel_gmbus *bus = &dev_priv->gmbus[i];
f899fc64
CW
610 i2c_del_adapter(&bus->adapter);
611 }
79e53945 612}