1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/kernel.h>
27#include <linux/module.h>
28#include <linux/pci.h>
29#include <linux/types.h>
30#include <linux/i2c.h>
31#include <linux/i2c-algo-bit.h>
32#include <linux/init.h>
33#include <linux/io.h>
34#include <linux/delay.h>
35
36#include <drm/drmP.h>
37#include "psb_drv.h"
38#include "psb_intel_reg.h"
39
40
41
42
43
44
45
46
47
48
49#define RGEN 0x20
50#define RGIO 0x24
51#define RGLVL 0x28
52#define RGTPE 0x2C
53#define RGTNE 0x30
54#define RGGPE 0x34
55#define RGSMI 0x38
56#define RGTS 0x3C
57
58
59
60
61#define GPIO_CLOCK 0x08
62#define GPIO_DATA 0x10
63
64#define LPC_READ_REG(chan, r) inl((chan)->reg + (r))
65#define LPC_WRITE_REG(chan, r, val) outl((val), (chan)->reg + (r))
66
67static int get_clock(void *data)
68{
69 struct psb_intel_i2c_chan *chan = data;
70 u32 val, tmp;
71
72 val = LPC_READ_REG(chan, RGIO);
73 val |= GPIO_CLOCK;
74 LPC_WRITE_REG(chan, RGIO, val);
75 tmp = LPC_READ_REG(chan, RGLVL);
76 val = (LPC_READ_REG(chan, RGLVL) & GPIO_CLOCK) ? 1 : 0;
77
78 return val;
79}
80
81static int get_data(void *data)
82{
83 struct psb_intel_i2c_chan *chan = data;
84 u32 val, tmp;
85
86 val = LPC_READ_REG(chan, RGIO);
87 val |= GPIO_DATA;
88 LPC_WRITE_REG(chan, RGIO, val);
89 tmp = LPC_READ_REG(chan, RGLVL);
90 val = (LPC_READ_REG(chan, RGLVL) & GPIO_DATA) ? 1 : 0;
91
92 return val;
93}
94
95static void set_clock(void *data, int state_high)
96{
97 struct psb_intel_i2c_chan *chan = data;
98 u32 val;
99
100 if (state_high) {
101 val = LPC_READ_REG(chan, RGIO);
102 val |= GPIO_CLOCK;
103 LPC_WRITE_REG(chan, RGIO, val);
104 } else {
105 val = LPC_READ_REG(chan, RGIO);
106 val &= ~GPIO_CLOCK;
107 LPC_WRITE_REG(chan, RGIO, val);
108 val = LPC_READ_REG(chan, RGLVL);
109 val &= ~GPIO_CLOCK;
110 LPC_WRITE_REG(chan, RGLVL, val);
111 }
112}
113
114static void set_data(void *data, int state_high)
115{
116 struct psb_intel_i2c_chan *chan = data;
117 u32 val;
118
119 if (state_high) {
120 val = LPC_READ_REG(chan, RGIO);
121 val |= GPIO_DATA;
122 LPC_WRITE_REG(chan, RGIO, val);
123 } else {
124 val = LPC_READ_REG(chan, RGIO);
125 val &= ~GPIO_DATA;
126 LPC_WRITE_REG(chan, RGIO, val);
127 val = LPC_READ_REG(chan, RGLVL);
128 val &= ~GPIO_DATA;
129 LPC_WRITE_REG(chan, RGLVL, val);
130 }
131}
132
133void oaktrail_lvds_i2c_init(struct drm_encoder *encoder)
134{
135 struct drm_device *dev = encoder->dev;
136 struct gma_encoder *gma_encoder = to_gma_encoder(encoder);
137 struct drm_psb_private *dev_priv = dev->dev_private;
138 struct psb_intel_i2c_chan *chan;
139
140 chan = kzalloc(sizeof(struct psb_intel_i2c_chan), GFP_KERNEL);
141 if (!chan)
142 return;
143
144 chan->drm_dev = dev;
145 chan->reg = dev_priv->lpc_gpio_base;
146 strncpy(chan->adapter.name, "gma500 LPC", I2C_NAME_SIZE - 1);
147 chan->adapter.owner = THIS_MODULE;
148 chan->adapter.algo_data = &chan->algo;
149 chan->adapter.dev.parent = &dev->pdev->dev;
150 chan->algo.setsda = set_data;
151 chan->algo.setscl = set_clock;
152 chan->algo.getsda = get_data;
153 chan->algo.getscl = get_clock;
154 chan->algo.udelay = 100;
155 chan->algo.timeout = usecs_to_jiffies(2200);
156 chan->algo.data = chan;
157
158 i2c_set_adapdata(&chan->adapter, chan);
159
160 set_data(chan, 1);
161 set_clock(chan, 1);
162 udelay(50);
163
164 if (i2c_bit_add_bus(&chan->adapter)) {
165 kfree(chan);
166 return;
167 }
168
169 gma_encoder->ddc_bus = chan;
170}
171