intel_i2c.c 18.0 KB
Newer Older
J
Jesse Barnes 已提交
1 2
/*
 * Copyright (c) 2006 Dave Airlie <airlied@linux.ie>
3
 * Copyright © 2006-2008,2010 Intel Corporation
J
Jesse Barnes 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26
 *   Jesse Barnes <jesse.barnes@intel.com>
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *
 * Authors:
 *	Eric Anholt <eric@anholt.net>
27
 *	Chris Wilson <chris@chris-wilson.co.uk>
J
Jesse Barnes 已提交
28 29 30
 */
#include <linux/i2c.h>
#include <linux/i2c-algo-bit.h>
31
#include <linux/export.h>
32
#include <drm/drmP.h>
J
Jesse Barnes 已提交
33
#include "intel_drv.h"
34
#include <drm/i915_drm.h>
J
Jesse Barnes 已提交
35 36
#include "i915_drv.h"

37
struct gmbus_pin {
38 39 40 41
	const char *name;
	int reg;
};

42 43 44 45 46 47 48 49
/* Map gmbus pin pairs to names and registers. */
static const struct gmbus_pin gmbus_pins[] = {
	[GMBUS_PIN_SSC] = { "ssc", GPIOB },
	[GMBUS_PIN_VGADDC] = { "vga", GPIOA },
	[GMBUS_PIN_PANEL] = { "panel", GPIOC },
	[GMBUS_PIN_DPC] = { "dpc", GPIOD },
	[GMBUS_PIN_DPB] = { "dpb", GPIOE },
	[GMBUS_PIN_DPD] = { "dpd", GPIOF },
50 51
};

52 53 54 55 56 57 58
static const struct gmbus_pin gmbus_pins_bdw[] = {
	[GMBUS_PIN_VGADDC] = { "vga", GPIOA },
	[GMBUS_PIN_DPC] = { "dpc", GPIOD },
	[GMBUS_PIN_DPB] = { "dpb", GPIOE },
	[GMBUS_PIN_DPD] = { "dpd", GPIOF },
};

59 60 61 62 63 64
static const struct gmbus_pin gmbus_pins_skl[] = {
	[GMBUS_PIN_DPC] = { "dpc", GPIOD },
	[GMBUS_PIN_DPB] = { "dpb", GPIOE },
	[GMBUS_PIN_DPD] = { "dpd", GPIOF },
};

J
Jani Nikula 已提交
65 66 67 68 69 70 71 72 73 74 75 76
static const struct gmbus_pin gmbus_pins_bxt[] = {
	[GMBUS_PIN_1_BXT] = { "dpb", PCH_GPIOB },
	[GMBUS_PIN_2_BXT] = { "dpc", PCH_GPIOC },
	[GMBUS_PIN_3_BXT] = { "misc", PCH_GPIOD },
};

/* pin is expected to be valid */
static const struct gmbus_pin *get_gmbus_pin(struct drm_i915_private *dev_priv,
					     unsigned int pin)
{
	if (IS_BROXTON(dev_priv))
		return &gmbus_pins_bxt[pin];
77
	else if (IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv))
78
		return &gmbus_pins_skl[pin];
79 80
	else if (IS_BROADWELL(dev_priv))
		return &gmbus_pins_bdw[pin];
J
Jani Nikula 已提交
81 82 83 84
	else
		return &gmbus_pins[pin];
}

85 86 87
bool intel_gmbus_is_valid_pin(struct drm_i915_private *dev_priv,
			      unsigned int pin)
{
J
Jani Nikula 已提交
88 89 90 91
	unsigned int size;

	if (IS_BROXTON(dev_priv))
		size = ARRAY_SIZE(gmbus_pins_bxt);
92
	else if (IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv))
93
		size = ARRAY_SIZE(gmbus_pins_skl);
94 95
	else if (IS_BROADWELL(dev_priv))
		size = ARRAY_SIZE(gmbus_pins_bdw);
J
Jani Nikula 已提交
96 97 98 99
	else
		size = ARRAY_SIZE(gmbus_pins);

	return pin < size && get_gmbus_pin(dev_priv, pin)->reg;
100 101
}

102 103
/* Intel GPIO access functions */

J
Jean Delvare 已提交
104
#define I2C_RISEFALL_TIME 10
105

C
Chris Wilson 已提交
106 107 108 109 110 111
static inline struct intel_gmbus *
to_intel_gmbus(struct i2c_adapter *i2c)
{
	return container_of(i2c, struct intel_gmbus, adapter);
}

112 113
void
intel_i2c_reset(struct drm_device *dev)
114 115
{
	struct drm_i915_private *dev_priv = dev->dev_private;
116

117 118
	I915_WRITE(GMBUS0, 0);
	I915_WRITE(GMBUS4, 0);
119 120 121 122
}

static void intel_i2c_quirk_set(struct drm_i915_private *dev_priv, bool enable)
{
123
	u32 val;
124 125

	/* When using bit bashing for I2C, this bit needs to be set to 1 */
126
	if (!IS_PINEVIEW(dev_priv->dev))
127
		return;
128 129

	val = I915_READ(DSPCLK_GATE_D);
130
	if (enable)
131
		val |= DPCUNIT_CLOCK_GATE_DISABLE;
132
	else
133 134
		val &= ~DPCUNIT_CLOCK_GATE_DISABLE;
	I915_WRITE(DSPCLK_GATE_D, val);
135 136
}

137
static u32 get_reserved(struct intel_gmbus *bus)
C
Chris Wilson 已提交
138
{
139
	struct drm_i915_private *dev_priv = bus->dev_priv;
C
Chris Wilson 已提交
140 141 142 143 144
	struct drm_device *dev = dev_priv->dev;
	u32 reserved = 0;

	/* On most chips, these bits must be preserved in software. */
	if (!IS_I830(dev) && !IS_845G(dev))
145
		reserved = I915_READ_NOTRACE(bus->gpio_reg) &
146 147
					     (GPIO_DATA_PULLUP_DISABLE |
					      GPIO_CLOCK_PULLUP_DISABLE);
C
Chris Wilson 已提交
148 149 150 151

	return reserved;
}

J
Jesse Barnes 已提交
152 153
static int get_clock(void *data)
{
154 155 156 157 158 159
	struct intel_gmbus *bus = data;
	struct drm_i915_private *dev_priv = bus->dev_priv;
	u32 reserved = get_reserved(bus);
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved | GPIO_CLOCK_DIR_MASK);
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved);
	return (I915_READ_NOTRACE(bus->gpio_reg) & GPIO_CLOCK_VAL_IN) != 0;
J
Jesse Barnes 已提交
160 161 162 163
}

static int get_data(void *data)
{
164 165 166 167 168 169
	struct intel_gmbus *bus = data;
	struct drm_i915_private *dev_priv = bus->dev_priv;
	u32 reserved = get_reserved(bus);
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved | GPIO_DATA_DIR_MASK);
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved);
	return (I915_READ_NOTRACE(bus->gpio_reg) & GPIO_DATA_VAL_IN) != 0;
J
Jesse Barnes 已提交
170 171 172 173
}

static void set_clock(void *data, int state_high)
{
174 175 176
	struct intel_gmbus *bus = data;
	struct drm_i915_private *dev_priv = bus->dev_priv;
	u32 reserved = get_reserved(bus);
C
Chris Wilson 已提交
177
	u32 clock_bits;
J
Jesse Barnes 已提交
178 179 180 181 182 183

	if (state_high)
		clock_bits = GPIO_CLOCK_DIR_IN | GPIO_CLOCK_DIR_MASK;
	else
		clock_bits = GPIO_CLOCK_DIR_OUT | GPIO_CLOCK_DIR_MASK |
			GPIO_CLOCK_VAL_MASK;
184

185 186
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved | clock_bits);
	POSTING_READ(bus->gpio_reg);
J
Jesse Barnes 已提交
187 188 189 190
}

static void set_data(void *data, int state_high)
{
191 192 193
	struct intel_gmbus *bus = data;
	struct drm_i915_private *dev_priv = bus->dev_priv;
	u32 reserved = get_reserved(bus);
C
Chris Wilson 已提交
194
	u32 data_bits;
J
Jesse Barnes 已提交
195 196 197 198 199 200 201

	if (state_high)
		data_bits = GPIO_DATA_DIR_IN | GPIO_DATA_DIR_MASK;
	else
		data_bits = GPIO_DATA_DIR_OUT | GPIO_DATA_DIR_MASK |
			GPIO_DATA_VAL_MASK;

202 203
	I915_WRITE_NOTRACE(bus->gpio_reg, reserved | data_bits);
	POSTING_READ(bus->gpio_reg);
J
Jesse Barnes 已提交
204 205
}

206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234
static int
intel_gpio_pre_xfer(struct i2c_adapter *adapter)
{
	struct intel_gmbus *bus = container_of(adapter,
					       struct intel_gmbus,
					       adapter);
	struct drm_i915_private *dev_priv = bus->dev_priv;

	intel_i2c_reset(dev_priv->dev);
	intel_i2c_quirk_set(dev_priv, true);
	set_data(bus, 1);
	set_clock(bus, 1);
	udelay(I2C_RISEFALL_TIME);
	return 0;
}

static void
intel_gpio_post_xfer(struct i2c_adapter *adapter)
{
	struct intel_gmbus *bus = container_of(adapter,
					       struct intel_gmbus,
					       adapter);
	struct drm_i915_private *dev_priv = bus->dev_priv;

	set_data(bus, 1);
	set_clock(bus, 1);
	intel_i2c_quirk_set(dev_priv, false);
}

235
static void
236
intel_gpio_setup(struct intel_gmbus *bus, unsigned int pin)
237
{
238 239
	struct drm_i915_private *dev_priv = bus->dev_priv;
	struct i2c_algo_bit_data *algo;
240

241
	algo = &bus->bit_algo;
242

J
Jani Nikula 已提交
243 244
	bus->gpio_reg = dev_priv->gpio_mmio_base +
		get_gmbus_pin(dev_priv, pin)->reg;
J
Jesse Barnes 已提交
245

246
	bus->adapter.algo_data = algo;
247 248 249 250
	algo->setsda = set_data;
	algo->setscl = set_clock;
	algo->getsda = get_data;
	algo->getscl = get_clock;
251 252
	algo->pre_xfer = intel_gpio_pre_xfer;
	algo->post_xfer = intel_gpio_post_xfer;
253 254 255
	algo->udelay = I2C_RISEFALL_TIME;
	algo->timeout = usecs_to_jiffies(2200);
	algo->data = bus;
J
Jesse Barnes 已提交
256 257
}

258 259
static int
gmbus_wait_hw_status(struct drm_i915_private *dev_priv,
260 261
		     u32 gmbus2_status,
		     u32 gmbus4_irq_en)
262
{
263 264 265 266
	int i;
	u32 gmbus2 = 0;
	DEFINE_WAIT(wait);

267 268 269
	if (!HAS_GMBUS_IRQ(dev_priv->dev))
		gmbus4_irq_en = 0;

270 271 272
	/* Important: The hw handles only the first bit, so set only one! Since
	 * we also need to check for NAKs besides the hw ready/idle signal, we
	 * need to wake up periodically and check that ourselves. */
273
	I915_WRITE(GMBUS4, gmbus4_irq_en);
274

275
	for (i = 0; i < msecs_to_jiffies_timeout(50); i++) {
276 277 278
		prepare_to_wait(&dev_priv->gmbus_wait_queue, &wait,
				TASK_UNINTERRUPTIBLE);

279
		gmbus2 = I915_READ_NOTRACE(GMBUS2);
280 281
		if (gmbus2 & (GMBUS_SATOER | gmbus2_status))
			break;
282

283 284 285 286
		schedule_timeout(1);
	}
	finish_wait(&dev_priv->gmbus_wait_queue, &wait);

287
	I915_WRITE(GMBUS4, 0);
288 289 290

	if (gmbus2 & GMBUS_SATOER)
		return -ENXIO;
291 292 293
	if (gmbus2 & gmbus2_status)
		return 0;
	return -ETIMEDOUT;
294 295
}

296 297 298 299 300
static int
gmbus_wait_idle(struct drm_i915_private *dev_priv)
{
	int ret;

301
#define C ((I915_READ_NOTRACE(GMBUS2) & GMBUS_ACTIVE) == 0)
302 303 304 305 306

	if (!HAS_GMBUS_IRQ(dev_priv->dev))
		return wait_for(C, 10);

	/* Important: The hw handles only the first bit, so set only one! */
307
	I915_WRITE(GMBUS4, GMBUS_IDLE_EN);
308

309 310
	ret = wait_event_timeout(dev_priv->gmbus_wait_queue, C,
				 msecs_to_jiffies_timeout(10));
311

312
	I915_WRITE(GMBUS4, 0);
313 314 315 316 317 318 319 320

	if (ret)
		return 0;
	else
		return -ETIMEDOUT;
#undef C
}

321
static int
322 323 324
gmbus_xfer_read_chunk(struct drm_i915_private *dev_priv,
		      unsigned short addr, u8 *buf, unsigned int len,
		      u32 gmbus1_index)
325
{
326
	I915_WRITE(GMBUS1,
327
		   gmbus1_index |
328 329
		   GMBUS_CYCLE_WAIT |
		   (len << GMBUS_BYTE_COUNT_SHIFT) |
330
		   (addr << GMBUS_SLAVE_ADDR_SHIFT) |
331
		   GMBUS_SLAVE_READ | GMBUS_SW_RDY);
332
	while (len) {
333
		int ret;
334 335
		u32 val, loop = 0;

336 337
		ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_RDY,
					   GMBUS_HW_RDY_EN);
338
		if (ret)
339
			return ret;
340

341
		val = I915_READ(GMBUS3);
342 343 344 345
		do {
			*buf++ = val & 0xff;
			val >>= 8;
		} while (--len && ++loop < 4);
346
	}
347 348 349 350 351

	return 0;
}

static int
352 353
gmbus_xfer_read(struct drm_i915_private *dev_priv, struct i2c_msg *msg,
		u32 gmbus1_index)
354 355
{
	u8 *buf = msg->buf;
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379
	unsigned int rx_size = msg->len;
	unsigned int len;
	int ret;

	do {
		len = min(rx_size, GMBUS_BYTE_COUNT_MAX);

		ret = gmbus_xfer_read_chunk(dev_priv, msg->addr,
					    buf, len, gmbus1_index);
		if (ret)
			return ret;

		rx_size -= len;
		buf += len;
	} while (rx_size != 0);

	return 0;
}

static int
gmbus_xfer_write_chunk(struct drm_i915_private *dev_priv,
		       unsigned short addr, u8 *buf, unsigned int len)
{
	unsigned int chunk_size = len;
380 381 382
	u32 val, loop;

	val = loop = 0;
383 384 385 386
	while (len && loop < 4) {
		val |= *buf++ << (8 * loop++);
		len -= 1;
	}
387

388 389
	I915_WRITE(GMBUS3, val);
	I915_WRITE(GMBUS1,
390
		   GMBUS_CYCLE_WAIT |
391 392
		   (chunk_size << GMBUS_BYTE_COUNT_SHIFT) |
		   (addr << GMBUS_SLAVE_ADDR_SHIFT) |
393 394
		   GMBUS_SLAVE_WRITE | GMBUS_SW_RDY);
	while (len) {
395 396
		int ret;

397 398 399 400 401
		val = loop = 0;
		do {
			val |= *buf++ << (8 * loop);
		} while (--len && ++loop < 4);

402
		I915_WRITE(GMBUS3, val);
403

404 405
		ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_RDY,
					   GMBUS_HW_RDY_EN);
406
		if (ret)
407
			return ret;
408
	}
409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431

	return 0;
}

static int
gmbus_xfer_write(struct drm_i915_private *dev_priv, struct i2c_msg *msg)
{
	u8 *buf = msg->buf;
	unsigned int tx_size = msg->len;
	unsigned int len;
	int ret;

	do {
		len = min(tx_size, GMBUS_BYTE_COUNT_MAX);

		ret = gmbus_xfer_write_chunk(dev_priv, msg->addr, buf, len);
		if (ret)
			return ret;

		buf += len;
		tx_size -= len;
	} while (tx_size != 0);

432 433 434
	return 0;
}

435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462
/*
 * The gmbus controller can combine a 1 or 2 byte write with a read that
 * immediately follows it by using an "INDEX" cycle.
 */
static bool
gmbus_is_index_read(struct i2c_msg *msgs, int i, int num)
{
	return (i + 1 < num &&
		!(msgs[i].flags & I2C_M_RD) && msgs[i].len <= 2 &&
		(msgs[i + 1].flags & I2C_M_RD));
}

static int
gmbus_xfer_index_read(struct drm_i915_private *dev_priv, struct i2c_msg *msgs)
{
	u32 gmbus1_index = 0;
	u32 gmbus5 = 0;
	int ret;

	if (msgs[0].len == 2)
		gmbus5 = GMBUS_2BYTE_INDEX_EN |
			 msgs[0].buf[1] | (msgs[0].buf[0] << 8);
	if (msgs[0].len == 1)
		gmbus1_index = GMBUS_CYCLE_INDEX |
			       (msgs[0].buf[0] << GMBUS_SLAVE_INDEX_SHIFT);

	/* GMBUS5 holds 16-bit index */
	if (gmbus5)
463
		I915_WRITE(GMBUS5, gmbus5);
464 465 466 467 468

	ret = gmbus_xfer_read(dev_priv, &msgs[1], gmbus1_index);

	/* Clear GMBUS5 after each index transfer */
	if (gmbus5)
469
		I915_WRITE(GMBUS5, 0);
470 471 472 473

	return ret;
}

474 475 476 477 478 479 480 481
static int
gmbus_xfer(struct i2c_adapter *adapter,
	   struct i2c_msg *msgs,
	   int num)
{
	struct intel_gmbus *bus = container_of(adapter,
					       struct intel_gmbus,
					       adapter);
482
	struct drm_i915_private *dev_priv = bus->dev_priv;
483
	int i = 0, inc, try = 0;
484
	int ret = 0;
485

486
	intel_display_power_get(dev_priv, POWER_DOMAIN_GMBUS);
487 488 489
	mutex_lock(&dev_priv->gmbus_mutex);

	if (bus->force_bit) {
490
		ret = i2c_bit_algo.master_xfer(adapter, msgs, num);
491 492
		goto out;
	}
493

494
retry:
495
	I915_WRITE(GMBUS0, bus->reg0);
496

497 498
	for (; i < num; i += inc) {
		inc = 1;
499 500
		if (gmbus_is_index_read(msgs, i, num)) {
			ret = gmbus_xfer_index_read(dev_priv, &msgs[i]);
501
			inc = 2; /* an index read is two msgs */
502 503 504
		} else if (msgs[i].flags & I2C_M_RD) {
			ret = gmbus_xfer_read(dev_priv, &msgs[i], 0);
		} else {
505
			ret = gmbus_xfer_write(dev_priv, &msgs[i]);
506
		}
507 508 509 510 511 512

		if (ret == -ETIMEDOUT)
			goto timeout;
		if (ret == -ENXIO)
			goto clear_err;

513 514
		ret = gmbus_wait_hw_status(dev_priv, GMBUS_HW_WAIT_PHASE,
					   GMBUS_HW_WAIT_EN);
515 516
		if (ret == -ENXIO)
			goto clear_err;
517
		if (ret)
518 519 520
			goto timeout;
	}

521 522 523 524
	/* Generate a STOP condition on the bus. Note that gmbus can't generata
	 * a STOP on the very first cycle. To simplify the code we
	 * unconditionally generate the STOP condition with an additional gmbus
	 * cycle. */
525
	I915_WRITE(GMBUS1, GMBUS_CYCLE_STOP | GMBUS_SW_RDY);
526

527 528 529 530
	/* Mark the GMBUS interface as disabled after waiting for idle.
	 * We will re-enable it at the start of the next xfer,
	 * till then let it sleep.
	 */
531
	if (gmbus_wait_idle(dev_priv)) {
532
		DRM_DEBUG_KMS("GMBUS [%s] timed out waiting for idle\n",
533
			 adapter->name);
534 535
		ret = -ETIMEDOUT;
	}
536
	I915_WRITE(GMBUS0, 0);
537
	ret = ret ?: i;
538
	goto out;
539 540

clear_err:
541 542 543 544
	/*
	 * Wait for bus to IDLE before clearing NAK.
	 * If we clear the NAK while bus is still active, then it will stay
	 * active and the next transaction may fail.
545 546 547 548 549 550 551 552
	 *
	 * If no ACK is received during the address phase of a transaction, the
	 * adapter must report -ENXIO. It is not clear what to return if no ACK
	 * is received at other times. But we have to be careful to not return
	 * spurious -ENXIO because that will prevent i2c and drm edid functions
	 * from retrying. So return -ENXIO only when gmbus properly quiescents -
	 * timing out seems to happen when there _is_ a ddc chip present, but
	 * it's slow responding and only answers on the 2nd retry.
553
	 */
554
	ret = -ENXIO;
555
	if (gmbus_wait_idle(dev_priv)) {
556 557
		DRM_DEBUG_KMS("GMBUS [%s] timed out after NAK\n",
			      adapter->name);
558 559
		ret = -ETIMEDOUT;
	}
560

561 562 563 564
	/* Toggle the Software Clear Interrupt bit. This has the effect
	 * of resetting the GMBUS controller and so clearing the
	 * BUS_ERROR raised by the slave's NAK.
	 */
565 566 567
	I915_WRITE(GMBUS1, GMBUS_SW_CLR_INT);
	I915_WRITE(GMBUS1, 0);
	I915_WRITE(GMBUS0, 0);
568

569
	DRM_DEBUG_KMS("GMBUS [%s] NAK for addr: %04x %c(%d)\n",
570 571 572
			 adapter->name, msgs[i].addr,
			 (msgs[i].flags & I2C_M_RD) ? 'r' : 'w', msgs[i].len);

573 574 575 576 577 578 579 580 581 582 583 584
	/*
	 * Passive adapters sometimes NAK the first probe. Retry the first
	 * message once on -ENXIO for GMBUS transfers; the bit banging algorithm
	 * has retries internally. See also the retry loop in
	 * drm_do_probe_ddc_edid, which bails out on the first -ENXIO.
	 */
	if (ret == -ENXIO && i == 0 && try++ == 0) {
		DRM_DEBUG_KMS("GMBUS [%s] NAK on first message, retry\n",
			      adapter->name);
		goto retry;
	}

585
	goto out;
586 587

timeout:
588 589
	DRM_INFO("GMBUS [%s] timed out, falling back to bit banging on pin %d\n",
		 bus->adapter.name, bus->reg0 & 0xff);
590
	I915_WRITE(GMBUS0, 0);
591

592
	/* Hardware may not support GMBUS over these pins? Try GPIO bitbanging instead. */
593
	bus->force_bit = 1;
594
	ret = i2c_bit_algo.master_xfer(adapter, msgs, num);
595

596 597
out:
	mutex_unlock(&dev_priv->gmbus_mutex);
598 599 600

	intel_display_power_put(dev_priv, POWER_DOMAIN_GMBUS);

601
	return ret;
602 603 604 605
}

static u32 gmbus_func(struct i2c_adapter *adapter)
{
606 607
	return i2c_bit_algo.functionality(adapter) &
		(I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL |
608 609 610 611 612 613 614 615 616 617
		/* I2C_FUNC_10BIT_ADDR | */
		I2C_FUNC_SMBUS_READ_BLOCK_DATA |
		I2C_FUNC_SMBUS_BLOCK_PROC_CALL);
}

static const struct i2c_algorithm gmbus_algorithm = {
	.master_xfer	= gmbus_xfer,
	.functionality	= gmbus_func
};

J
Jesse Barnes 已提交
618
/**
619 620
 * intel_gmbus_setup - instantiate all Intel i2c GMBuses
 * @dev: DRM device
J
Jesse Barnes 已提交
621
 */
622 623 624
int intel_setup_gmbus(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
625 626 627
	struct intel_gmbus *bus;
	unsigned int pin;
	int ret;
628

629 630 631
	if (HAS_PCH_NOP(dev))
		return 0;
	else if (HAS_PCH_SPLIT(dev))
632
		dev_priv->gpio_mmio_base = PCH_GPIOA - GPIOA;
633 634
	else if (IS_VALLEYVIEW(dev))
		dev_priv->gpio_mmio_base = VLV_DISPLAY_BASE;
635 636 637
	else
		dev_priv->gpio_mmio_base = 0;

638
	mutex_init(&dev_priv->gmbus_mutex);
639
	init_waitqueue_head(&dev_priv->gmbus_wait_queue);
640

641
	for (pin = 0; pin < ARRAY_SIZE(dev_priv->gmbus); pin++) {
642
		if (!intel_gmbus_is_valid_pin(dev_priv, pin))
643 644 645
			continue;

		bus = &dev_priv->gmbus[pin];
646 647 648 649

		bus->adapter.owner = THIS_MODULE;
		bus->adapter.class = I2C_CLASS_DDC;
		snprintf(bus->adapter.name,
650 651
			 sizeof(bus->adapter.name),
			 "i915 gmbus %s",
J
Jani Nikula 已提交
652
			 get_gmbus_pin(dev_priv, pin)->name);
653 654

		bus->adapter.dev.parent = &dev->pdev->dev;
655
		bus->dev_priv = dev_priv;
656 657 658

		bus->adapter.algo = &gmbus_algorithm;

C
Chris Wilson 已提交
659
		/* By default use a conservative clock rate */
660
		bus->reg0 = pin | GMBUS_RATE_100KHZ;
661

D
Daniel Vetter 已提交
662 663
		/* gmbus seems to be broken on i830 */
		if (IS_I830(dev))
664
			bus->force_bit = 1;
D
Daniel Vetter 已提交
665

666
		intel_gpio_setup(bus, pin);
667 668 669 670

		ret = i2c_add_adapter(&bus->adapter);
		if (ret)
			goto err;
671 672 673 674 675 676 677
	}

	intel_i2c_reset(dev_priv->dev);

	return 0;

err:
678
	while (--pin) {
679
		if (!intel_gmbus_is_valid_pin(dev_priv, pin))
680 681 682
			continue;

		bus = &dev_priv->gmbus[pin];
683 684 685 686 687
		i2c_del_adapter(&bus->adapter);
	}
	return ret;
}

688
struct i2c_adapter *intel_gmbus_get_adapter(struct drm_i915_private *dev_priv,
689
					    unsigned int pin)
690
{
691
	if (WARN_ON(!intel_gmbus_is_valid_pin(dev_priv, pin)))
692 693 694
		return NULL;

	return &dev_priv->gmbus[pin].adapter;
695 696
}

C
Chris Wilson 已提交
697 698 699 700
void intel_gmbus_set_speed(struct i2c_adapter *adapter, int speed)
{
	struct intel_gmbus *bus = to_intel_gmbus(adapter);

701
	bus->reg0 = (bus->reg0 & ~(0x3 << 8)) | speed;
C
Chris Wilson 已提交
702 703 704 705 706 707
}

void intel_gmbus_force_bit(struct i2c_adapter *adapter, bool force_bit)
{
	struct intel_gmbus *bus = to_intel_gmbus(adapter);

708 709 710 711
	bus->force_bit += force_bit ? 1 : -1;
	DRM_DEBUG_KMS("%sabling bit-banging on %s. force bit now %d\n",
		      force_bit ? "en" : "dis", adapter->name,
		      bus->force_bit);
C
Chris Wilson 已提交
712 713
}

714
void intel_teardown_gmbus(struct drm_device *dev)
J
Jesse Barnes 已提交
715
{
716
	struct drm_i915_private *dev_priv = dev->dev_private;
717 718 719 720
	struct intel_gmbus *bus;
	unsigned int pin;

	for (pin = 0; pin < ARRAY_SIZE(dev_priv->gmbus); pin++) {
721
		if (!intel_gmbus_is_valid_pin(dev_priv, pin))
722
			continue;
723

724
		bus = &dev_priv->gmbus[pin];
725 726
		i2c_del_adapter(&bus->adapter);
	}
J
Jesse Barnes 已提交
727
}