vt: vt_ioctl: fix VT_DISALLOCATE freeing in-use virtual console
[linux/fpc-iii.git] / drivers / gpu / drm / i915 / dvo_sil164.c
blob4ae5d8fd9ff0fcf5d542e0405cefd2b08694c76a
1 /**************************************************************************
3 Copyright © 2006 Dave Airlie
5 All Rights Reserved.
7 Permission is hereby granted, free of charge, to any person obtaining a
8 copy of this software and associated documentation files (the
9 "Software"), to deal in the Software without restriction, including
10 without limitation the rights to use, copy, modify, merge, publish,
11 distribute, sub license, and/or sell copies of the Software, and to
12 permit persons to whom the Software is furnished to do so, subject to
13 the following conditions:
15 The above copyright notice and this permission notice (including the
16 next paragraph) shall be included in all copies or substantial portions
17 of the Software.
19 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
20 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
21 MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
22 IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
23 ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
24 TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
25 SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
27 **************************************************************************/
29 #include "dvo.h"
31 #define SIL164_VID 0x0001
32 #define SIL164_DID 0x0006
34 #define SIL164_VID_LO 0x00
35 #define SIL164_VID_HI 0x01
36 #define SIL164_DID_LO 0x02
37 #define SIL164_DID_HI 0x03
38 #define SIL164_REV 0x04
39 #define SIL164_RSVD 0x05
40 #define SIL164_FREQ_LO 0x06
41 #define SIL164_FREQ_HI 0x07
43 #define SIL164_REG8 0x08
44 #define SIL164_8_VEN (1<<5)
45 #define SIL164_8_HEN (1<<4)
46 #define SIL164_8_DSEL (1<<3)
47 #define SIL164_8_BSEL (1<<2)
48 #define SIL164_8_EDGE (1<<1)
49 #define SIL164_8_PD (1<<0)
51 #define SIL164_REG9 0x09
52 #define SIL164_9_VLOW (1<<7)
53 #define SIL164_9_MSEL_MASK (0x7<<4)
54 #define SIL164_9_TSEL (1<<3)
55 #define SIL164_9_RSEN (1<<2)
56 #define SIL164_9_HTPLG (1<<1)
57 #define SIL164_9_MDI (1<<0)
59 #define SIL164_REGC 0x0c
61 struct sil164_priv {
62 //I2CDevRec d;
63 bool quiet;
66 #define SILPTR(d) ((SIL164Ptr)(d->DriverPrivate.ptr))
68 static bool sil164_readb(struct intel_dvo_device *dvo, int addr, u8 *ch)
70 struct sil164_priv *sil = dvo->dev_priv;
71 struct i2c_adapter *adapter = dvo->i2c_bus;
72 u8 out_buf[2];
73 u8 in_buf[2];
75 struct i2c_msg msgs[] = {
77 .addr = dvo->slave_addr,
78 .flags = 0,
79 .len = 1,
80 .buf = out_buf,
83 .addr = dvo->slave_addr,
84 .flags = I2C_M_RD,
85 .len = 1,
86 .buf = in_buf,
90 out_buf[0] = addr;
91 out_buf[1] = 0;
93 if (i2c_transfer(adapter, msgs, 2) == 2) {
94 *ch = in_buf[0];
95 return true;
98 if (!sil->quiet) {
99 DRM_DEBUG_KMS("Unable to read register 0x%02x from %s:%02x.\n",
100 addr, adapter->name, dvo->slave_addr);
102 return false;
105 static bool sil164_writeb(struct intel_dvo_device *dvo, int addr, u8 ch)
107 struct sil164_priv *sil = dvo->dev_priv;
108 struct i2c_adapter *adapter = dvo->i2c_bus;
109 u8 out_buf[2];
110 struct i2c_msg msg = {
111 .addr = dvo->slave_addr,
112 .flags = 0,
113 .len = 2,
114 .buf = out_buf,
117 out_buf[0] = addr;
118 out_buf[1] = ch;
120 if (i2c_transfer(adapter, &msg, 1) == 1)
121 return true;
123 if (!sil->quiet) {
124 DRM_DEBUG_KMS("Unable to write register 0x%02x to %s:%d.\n",
125 addr, adapter->name, dvo->slave_addr);
128 return false;
131 /* Silicon Image 164 driver for chip on i2c bus */
132 static bool sil164_init(struct intel_dvo_device *dvo,
133 struct i2c_adapter *adapter)
135 /* this will detect the SIL164 chip on the specified i2c bus */
136 struct sil164_priv *sil;
137 unsigned char ch;
139 sil = kzalloc(sizeof(struct sil164_priv), GFP_KERNEL);
140 if (sil == NULL)
141 return false;
143 dvo->i2c_bus = adapter;
144 dvo->dev_priv = sil;
145 sil->quiet = true;
147 if (!sil164_readb(dvo, SIL164_VID_LO, &ch))
148 goto out;
150 if (ch != (SIL164_VID & 0xff)) {
151 DRM_DEBUG_KMS("sil164 not detected got %d: from %s Slave %d.\n",
152 ch, adapter->name, dvo->slave_addr);
153 goto out;
156 if (!sil164_readb(dvo, SIL164_DID_LO, &ch))
157 goto out;
159 if (ch != (SIL164_DID & 0xff)) {
160 DRM_DEBUG_KMS("sil164 not detected got %d: from %s Slave %d.\n",
161 ch, adapter->name, dvo->slave_addr);
162 goto out;
164 sil->quiet = false;
166 DRM_DEBUG_KMS("init sil164 dvo controller successfully!\n");
167 return true;
169 out:
170 kfree(sil);
171 return false;
174 static enum drm_connector_status sil164_detect(struct intel_dvo_device *dvo)
176 u8 reg9;
178 sil164_readb(dvo, SIL164_REG9, &reg9);
180 if (reg9 & SIL164_9_HTPLG)
181 return connector_status_connected;
182 else
183 return connector_status_disconnected;
186 static enum drm_mode_status sil164_mode_valid(struct intel_dvo_device *dvo,
187 struct drm_display_mode *mode)
189 return MODE_OK;
192 static void sil164_mode_set(struct intel_dvo_device *dvo,
193 const struct drm_display_mode *mode,
194 const struct drm_display_mode *adjusted_mode)
196 /* As long as the basics are set up, since we don't have clock
197 * dependencies in the mode setup, we can just leave the
198 * registers alone and everything will work fine.
200 /* recommended programming sequence from doc */
201 /*sil164_writeb(sil, 0x08, 0x30);
202 sil164_writeb(sil, 0x09, 0x00);
203 sil164_writeb(sil, 0x0a, 0x90);
204 sil164_writeb(sil, 0x0c, 0x89);
205 sil164_writeb(sil, 0x08, 0x31);*/
206 /* don't do much */
207 return;
210 /* set the SIL164 power state */
211 static void sil164_dpms(struct intel_dvo_device *dvo, bool enable)
213 int ret;
214 unsigned char ch;
216 ret = sil164_readb(dvo, SIL164_REG8, &ch);
217 if (ret == false)
218 return;
220 if (enable)
221 ch |= SIL164_8_PD;
222 else
223 ch &= ~SIL164_8_PD;
225 sil164_writeb(dvo, SIL164_REG8, ch);
226 return;
229 static bool sil164_get_hw_state(struct intel_dvo_device *dvo)
231 int ret;
232 unsigned char ch;
234 ret = sil164_readb(dvo, SIL164_REG8, &ch);
235 if (ret == false)
236 return false;
238 if (ch & SIL164_8_PD)
239 return true;
240 else
241 return false;
244 static void sil164_dump_regs(struct intel_dvo_device *dvo)
246 u8 val;
248 sil164_readb(dvo, SIL164_FREQ_LO, &val);
249 DRM_DEBUG_KMS("SIL164_FREQ_LO: 0x%02x\n", val);
250 sil164_readb(dvo, SIL164_FREQ_HI, &val);
251 DRM_DEBUG_KMS("SIL164_FREQ_HI: 0x%02x\n", val);
252 sil164_readb(dvo, SIL164_REG8, &val);
253 DRM_DEBUG_KMS("SIL164_REG8: 0x%02x\n", val);
254 sil164_readb(dvo, SIL164_REG9, &val);
255 DRM_DEBUG_KMS("SIL164_REG9: 0x%02x\n", val);
256 sil164_readb(dvo, SIL164_REGC, &val);
257 DRM_DEBUG_KMS("SIL164_REGC: 0x%02x\n", val);
260 static void sil164_destroy(struct intel_dvo_device *dvo)
262 struct sil164_priv *sil = dvo->dev_priv;
264 if (sil) {
265 kfree(sil);
266 dvo->dev_priv = NULL;
270 const struct intel_dvo_dev_ops sil164_ops = {
271 .init = sil164_init,
272 .detect = sil164_detect,
273 .mode_valid = sil164_mode_valid,
274 .mode_set = sil164_mode_set,
275 .dpms = sil164_dpms,
276 .get_hw_state = sil164_get_hw_state,
277 .dump_regs = sil164_dump_regs,
278 .destroy = sil164_destroy,