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
27
28#include "intel_drv.h"
29#include "intel_dvo_dev.h"
30
31
32#define TFP410_VID 0x014C
33#define TFP410_DID 0x0410
34
35#define TFP410_VID_LO 0x00
36#define TFP410_VID_HI 0x01
37#define TFP410_DID_LO 0x02
38#define TFP410_DID_HI 0x03
39#define TFP410_REV 0x04
40
41#define TFP410_CTL_1 0x08
42#define TFP410_CTL_1_TDIS (1<<6)
43#define TFP410_CTL_1_VEN (1<<5)
44#define TFP410_CTL_1_HEN (1<<4)
45#define TFP410_CTL_1_DSEL (1<<3)
46#define TFP410_CTL_1_BSEL (1<<2)
47#define TFP410_CTL_1_EDGE (1<<1)
48#define TFP410_CTL_1_PD (1<<0)
49
50#define TFP410_CTL_2 0x09
51#define TFP410_CTL_2_VLOW (1<<7)
52#define TFP410_CTL_2_MSEL_MASK (0x7<<4)
53#define TFP410_CTL_2_MSEL (1<<4)
54#define TFP410_CTL_2_TSEL (1<<3)
55#define TFP410_CTL_2_RSEN (1<<2)
56#define TFP410_CTL_2_HTPLG (1<<1)
57#define TFP410_CTL_2_MDI (1<<0)
58
59#define TFP410_CTL_3 0x0A
60#define TFP410_CTL_3_DK_MASK (0x7<<5)
61#define TFP410_CTL_3_DK (1<<5)
62#define TFP410_CTL_3_DKEN (1<<4)
63#define TFP410_CTL_3_CTL_MASK (0x7<<1)
64#define TFP410_CTL_3_CTL (1<<1)
65
66#define TFP410_USERCFG 0x0B
67
68#define TFP410_DE_DLY 0x32
69
70#define TFP410_DE_CTL 0x33
71#define TFP410_DE_CTL_DEGEN (1<<6)
72#define TFP410_DE_CTL_VSPOL (1<<5)
73#define TFP410_DE_CTL_HSPOL (1<<4)
74#define TFP410_DE_CTL_DEDLY8 (1<<0)
75
76#define TFP410_DE_TOP 0x34
77
78#define TFP410_DE_CNT_LO 0x36
79#define TFP410_DE_CNT_HI 0x37
80
81#define TFP410_DE_LIN_LO 0x38
82#define TFP410_DE_LIN_HI 0x39
83
84#define TFP410_H_RES_LO 0x3A
85#define TFP410_H_RES_HI 0x3B
86
87#define TFP410_V_RES_LO 0x3C
88#define TFP410_V_RES_HI 0x3D
89
90struct tfp410_priv {
91 bool quiet;
92};
93
94static bool tfp410_readb(struct intel_dvo_device *dvo, int addr, u8 *ch)
95{
96 struct tfp410_priv *tfp = dvo->dev_priv;
97 struct i2c_adapter *adapter = dvo->i2c_bus;
98 u8 out_buf[2];
99 u8 in_buf[2];
100
101 struct i2c_msg msgs[] = {
102 {
103 .addr = dvo->slave_addr,
104 .flags = 0,
105 .len = 1,
106 .buf = out_buf,
107 },
108 {
109 .addr = dvo->slave_addr,
110 .flags = I2C_M_RD,
111 .len = 1,
112 .buf = in_buf,
113 }
114 };
115
116 out_buf[0] = addr;
117 out_buf[1] = 0;
118
119 if (i2c_transfer(adapter, msgs, 2) == 2) {
120 *ch = in_buf[0];
121 return true;
122 }
123
124 if (!tfp->quiet) {
125 DRM_DEBUG_KMS("Unable to read register 0x%02x from %s:%02x.\n",
126 addr, adapter->name, dvo->slave_addr);
127 }
128 return false;
129}
130
131static bool tfp410_writeb(struct intel_dvo_device *dvo, int addr, u8 ch)
132{
133 struct tfp410_priv *tfp = dvo->dev_priv;
134 struct i2c_adapter *adapter = dvo->i2c_bus;
135 u8 out_buf[2];
136 struct i2c_msg msg = {
137 .addr = dvo->slave_addr,
138 .flags = 0,
139 .len = 2,
140 .buf = out_buf,
141 };
142
143 out_buf[0] = addr;
144 out_buf[1] = ch;
145
146 if (i2c_transfer(adapter, &msg, 1) == 1)
147 return true;
148
149 if (!tfp->quiet) {
150 DRM_DEBUG_KMS("Unable to write register 0x%02x to %s:%d.\n",
151 addr, adapter->name, dvo->slave_addr);
152 }
153
154 return false;
155}
156
157static int tfp410_getid(struct intel_dvo_device *dvo, int addr)
158{
159 u8 ch1, ch2;
160
161 if (tfp410_readb(dvo, addr+0, &ch1) &&
162 tfp410_readb(dvo, addr+1, &ch2))
163 return ((ch2 << 8) & 0xFF00) | (ch1 & 0x00FF);
164
165 return -1;
166}
167
168
169static bool tfp410_init(struct intel_dvo_device *dvo,
170 struct i2c_adapter *adapter)
171{
172
173 struct tfp410_priv *tfp;
174 int id;
175
176 tfp = kzalloc(sizeof(struct tfp410_priv), GFP_KERNEL);
177 if (tfp == NULL)
178 return false;
179
180 dvo->i2c_bus = adapter;
181 dvo->dev_priv = tfp;
182 tfp->quiet = true;
183
184 if ((id = tfp410_getid(dvo, TFP410_VID_LO)) != TFP410_VID) {
185 DRM_DEBUG_KMS("tfp410 not detected got VID %X: from %s "
186 "Slave %d.\n",
187 id, adapter->name, dvo->slave_addr);
188 goto out;
189 }
190
191 if ((id = tfp410_getid(dvo, TFP410_DID_LO)) != TFP410_DID) {
192 DRM_DEBUG_KMS("tfp410 not detected got DID %X: from %s "
193 "Slave %d.\n",
194 id, adapter->name, dvo->slave_addr);
195 goto out;
196 }
197 tfp->quiet = false;
198 return true;
199out:
200 kfree(tfp);
201 return false;
202}
203
204static enum drm_connector_status tfp410_detect(struct intel_dvo_device *dvo)
205{
206 enum drm_connector_status ret = connector_status_disconnected;
207 u8 ctl2;
208
209 if (tfp410_readb(dvo, TFP410_CTL_2, &ctl2)) {
210 if (ctl2 & TFP410_CTL_2_RSEN)
211 ret = connector_status_connected;
212 else
213 ret = connector_status_disconnected;
214 }
215
216 return ret;
217}
218
219static enum drm_mode_status tfp410_mode_valid(struct intel_dvo_device *dvo,
220 struct drm_display_mode *mode)
221{
222 return MODE_OK;
223}
224
225static void tfp410_mode_set(struct intel_dvo_device *dvo,
226 const struct drm_display_mode *mode,
227 const struct drm_display_mode *adjusted_mode)
228{
229
230
231
232
233
234 return;
235}
236
237
238static void tfp410_dpms(struct intel_dvo_device *dvo, bool enable)
239{
240 u8 ctl1;
241
242 if (!tfp410_readb(dvo, TFP410_CTL_1, &ctl1))
243 return;
244
245 if (enable)
246 ctl1 |= TFP410_CTL_1_PD;
247 else
248 ctl1 &= ~TFP410_CTL_1_PD;
249
250 tfp410_writeb(dvo, TFP410_CTL_1, ctl1);
251}
252
253static bool tfp410_get_hw_state(struct intel_dvo_device *dvo)
254{
255 u8 ctl1;
256
257 if (!tfp410_readb(dvo, TFP410_CTL_1, &ctl1))
258 return false;
259
260 if (ctl1 & TFP410_CTL_1_PD)
261 return true;
262 else
263 return false;
264}
265
266static void tfp410_dump_regs(struct intel_dvo_device *dvo)
267{
268 u8 val, val2;
269
270 tfp410_readb(dvo, TFP410_REV, &val);
271 DRM_DEBUG_KMS("TFP410_REV: 0x%02X\n", val);
272 tfp410_readb(dvo, TFP410_CTL_1, &val);
273 DRM_DEBUG_KMS("TFP410_CTL1: 0x%02X\n", val);
274 tfp410_readb(dvo, TFP410_CTL_2, &val);
275 DRM_DEBUG_KMS("TFP410_CTL2: 0x%02X\n", val);
276 tfp410_readb(dvo, TFP410_CTL_3, &val);
277 DRM_DEBUG_KMS("TFP410_CTL3: 0x%02X\n", val);
278 tfp410_readb(dvo, TFP410_USERCFG, &val);
279 DRM_DEBUG_KMS("TFP410_USERCFG: 0x%02X\n", val);
280 tfp410_readb(dvo, TFP410_DE_DLY, &val);
281 DRM_DEBUG_KMS("TFP410_DE_DLY: 0x%02X\n", val);
282 tfp410_readb(dvo, TFP410_DE_CTL, &val);
283 DRM_DEBUG_KMS("TFP410_DE_CTL: 0x%02X\n", val);
284 tfp410_readb(dvo, TFP410_DE_TOP, &val);
285 DRM_DEBUG_KMS("TFP410_DE_TOP: 0x%02X\n", val);
286 tfp410_readb(dvo, TFP410_DE_CNT_LO, &val);
287 tfp410_readb(dvo, TFP410_DE_CNT_HI, &val2);
288 DRM_DEBUG_KMS("TFP410_DE_CNT: 0x%02X%02X\n", val2, val);
289 tfp410_readb(dvo, TFP410_DE_LIN_LO, &val);
290 tfp410_readb(dvo, TFP410_DE_LIN_HI, &val2);
291 DRM_DEBUG_KMS("TFP410_DE_LIN: 0x%02X%02X\n", val2, val);
292 tfp410_readb(dvo, TFP410_H_RES_LO, &val);
293 tfp410_readb(dvo, TFP410_H_RES_HI, &val2);
294 DRM_DEBUG_KMS("TFP410_H_RES: 0x%02X%02X\n", val2, val);
295 tfp410_readb(dvo, TFP410_V_RES_LO, &val);
296 tfp410_readb(dvo, TFP410_V_RES_HI, &val2);
297 DRM_DEBUG_KMS("TFP410_V_RES: 0x%02X%02X\n", val2, val);
298}
299
300static void tfp410_destroy(struct intel_dvo_device *dvo)
301{
302 struct tfp410_priv *tfp = dvo->dev_priv;
303
304 if (tfp) {
305 kfree(tfp);
306 dvo->dev_priv = NULL;
307 }
308}
309
310const struct intel_dvo_dev_ops tfp410_ops = {
311 .init = tfp410_init,
312 .detect = tfp410_detect,
313 .mode_valid = tfp410_mode_valid,
314 .mode_set = tfp410_mode_set,
315 .dpms = tfp410_dpms,
316 .get_hw_state = tfp410_get_hw_state,
317 .dump_regs = tfp410_dump_regs,
318 .destroy = tfp410_destroy,
319};
320