2 * Copyright (c) 2006 Dave Airlie <airlied@linux.ie>
3 * Copyright © 2006-2008,2010 Intel Corporation
4 * Jesse Barnes <jesse.barnes@intel.com>
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:
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
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.
26 * Eric Anholt <eric@anholt.net>
27 * Chris Wilson <chris@chris-wilson.co.uk>
29 #include <linux/i2c.h>
30 #include <linux/i2c-algo-bit.h>
31 #include <linux/export.h>
34 #include "intel_drv.h"
38 /* Intel GPIO access functions */
40 #define I2C_RISEFALL_TIME 10
42 static inline struct intel_gmbus
*
43 to_intel_gmbus(struct i2c_adapter
*i2c
)
45 return container_of(i2c
, struct intel_gmbus
, adapter
);
49 struct i2c_adapter adapter
;
50 struct i2c_algo_bit_data algo
;
51 struct drm_i915_private
*dev_priv
;
56 intel_i2c_reset(struct drm_device
*dev
)
58 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
59 if (HAS_PCH_SPLIT(dev
))
60 I915_WRITE(PCH_GMBUS0
, 0);
62 I915_WRITE(GMBUS0
, 0);
65 static void intel_i2c_quirk_set(struct drm_i915_private
*dev_priv
, bool enable
)
69 /* When using bit bashing for I2C, this bit needs to be set to 1 */
70 if (!IS_PINEVIEW(dev_priv
->dev
))
73 val
= I915_READ(DSPCLK_GATE_D
);
75 val
|= DPCUNIT_CLOCK_GATE_DISABLE
;
77 val
&= ~DPCUNIT_CLOCK_GATE_DISABLE
;
78 I915_WRITE(DSPCLK_GATE_D
, val
);
81 static u32
get_reserved(struct intel_gpio
*gpio
)
83 struct drm_i915_private
*dev_priv
= gpio
->dev_priv
;
84 struct drm_device
*dev
= dev_priv
->dev
;
87 /* On most chips, these bits must be preserved in software. */
88 if (!IS_I830(dev
) && !IS_845G(dev
))
89 reserved
= I915_READ_NOTRACE(gpio
->reg
) &
90 (GPIO_DATA_PULLUP_DISABLE
|
91 GPIO_CLOCK_PULLUP_DISABLE
);
96 static int get_clock(void *data
)
98 struct intel_gpio
*gpio
= data
;
99 struct drm_i915_private
*dev_priv
= gpio
->dev_priv
;
100 u32 reserved
= get_reserved(gpio
);
101 I915_WRITE_NOTRACE(gpio
->reg
, reserved
| GPIO_CLOCK_DIR_MASK
);
102 I915_WRITE_NOTRACE(gpio
->reg
, reserved
);
103 return (I915_READ_NOTRACE(gpio
->reg
) & GPIO_CLOCK_VAL_IN
) != 0;
106 static int get_data(void *data
)
108 struct intel_gpio
*gpio
= data
;
109 struct drm_i915_private
*dev_priv
= gpio
->dev_priv
;
110 u32 reserved
= get_reserved(gpio
);
111 I915_WRITE_NOTRACE(gpio
->reg
, reserved
| GPIO_DATA_DIR_MASK
);
112 I915_WRITE_NOTRACE(gpio
->reg
, reserved
);
113 return (I915_READ_NOTRACE(gpio
->reg
) & GPIO_DATA_VAL_IN
) != 0;
116 static void set_clock(void *data
, int state_high
)
118 struct intel_gpio
*gpio
= data
;
119 struct drm_i915_private
*dev_priv
= gpio
->dev_priv
;
120 u32 reserved
= get_reserved(gpio
);
124 clock_bits
= GPIO_CLOCK_DIR_IN
| GPIO_CLOCK_DIR_MASK
;
126 clock_bits
= GPIO_CLOCK_DIR_OUT
| GPIO_CLOCK_DIR_MASK
|
129 I915_WRITE_NOTRACE(gpio
->reg
, reserved
| clock_bits
);
130 POSTING_READ(gpio
->reg
);
133 static void set_data(void *data
, int state_high
)
135 struct intel_gpio
*gpio
= data
;
136 struct drm_i915_private
*dev_priv
= gpio
->dev_priv
;
137 u32 reserved
= get_reserved(gpio
);
141 data_bits
= GPIO_DATA_DIR_IN
| GPIO_DATA_DIR_MASK
;
143 data_bits
= GPIO_DATA_DIR_OUT
| GPIO_DATA_DIR_MASK
|
146 I915_WRITE_NOTRACE(gpio
->reg
, reserved
| data_bits
);
147 POSTING_READ(gpio
->reg
);
150 static struct i2c_adapter
*
151 intel_gpio_create(struct drm_i915_private
*dev_priv
, u32 pin
)
153 static const int map_pin_to_reg
[] = {
163 struct intel_gpio
*gpio
;
165 if (pin
>= ARRAY_SIZE(map_pin_to_reg
) || !map_pin_to_reg
[pin
])
168 gpio
= kzalloc(sizeof(struct intel_gpio
), GFP_KERNEL
);
172 gpio
->reg
= map_pin_to_reg
[pin
];
173 if (HAS_PCH_SPLIT(dev_priv
->dev
))
174 gpio
->reg
+= PCH_GPIOA
- GPIOA
;
175 gpio
->dev_priv
= dev_priv
;
177 snprintf(gpio
->adapter
.name
, sizeof(gpio
->adapter
.name
),
178 "i915 GPIO%c", "?BACDE?F"[pin
]);
179 gpio
->adapter
.owner
= THIS_MODULE
;
180 gpio
->adapter
.algo_data
= &gpio
->algo
;
181 gpio
->adapter
.dev
.parent
= &dev_priv
->dev
->pdev
->dev
;
182 gpio
->algo
.setsda
= set_data
;
183 gpio
->algo
.setscl
= set_clock
;
184 gpio
->algo
.getsda
= get_data
;
185 gpio
->algo
.getscl
= get_clock
;
186 gpio
->algo
.udelay
= I2C_RISEFALL_TIME
;
187 gpio
->algo
.timeout
= usecs_to_jiffies(2200);
188 gpio
->algo
.data
= gpio
;
190 if (i2c_bit_add_bus(&gpio
->adapter
))
193 return &gpio
->adapter
;
201 intel_i2c_quirk_xfer(struct drm_i915_private
*dev_priv
,
202 struct i2c_adapter
*adapter
,
203 struct i2c_msg
*msgs
,
206 struct intel_gpio
*gpio
= container_of(adapter
,
211 intel_i2c_reset(dev_priv
->dev
);
213 intel_i2c_quirk_set(dev_priv
, true);
216 udelay(I2C_RISEFALL_TIME
);
218 ret
= adapter
->algo
->master_xfer(adapter
, msgs
, num
);
222 intel_i2c_quirk_set(dev_priv
, false);
228 gmbus_xfer(struct i2c_adapter
*adapter
,
229 struct i2c_msg
*msgs
,
232 struct intel_gmbus
*bus
= container_of(adapter
,
235 struct drm_i915_private
*dev_priv
= adapter
->algo_data
;
236 int i
, reg_offset
, ret
;
238 mutex_lock(&dev_priv
->gmbus_mutex
);
240 if (bus
->force_bit
) {
241 ret
= intel_i2c_quirk_xfer(dev_priv
,
242 bus
->force_bit
, msgs
, num
);
246 reg_offset
= HAS_PCH_SPLIT(dev_priv
->dev
) ? PCH_GMBUS0
- GMBUS0
: 0;
248 I915_WRITE(GMBUS0
+ reg_offset
, bus
->reg0
);
250 for (i
= 0; i
< num
; i
++) {
251 u16 len
= msgs
[i
].len
;
252 u8
*buf
= msgs
[i
].buf
;
254 if (msgs
[i
].flags
& I2C_M_RD
) {
255 I915_WRITE(GMBUS1
+ reg_offset
,
256 GMBUS_CYCLE_WAIT
| (i
+ 1 == num
? GMBUS_CYCLE_STOP
: 0) |
257 (len
<< GMBUS_BYTE_COUNT_SHIFT
) |
258 (msgs
[i
].addr
<< GMBUS_SLAVE_ADDR_SHIFT
) |
259 GMBUS_SLAVE_READ
| GMBUS_SW_RDY
);
260 POSTING_READ(GMBUS2
+reg_offset
);
264 if (wait_for(I915_READ(GMBUS2
+ reg_offset
) & (GMBUS_SATOER
| GMBUS_HW_RDY
), 50))
266 if (I915_READ(GMBUS2
+ reg_offset
) & GMBUS_SATOER
)
269 val
= I915_READ(GMBUS3
+ reg_offset
);
273 } while (--len
&& ++loop
< 4);
280 val
|= *buf
++ << (8 * loop
);
281 } while (--len
&& ++loop
< 4);
283 I915_WRITE(GMBUS3
+ reg_offset
, val
);
284 I915_WRITE(GMBUS1
+ reg_offset
,
285 (i
+ 1 == num
? GMBUS_CYCLE_STOP
: GMBUS_CYCLE_WAIT
) |
286 (msgs
[i
].len
<< GMBUS_BYTE_COUNT_SHIFT
) |
287 (msgs
[i
].addr
<< GMBUS_SLAVE_ADDR_SHIFT
) |
288 GMBUS_SLAVE_WRITE
| GMBUS_SW_RDY
);
289 POSTING_READ(GMBUS2
+reg_offset
);
292 if (wait_for(I915_READ(GMBUS2
+ reg_offset
) & (GMBUS_SATOER
| GMBUS_HW_RDY
), 50))
294 if (I915_READ(GMBUS2
+ reg_offset
) & GMBUS_SATOER
)
299 val
|= *buf
++ << (8 * loop
);
300 } while (--len
&& ++loop
< 4);
302 I915_WRITE(GMBUS3
+ reg_offset
, val
);
303 POSTING_READ(GMBUS2
+reg_offset
);
307 if (i
+ 1 < num
&& wait_for(I915_READ(GMBUS2
+ reg_offset
) & (GMBUS_SATOER
| GMBUS_HW_WAIT_PHASE
), 50))
309 if (I915_READ(GMBUS2
+ reg_offset
) & GMBUS_SATOER
)
316 /* Toggle the Software Clear Interrupt bit. This has the effect
317 * of resetting the GMBUS controller and so clearing the
318 * BUS_ERROR raised by the slave's NAK.
320 I915_WRITE(GMBUS1
+ reg_offset
, GMBUS_SW_CLR_INT
);
321 I915_WRITE(GMBUS1
+ reg_offset
, 0);
324 /* Mark the GMBUS interface as disabled. We will re-enable it at the
325 * start of the next xfer, till then let it sleep.
327 I915_WRITE(GMBUS0
+ reg_offset
, 0);
332 DRM_INFO("GMBUS timed out, falling back to bit banging on pin %d [%s]\n",
333 bus
->reg0
& 0xff, bus
->adapter
.name
);
334 I915_WRITE(GMBUS0
+ reg_offset
, 0);
336 /* Hardware may not support GMBUS over these pins? Try GPIO bitbanging instead. */
337 bus
->force_bit
= intel_gpio_create(dev_priv
, bus
->reg0
& 0xff);
341 ret
= intel_i2c_quirk_xfer(dev_priv
, bus
->force_bit
, msgs
, num
);
343 mutex_unlock(&dev_priv
->gmbus_mutex
);
347 static u32
gmbus_func(struct i2c_adapter
*adapter
)
349 struct intel_gmbus
*bus
= container_of(adapter
,
354 bus
->force_bit
->algo
->functionality(bus
->force_bit
);
356 return (I2C_FUNC_I2C
| I2C_FUNC_SMBUS_EMUL
|
357 /* I2C_FUNC_10BIT_ADDR | */
358 I2C_FUNC_SMBUS_READ_BLOCK_DATA
|
359 I2C_FUNC_SMBUS_BLOCK_PROC_CALL
);
362 static const struct i2c_algorithm gmbus_algorithm
= {
363 .master_xfer
= gmbus_xfer
,
364 .functionality
= gmbus_func
368 * intel_gmbus_setup - instantiate all Intel i2c GMBuses
371 int intel_setup_gmbus(struct drm_device
*dev
)
373 static const char *names
[GMBUS_NUM_PORTS
] = {
383 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
386 dev_priv
->gmbus
= kcalloc(GMBUS_NUM_PORTS
, sizeof(struct intel_gmbus
),
388 if (dev_priv
->gmbus
== NULL
)
391 mutex_init(&dev_priv
->gmbus_mutex
);
393 for (i
= 0; i
< GMBUS_NUM_PORTS
; i
++) {
394 struct intel_gmbus
*bus
= &dev_priv
->gmbus
[i
];
396 bus
->adapter
.owner
= THIS_MODULE
;
397 bus
->adapter
.class = I2C_CLASS_DDC
;
398 snprintf(bus
->adapter
.name
,
399 sizeof(bus
->adapter
.name
),
403 bus
->adapter
.dev
.parent
= &dev
->pdev
->dev
;
404 bus
->adapter
.algo_data
= dev_priv
;
406 bus
->adapter
.algo
= &gmbus_algorithm
;
407 ret
= i2c_add_adapter(&bus
->adapter
);
411 /* By default use a conservative clock rate */
412 bus
->reg0
= i
| GMBUS_RATE_100KHZ
;
414 /* XXX force bit banging until GMBUS is fully debugged */
415 bus
->force_bit
= intel_gpio_create(dev_priv
, i
);
418 intel_i2c_reset(dev_priv
->dev
);
424 struct intel_gmbus
*bus
= &dev_priv
->gmbus
[i
];
425 i2c_del_adapter(&bus
->adapter
);
427 kfree(dev_priv
->gmbus
);
428 dev_priv
->gmbus
= NULL
;
432 void intel_gmbus_set_speed(struct i2c_adapter
*adapter
, int speed
)
434 struct intel_gmbus
*bus
= to_intel_gmbus(adapter
);
436 bus
->reg0
= (bus
->reg0
& ~(0x3 << 8)) | speed
;
439 void intel_gmbus_force_bit(struct i2c_adapter
*adapter
, bool force_bit
)
441 struct intel_gmbus
*bus
= to_intel_gmbus(adapter
);
444 if (bus
->force_bit
== NULL
) {
445 struct drm_i915_private
*dev_priv
= adapter
->algo_data
;
446 bus
->force_bit
= intel_gpio_create(dev_priv
,
450 if (bus
->force_bit
) {
451 i2c_del_adapter(bus
->force_bit
);
452 kfree(bus
->force_bit
);
453 bus
->force_bit
= NULL
;
458 void intel_teardown_gmbus(struct drm_device
*dev
)
460 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
463 if (dev_priv
->gmbus
== NULL
)
466 for (i
= 0; i
< GMBUS_NUM_PORTS
; i
++) {
467 struct intel_gmbus
*bus
= &dev_priv
->gmbus
[i
];
468 if (bus
->force_bit
) {
469 i2c_del_adapter(bus
->force_bit
);
470 kfree(bus
->force_bit
);
472 i2c_del_adapter(&bus
->adapter
);
475 kfree(dev_priv
->gmbus
);
476 dev_priv
->gmbus
= NULL
;