Subversion Repositories Kolibri OS

Rev

Rev 6660 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 6660 Rev 6937
1
/*
1
/*
2
 * Copyright © 2006 Intel Corporation
2
 * Copyright © 2006 Intel Corporation
3
 *
3
 *
4
 * Permission is hereby granted, free of charge, to any person obtaining a
4
 * Permission is hereby granted, free of charge, to any person obtaining a
5
 * copy of this software and associated documentation files (the "Software"),
5
 * copy of this software and associated documentation files (the "Software"),
6
 * to deal in the Software without restriction, including without limitation
6
 * to deal in the Software without restriction, including without limitation
7
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
7
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8
 * and/or sell copies of the Software, and to permit persons to whom the
8
 * and/or sell copies of the Software, and to permit persons to whom the
9
 * Software is furnished to do so, subject to the following conditions:
9
 * Software is furnished to do so, subject to the following conditions:
10
 *
10
 *
11
 * The above copyright notice and this permission notice (including the next
11
 * The above copyright notice and this permission notice (including the next
12
 * paragraph) shall be included in all copies or substantial portions of the
12
 * paragraph) shall be included in all copies or substantial portions of the
13
 * Software.
13
 * Software.
14
 *
14
 *
15
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
18
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
19
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
20
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
20
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
21
 * SOFTWARE.
21
 * SOFTWARE.
22
 *
22
 *
23
 * Authors:
23
 * Authors:
24
 *    Eric Anholt 
24
 *    Eric Anholt 
25
 *
25
 *
26
 */
26
 */
27
#include 
-
 
-
 
27
 
28
#include 
28
#include 
29
#include 
29
#include 
30
#include 
30
#include 
31
#include "i915_drv.h"
31
#include "i915_drv.h"
32
#include "intel_bios.h"
32
#include "intel_bios.h"
33
 
33
 
34
#define	SLAVE_ADDR1	0x70
34
#define	SLAVE_ADDR1	0x70
35
#define	SLAVE_ADDR2	0x72
35
#define	SLAVE_ADDR2	0x72
36
 
36
 
37
static int panel_type;
37
static int panel_type;
38
 
38
 
39
static const void *
39
static const void *
40
find_section(const void *_bdb, int section_id)
40
find_section(const void *_bdb, int section_id)
41
{
41
{
42
	const struct bdb_header *bdb = _bdb;
42
	const struct bdb_header *bdb = _bdb;
43
	const u8 *base = _bdb;
43
	const u8 *base = _bdb;
44
	int index = 0;
44
	int index = 0;
45
	u32 total, current_size;
45
	u32 total, current_size;
46
	u8 current_id;
46
	u8 current_id;
47
 
47
 
48
	/* skip to first section */
48
	/* skip to first section */
49
	index += bdb->header_size;
49
	index += bdb->header_size;
50
	total = bdb->bdb_size;
50
	total = bdb->bdb_size;
51
 
51
 
52
	/* walk the sections looking for section_id */
52
	/* walk the sections looking for section_id */
53
	while (index + 3 < total) {
53
	while (index + 3 < total) {
54
		current_id = *(base + index);
54
		current_id = *(base + index);
55
		index++;
55
		index++;
56
 
56
 
57
		current_size = *((const u16 *)(base + index));
57
		current_size = *((const u16 *)(base + index));
58
		index += 2;
58
		index += 2;
59
 
59
 
60
		/* The MIPI Sequence Block v3+ has a separate size field. */
60
		/* The MIPI Sequence Block v3+ has a separate size field. */
61
		if (current_id == BDB_MIPI_SEQUENCE && *(base + index) >= 3)
61
		if (current_id == BDB_MIPI_SEQUENCE && *(base + index) >= 3)
62
			current_size = *((const u32 *)(base + index + 1));
62
			current_size = *((const u32 *)(base + index + 1));
63
 
63
 
64
		if (index + current_size > total)
64
		if (index + current_size > total)
65
			return NULL;
65
			return NULL;
66
 
66
 
67
		if (current_id == section_id)
67
		if (current_id == section_id)
68
			return base + index;
68
			return base + index;
69
 
69
 
70
		index += current_size;
70
		index += current_size;
71
	}
71
	}
72
 
72
 
73
	return NULL;
73
	return NULL;
74
}
74
}
75
 
75
 
76
static u16
76
static u16
77
get_blocksize(const void *p)
77
get_blocksize(const void *p)
78
{
78
{
79
	u16 *block_ptr, block_size;
79
	u16 *block_ptr, block_size;
80
 
80
 
81
	block_ptr = (u16 *)((char *)p - 2);
81
	block_ptr = (u16 *)((char *)p - 2);
82
	block_size = *block_ptr;
82
	block_size = *block_ptr;
83
	return block_size;
83
	return block_size;
84
}
84
}
85
 
85
 
86
static void
86
static void
87
fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode,
87
fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode,
88
			const struct lvds_dvo_timing *dvo_timing)
88
			const struct lvds_dvo_timing *dvo_timing)
89
{
89
{
90
	panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) |
90
	panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) |
91
		dvo_timing->hactive_lo;
91
		dvo_timing->hactive_lo;
92
	panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay +
92
	panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay +
93
		((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo);
93
		((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo);
94
	panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start +
94
	panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start +
95
		dvo_timing->hsync_pulse_width;
95
		dvo_timing->hsync_pulse_width;
96
	panel_fixed_mode->htotal = panel_fixed_mode->hdisplay +
96
	panel_fixed_mode->htotal = panel_fixed_mode->hdisplay +
97
		((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo);
97
		((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo);
98
 
98
 
99
	panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) |
99
	panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) |
100
		dvo_timing->vactive_lo;
100
		dvo_timing->vactive_lo;
101
	panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay +
101
	panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay +
102
		dvo_timing->vsync_off;
102
		dvo_timing->vsync_off;
103
	panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start +
103
	panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start +
104
		dvo_timing->vsync_pulse_width;
104
		dvo_timing->vsync_pulse_width;
105
	panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay +
105
	panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay +
106
		((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo);
106
		((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo);
107
	panel_fixed_mode->clock = dvo_timing->clock * 10;
107
	panel_fixed_mode->clock = dvo_timing->clock * 10;
108
	panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED;
108
	panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED;
109
 
109
 
110
	if (dvo_timing->hsync_positive)
110
	if (dvo_timing->hsync_positive)
111
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC;
111
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC;
112
	else
112
	else
113
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC;
113
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC;
114
 
114
 
115
	if (dvo_timing->vsync_positive)
115
	if (dvo_timing->vsync_positive)
116
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC;
116
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC;
117
	else
117
	else
118
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC;
118
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC;
119
 
119
 
120
	/* Some VBTs have bogus h/vtotal values */
120
	/* Some VBTs have bogus h/vtotal values */
121
	if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal)
121
	if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal)
122
		panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1;
122
		panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1;
123
	if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal)
123
	if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal)
124
		panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1;
124
		panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1;
125
 
125
 
126
	drm_mode_set_name(panel_fixed_mode);
126
	drm_mode_set_name(panel_fixed_mode);
127
}
127
}
128
 
128
 
129
static const struct lvds_dvo_timing *
129
static const struct lvds_dvo_timing *
130
get_lvds_dvo_timing(const struct bdb_lvds_lfp_data *lvds_lfp_data,
130
get_lvds_dvo_timing(const struct bdb_lvds_lfp_data *lvds_lfp_data,
131
		    const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs,
131
		    const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs,
132
		    int index)
132
		    int index)
133
{
133
{
134
	/*
134
	/*
135
	 * the size of fp_timing varies on the different platform.
135
	 * the size of fp_timing varies on the different platform.
136
	 * So calculate the DVO timing relative offset in LVDS data
136
	 * So calculate the DVO timing relative offset in LVDS data
137
	 * entry to get the DVO timing entry
137
	 * entry to get the DVO timing entry
138
	 */
138
	 */
139
 
139
 
140
	int lfp_data_size =
140
	int lfp_data_size =
141
		lvds_lfp_data_ptrs->ptr[1].dvo_timing_offset -
141
		lvds_lfp_data_ptrs->ptr[1].dvo_timing_offset -
142
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset;
142
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset;
143
	int dvo_timing_offset =
143
	int dvo_timing_offset =
144
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset -
144
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset -
145
		lvds_lfp_data_ptrs->ptr[0].fp_timing_offset;
145
		lvds_lfp_data_ptrs->ptr[0].fp_timing_offset;
146
	char *entry = (char *)lvds_lfp_data->data + lfp_data_size * index;
146
	char *entry = (char *)lvds_lfp_data->data + lfp_data_size * index;
147
 
147
 
148
	return (struct lvds_dvo_timing *)(entry + dvo_timing_offset);
148
	return (struct lvds_dvo_timing *)(entry + dvo_timing_offset);
149
}
149
}
150
 
150
 
151
/* get lvds_fp_timing entry
151
/* get lvds_fp_timing entry
152
 * this function may return NULL if the corresponding entry is invalid
152
 * this function may return NULL if the corresponding entry is invalid
153
 */
153
 */
154
static const struct lvds_fp_timing *
154
static const struct lvds_fp_timing *
155
get_lvds_fp_timing(const struct bdb_header *bdb,
155
get_lvds_fp_timing(const struct bdb_header *bdb,
156
		   const struct bdb_lvds_lfp_data *data,
156
		   const struct bdb_lvds_lfp_data *data,
157
		   const struct bdb_lvds_lfp_data_ptrs *ptrs,
157
		   const struct bdb_lvds_lfp_data_ptrs *ptrs,
158
		   int index)
158
		   int index)
159
{
159
{
160
	size_t data_ofs = (const u8 *)data - (const u8 *)bdb;
160
	size_t data_ofs = (const u8 *)data - (const u8 *)bdb;
161
	u16 data_size = ((const u16 *)data)[-1]; /* stored in header */
161
	u16 data_size = ((const u16 *)data)[-1]; /* stored in header */
162
	size_t ofs;
162
	size_t ofs;
163
 
163
 
164
	if (index >= ARRAY_SIZE(ptrs->ptr))
164
	if (index >= ARRAY_SIZE(ptrs->ptr))
165
		return NULL;
165
		return NULL;
166
	ofs = ptrs->ptr[index].fp_timing_offset;
166
	ofs = ptrs->ptr[index].fp_timing_offset;
167
	if (ofs < data_ofs ||
167
	if (ofs < data_ofs ||
168
	    ofs + sizeof(struct lvds_fp_timing) > data_ofs + data_size)
168
	    ofs + sizeof(struct lvds_fp_timing) > data_ofs + data_size)
169
		return NULL;
169
		return NULL;
170
	return (const struct lvds_fp_timing *)((const u8 *)bdb + ofs);
170
	return (const struct lvds_fp_timing *)((const u8 *)bdb + ofs);
171
}
171
}
172
 
172
 
173
/* Try to find integrated panel data */
173
/* Try to find integrated panel data */
174
static void
174
static void
175
parse_lfp_panel_data(struct drm_i915_private *dev_priv,
175
parse_lfp_panel_data(struct drm_i915_private *dev_priv,
176
		     const struct bdb_header *bdb)
176
		     const struct bdb_header *bdb)
177
{
177
{
178
	const struct bdb_lvds_options *lvds_options;
178
	const struct bdb_lvds_options *lvds_options;
179
	const struct bdb_lvds_lfp_data *lvds_lfp_data;
179
	const struct bdb_lvds_lfp_data *lvds_lfp_data;
180
	const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs;
180
	const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs;
181
	const struct lvds_dvo_timing *panel_dvo_timing;
181
	const struct lvds_dvo_timing *panel_dvo_timing;
182
	const struct lvds_fp_timing *fp_timing;
182
	const struct lvds_fp_timing *fp_timing;
183
	struct drm_display_mode *panel_fixed_mode;
183
	struct drm_display_mode *panel_fixed_mode;
184
	int drrs_mode;
184
	int drrs_mode;
185
 
185
 
186
	lvds_options = find_section(bdb, BDB_LVDS_OPTIONS);
186
	lvds_options = find_section(bdb, BDB_LVDS_OPTIONS);
187
	if (!lvds_options)
187
	if (!lvds_options)
188
		return;
188
		return;
189
 
189
 
190
	dev_priv->vbt.lvds_dither = lvds_options->pixel_dither;
190
	dev_priv->vbt.lvds_dither = lvds_options->pixel_dither;
191
	if (lvds_options->panel_type == 0xff)
191
	if (lvds_options->panel_type == 0xff)
192
		return;
192
		return;
193
 
193
 
194
	panel_type = lvds_options->panel_type;
194
	panel_type = lvds_options->panel_type;
195
 
195
 
196
	drrs_mode = (lvds_options->dps_panel_type_bits
196
	drrs_mode = (lvds_options->dps_panel_type_bits
197
				>> (panel_type * 2)) & MODE_MASK;
197
				>> (panel_type * 2)) & MODE_MASK;
198
	/*
198
	/*
199
	 * VBT has static DRRS = 0 and seamless DRRS = 2.
199
	 * VBT has static DRRS = 0 and seamless DRRS = 2.
200
	 * The below piece of code is required to adjust vbt.drrs_type
200
	 * The below piece of code is required to adjust vbt.drrs_type
201
	 * to match the enum drrs_support_type.
201
	 * to match the enum drrs_support_type.
202
	 */
202
	 */
203
	switch (drrs_mode) {
203
	switch (drrs_mode) {
204
	case 0:
204
	case 0:
205
		dev_priv->vbt.drrs_type = STATIC_DRRS_SUPPORT;
205
		dev_priv->vbt.drrs_type = STATIC_DRRS_SUPPORT;
206
		DRM_DEBUG_KMS("DRRS supported mode is static\n");
206
		DRM_DEBUG_KMS("DRRS supported mode is static\n");
207
		break;
207
		break;
208
	case 2:
208
	case 2:
209
		dev_priv->vbt.drrs_type = SEAMLESS_DRRS_SUPPORT;
209
		dev_priv->vbt.drrs_type = SEAMLESS_DRRS_SUPPORT;
210
		DRM_DEBUG_KMS("DRRS supported mode is seamless\n");
210
		DRM_DEBUG_KMS("DRRS supported mode is seamless\n");
211
		break;
211
		break;
212
	default:
212
	default:
213
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
213
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
214
		DRM_DEBUG_KMS("DRRS not supported (VBT input)\n");
214
		DRM_DEBUG_KMS("DRRS not supported (VBT input)\n");
215
		break;
215
		break;
216
	}
216
	}
217
 
217
 
218
	lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA);
218
	lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA);
219
	if (!lvds_lfp_data)
219
	if (!lvds_lfp_data)
220
		return;
220
		return;
221
 
221
 
222
	lvds_lfp_data_ptrs = find_section(bdb, BDB_LVDS_LFP_DATA_PTRS);
222
	lvds_lfp_data_ptrs = find_section(bdb, BDB_LVDS_LFP_DATA_PTRS);
223
	if (!lvds_lfp_data_ptrs)
223
	if (!lvds_lfp_data_ptrs)
224
		return;
224
		return;
225
 
225
 
226
	dev_priv->vbt.lvds_vbt = 1;
226
	dev_priv->vbt.lvds_vbt = 1;
227
 
227
 
228
	panel_dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
228
	panel_dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
229
					       lvds_lfp_data_ptrs,
229
					       lvds_lfp_data_ptrs,
230
					       lvds_options->panel_type);
230
					       lvds_options->panel_type);
231
 
231
 
232
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
232
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
233
	if (!panel_fixed_mode)
233
	if (!panel_fixed_mode)
234
		return;
234
		return;
235
 
235
 
236
	fill_detail_timing_data(panel_fixed_mode, panel_dvo_timing);
236
	fill_detail_timing_data(panel_fixed_mode, panel_dvo_timing);
237
 
237
 
238
	dev_priv->vbt.lfp_lvds_vbt_mode = panel_fixed_mode;
238
	dev_priv->vbt.lfp_lvds_vbt_mode = panel_fixed_mode;
239
 
239
 
240
	DRM_DEBUG_KMS("Found panel mode in BIOS VBT tables:\n");
240
	DRM_DEBUG_KMS("Found panel mode in BIOS VBT tables:\n");
241
	drm_mode_debug_printmodeline(panel_fixed_mode);
241
	drm_mode_debug_printmodeline(panel_fixed_mode);
242
 
242
 
243
	fp_timing = get_lvds_fp_timing(bdb, lvds_lfp_data,
243
	fp_timing = get_lvds_fp_timing(bdb, lvds_lfp_data,
244
				       lvds_lfp_data_ptrs,
244
				       lvds_lfp_data_ptrs,
245
				       lvds_options->panel_type);
245
				       lvds_options->panel_type);
246
	if (fp_timing) {
246
	if (fp_timing) {
247
		/* check the resolution, just to be sure */
247
		/* check the resolution, just to be sure */
248
		if (fp_timing->x_res == panel_fixed_mode->hdisplay &&
248
		if (fp_timing->x_res == panel_fixed_mode->hdisplay &&
249
		    fp_timing->y_res == panel_fixed_mode->vdisplay) {
249
		    fp_timing->y_res == panel_fixed_mode->vdisplay) {
250
			dev_priv->vbt.bios_lvds_val = fp_timing->lvds_reg_val;
250
			dev_priv->vbt.bios_lvds_val = fp_timing->lvds_reg_val;
251
			DRM_DEBUG_KMS("VBT initial LVDS value %x\n",
251
			DRM_DEBUG_KMS("VBT initial LVDS value %x\n",
252
				      dev_priv->vbt.bios_lvds_val);
252
				      dev_priv->vbt.bios_lvds_val);
253
		}
253
		}
254
	}
254
	}
255
}
255
}
256
 
256
 
257
static void
257
static void
258
parse_lfp_backlight(struct drm_i915_private *dev_priv,
258
parse_lfp_backlight(struct drm_i915_private *dev_priv,
259
		    const struct bdb_header *bdb)
259
		    const struct bdb_header *bdb)
260
{
260
{
261
	const struct bdb_lfp_backlight_data *backlight_data;
261
	const struct bdb_lfp_backlight_data *backlight_data;
262
	const struct bdb_lfp_backlight_data_entry *entry;
262
	const struct bdb_lfp_backlight_data_entry *entry;
263
 
263
 
264
	backlight_data = find_section(bdb, BDB_LVDS_BACKLIGHT);
264
	backlight_data = find_section(bdb, BDB_LVDS_BACKLIGHT);
265
	if (!backlight_data)
265
	if (!backlight_data)
266
		return;
266
		return;
267
 
267
 
268
	if (backlight_data->entry_size != sizeof(backlight_data->data[0])) {
268
	if (backlight_data->entry_size != sizeof(backlight_data->data[0])) {
269
		DRM_DEBUG_KMS("Unsupported backlight data entry size %u\n",
269
		DRM_DEBUG_KMS("Unsupported backlight data entry size %u\n",
270
			      backlight_data->entry_size);
270
			      backlight_data->entry_size);
271
		return;
271
		return;
272
	}
272
	}
273
 
273
 
274
	entry = &backlight_data->data[panel_type];
274
	entry = &backlight_data->data[panel_type];
275
 
275
 
276
	dev_priv->vbt.backlight.present = entry->type == BDB_BACKLIGHT_TYPE_PWM;
276
	dev_priv->vbt.backlight.present = entry->type == BDB_BACKLIGHT_TYPE_PWM;
277
	if (!dev_priv->vbt.backlight.present) {
277
	if (!dev_priv->vbt.backlight.present) {
278
		DRM_DEBUG_KMS("PWM backlight not present in VBT (type %u)\n",
278
		DRM_DEBUG_KMS("PWM backlight not present in VBT (type %u)\n",
279
			      entry->type);
279
			      entry->type);
280
		return;
280
		return;
281
	}
281
	}
282
 
282
 
283
	dev_priv->vbt.backlight.pwm_freq_hz = entry->pwm_freq_hz;
283
	dev_priv->vbt.backlight.pwm_freq_hz = entry->pwm_freq_hz;
284
	dev_priv->vbt.backlight.active_low_pwm = entry->active_low_pwm;
284
	dev_priv->vbt.backlight.active_low_pwm = entry->active_low_pwm;
285
	dev_priv->vbt.backlight.min_brightness = entry->min_brightness;
285
	dev_priv->vbt.backlight.min_brightness = entry->min_brightness;
286
	DRM_DEBUG_KMS("VBT backlight PWM modulation frequency %u Hz, "
286
	DRM_DEBUG_KMS("VBT backlight PWM modulation frequency %u Hz, "
287
		      "active %s, min brightness %u, level %u\n",
287
		      "active %s, min brightness %u, level %u\n",
288
		      dev_priv->vbt.backlight.pwm_freq_hz,
288
		      dev_priv->vbt.backlight.pwm_freq_hz,
289
		      dev_priv->vbt.backlight.active_low_pwm ? "low" : "high",
289
		      dev_priv->vbt.backlight.active_low_pwm ? "low" : "high",
290
		      dev_priv->vbt.backlight.min_brightness,
290
		      dev_priv->vbt.backlight.min_brightness,
291
		      backlight_data->level[panel_type]);
291
		      backlight_data->level[panel_type]);
292
}
292
}
293
 
293
 
294
/* Try to find sdvo panel data */
294
/* Try to find sdvo panel data */
295
static void
295
static void
296
parse_sdvo_panel_data(struct drm_i915_private *dev_priv,
296
parse_sdvo_panel_data(struct drm_i915_private *dev_priv,
297
		      const struct bdb_header *bdb)
297
		      const struct bdb_header *bdb)
298
{
298
{
299
	const struct lvds_dvo_timing *dvo_timing;
299
	const struct lvds_dvo_timing *dvo_timing;
300
	struct drm_display_mode *panel_fixed_mode;
300
	struct drm_display_mode *panel_fixed_mode;
301
	int index;
301
	int index;
302
 
302
 
303
	index = i915.vbt_sdvo_panel_type;
303
	index = i915.vbt_sdvo_panel_type;
304
	if (index == -2) {
304
	if (index == -2) {
305
		DRM_DEBUG_KMS("Ignore SDVO panel mode from BIOS VBT tables.\n");
305
		DRM_DEBUG_KMS("Ignore SDVO panel mode from BIOS VBT tables.\n");
306
		return;
306
		return;
307
	}
307
	}
308
 
308
 
309
	if (index == -1) {
309
	if (index == -1) {
310
		const struct bdb_sdvo_lvds_options *sdvo_lvds_options;
310
		const struct bdb_sdvo_lvds_options *sdvo_lvds_options;
311
 
311
 
312
		sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS);
312
		sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS);
313
		if (!sdvo_lvds_options)
313
		if (!sdvo_lvds_options)
314
			return;
314
			return;
315
 
315
 
316
		index = sdvo_lvds_options->panel_type;
316
		index = sdvo_lvds_options->panel_type;
317
	}
317
	}
318
 
318
 
319
	dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS);
319
	dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS);
320
	if (!dvo_timing)
320
	if (!dvo_timing)
321
		return;
321
		return;
322
 
322
 
323
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
323
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
324
	if (!panel_fixed_mode)
324
	if (!panel_fixed_mode)
325
		return;
325
		return;
326
 
326
 
327
	fill_detail_timing_data(panel_fixed_mode, dvo_timing + index);
327
	fill_detail_timing_data(panel_fixed_mode, dvo_timing + index);
328
 
328
 
329
	dev_priv->vbt.sdvo_lvds_vbt_mode = panel_fixed_mode;
329
	dev_priv->vbt.sdvo_lvds_vbt_mode = panel_fixed_mode;
330
 
330
 
331
	DRM_DEBUG_KMS("Found SDVO panel mode in BIOS VBT tables:\n");
331
	DRM_DEBUG_KMS("Found SDVO panel mode in BIOS VBT tables:\n");
332
	drm_mode_debug_printmodeline(panel_fixed_mode);
332
	drm_mode_debug_printmodeline(panel_fixed_mode);
333
}
333
}
334
 
334
 
335
static int intel_bios_ssc_frequency(struct drm_device *dev,
335
static int intel_bios_ssc_frequency(struct drm_i915_private *dev_priv,
336
				    bool alternate)
336
				    bool alternate)
337
{
337
{
338
	switch (INTEL_INFO(dev)->gen) {
338
	switch (INTEL_INFO(dev_priv)->gen) {
339
	case 2:
339
	case 2:
340
		return alternate ? 66667 : 48000;
340
		return alternate ? 66667 : 48000;
341
	case 3:
341
	case 3:
342
	case 4:
342
	case 4:
343
		return alternate ? 100000 : 96000;
343
		return alternate ? 100000 : 96000;
344
	default:
344
	default:
345
		return alternate ? 100000 : 120000;
345
		return alternate ? 100000 : 120000;
346
	}
346
	}
347
}
347
}
348
 
348
 
349
static void
349
static void
350
parse_general_features(struct drm_i915_private *dev_priv,
350
parse_general_features(struct drm_i915_private *dev_priv,
351
		       const struct bdb_header *bdb)
351
		       const struct bdb_header *bdb)
352
{
352
{
353
	struct drm_device *dev = dev_priv->dev;
-
 
354
	const struct bdb_general_features *general;
353
	const struct bdb_general_features *general;
355
 
354
 
356
	general = find_section(bdb, BDB_GENERAL_FEATURES);
355
	general = find_section(bdb, BDB_GENERAL_FEATURES);
357
	if (general) {
356
	if (!general)
-
 
357
		return;
-
 
358
 
358
		dev_priv->vbt.int_tv_support = general->int_tv_support;
359
		dev_priv->vbt.int_tv_support = general->int_tv_support;
-
 
360
	/* int_crt_support can't be trusted on earlier platforms */
-
 
361
	if (bdb->version >= 155 &&
-
 
362
	    (HAS_DDI(dev_priv) || IS_VALLEYVIEW(dev_priv)))
359
		dev_priv->vbt.int_crt_support = general->int_crt_support;
363
		dev_priv->vbt.int_crt_support = general->int_crt_support;
360
		dev_priv->vbt.lvds_use_ssc = general->enable_ssc;
364
		dev_priv->vbt.lvds_use_ssc = general->enable_ssc;
361
		dev_priv->vbt.lvds_ssc_freq =
365
		dev_priv->vbt.lvds_ssc_freq =
362
			intel_bios_ssc_frequency(dev, general->ssc_freq);
366
		intel_bios_ssc_frequency(dev_priv, general->ssc_freq);
363
		dev_priv->vbt.display_clock_mode = general->display_clock_mode;
367
		dev_priv->vbt.display_clock_mode = general->display_clock_mode;
364
		dev_priv->vbt.fdi_rx_polarity_inverted = general->fdi_rx_polarity_inverted;
368
		dev_priv->vbt.fdi_rx_polarity_inverted = general->fdi_rx_polarity_inverted;
365
		DRM_DEBUG_KMS("BDB_GENERAL_FEATURES int_tv_support %d int_crt_support %d lvds_use_ssc %d lvds_ssc_freq %d display_clock_mode %d fdi_rx_polarity_inverted %d\n",
369
		DRM_DEBUG_KMS("BDB_GENERAL_FEATURES int_tv_support %d int_crt_support %d lvds_use_ssc %d lvds_ssc_freq %d display_clock_mode %d fdi_rx_polarity_inverted %d\n",
366
			      dev_priv->vbt.int_tv_support,
370
			      dev_priv->vbt.int_tv_support,
367
			      dev_priv->vbt.int_crt_support,
371
			      dev_priv->vbt.int_crt_support,
368
			      dev_priv->vbt.lvds_use_ssc,
372
			      dev_priv->vbt.lvds_use_ssc,
369
			      dev_priv->vbt.lvds_ssc_freq,
373
			      dev_priv->vbt.lvds_ssc_freq,
370
			      dev_priv->vbt.display_clock_mode,
374
			      dev_priv->vbt.display_clock_mode,
371
			      dev_priv->vbt.fdi_rx_polarity_inverted);
375
			      dev_priv->vbt.fdi_rx_polarity_inverted);
372
	}
376
	}
373
}
-
 
374
 
377
 
375
static void
378
static void
376
parse_general_definitions(struct drm_i915_private *dev_priv,
379
parse_general_definitions(struct drm_i915_private *dev_priv,
377
			  const struct bdb_header *bdb)
380
			  const struct bdb_header *bdb)
378
{
381
{
379
	const struct bdb_general_definitions *general;
382
	const struct bdb_general_definitions *general;
380
 
383
 
381
	general = find_section(bdb, BDB_GENERAL_DEFINITIONS);
384
	general = find_section(bdb, BDB_GENERAL_DEFINITIONS);
382
	if (general) {
385
	if (general) {
383
		u16 block_size = get_blocksize(general);
386
		u16 block_size = get_blocksize(general);
384
		if (block_size >= sizeof(*general)) {
387
		if (block_size >= sizeof(*general)) {
385
			int bus_pin = general->crt_ddc_gmbus_pin;
388
			int bus_pin = general->crt_ddc_gmbus_pin;
386
			DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
389
			DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
387
			if (intel_gmbus_is_valid_pin(dev_priv, bus_pin))
390
			if (intel_gmbus_is_valid_pin(dev_priv, bus_pin))
388
				dev_priv->vbt.crt_ddc_pin = bus_pin;
391
				dev_priv->vbt.crt_ddc_pin = bus_pin;
389
		} else {
392
		} else {
390
			DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
393
			DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
391
				      block_size);
394
				      block_size);
392
		}
395
		}
393
	}
396
	}
394
}
397
}
395
 
398
 
396
static const union child_device_config *
399
static const union child_device_config *
397
child_device_ptr(const struct bdb_general_definitions *p_defs, int i)
400
child_device_ptr(const struct bdb_general_definitions *p_defs, int i)
398
{
401
{
399
	return (const void *) &p_defs->devices[i * p_defs->child_dev_size];
402
	return (const void *) &p_defs->devices[i * p_defs->child_dev_size];
400
}
403
}
401
 
404
 
402
static void
405
static void
403
parse_sdvo_device_mapping(struct drm_i915_private *dev_priv,
406
parse_sdvo_device_mapping(struct drm_i915_private *dev_priv,
404
			  const struct bdb_header *bdb)
407
			  const struct bdb_header *bdb)
405
{
408
{
406
	struct sdvo_device_mapping *p_mapping;
409
	struct sdvo_device_mapping *p_mapping;
407
	const struct bdb_general_definitions *p_defs;
410
	const struct bdb_general_definitions *p_defs;
408
	const struct old_child_dev_config *child; /* legacy */
411
	const struct old_child_dev_config *child; /* legacy */
409
	int i, child_device_num, count;
412
	int i, child_device_num, count;
410
	u16	block_size;
413
	u16	block_size;
411
 
414
 
412
	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
415
	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
413
	if (!p_defs) {
416
	if (!p_defs) {
414
		DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n");
417
		DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n");
415
		return;
418
		return;
416
	}
419
	}
417
 
420
 
418
	/*
421
	/*
419
	 * Only parse SDVO mappings when the general definitions block child
422
	 * Only parse SDVO mappings when the general definitions block child
420
	 * device size matches that of the *legacy* child device config
423
	 * device size matches that of the *legacy* child device config
421
	 * struct. Thus, SDVO mapping will be skipped for newer VBT.
424
	 * struct. Thus, SDVO mapping will be skipped for newer VBT.
422
	 */
425
	 */
423
	if (p_defs->child_dev_size != sizeof(*child)) {
426
	if (p_defs->child_dev_size != sizeof(*child)) {
424
		DRM_DEBUG_KMS("Unsupported child device size for SDVO mapping.\n");
427
		DRM_DEBUG_KMS("Unsupported child device size for SDVO mapping.\n");
425
		return;
428
		return;
426
	}
429
	}
427
	/* get the block size of general definitions */
430
	/* get the block size of general definitions */
428
	block_size = get_blocksize(p_defs);
431
	block_size = get_blocksize(p_defs);
429
	/* get the number of child device */
432
	/* get the number of child device */
430
	child_device_num = (block_size - sizeof(*p_defs)) /
433
	child_device_num = (block_size - sizeof(*p_defs)) /
431
		p_defs->child_dev_size;
434
		p_defs->child_dev_size;
432
	count = 0;
435
	count = 0;
433
	for (i = 0; i < child_device_num; i++) {
436
	for (i = 0; i < child_device_num; i++) {
434
		child = &child_device_ptr(p_defs, i)->old;
437
		child = &child_device_ptr(p_defs, i)->old;
435
		if (!child->device_type) {
438
		if (!child->device_type) {
436
			/* skip the device block if device type is invalid */
439
			/* skip the device block if device type is invalid */
437
			continue;
440
			continue;
438
		}
441
		}
439
		if (child->slave_addr != SLAVE_ADDR1 &&
442
		if (child->slave_addr != SLAVE_ADDR1 &&
440
		    child->slave_addr != SLAVE_ADDR2) {
443
		    child->slave_addr != SLAVE_ADDR2) {
441
			/*
444
			/*
442
			 * If the slave address is neither 0x70 nor 0x72,
445
			 * If the slave address is neither 0x70 nor 0x72,
443
			 * it is not a SDVO device. Skip it.
446
			 * it is not a SDVO device. Skip it.
444
			 */
447
			 */
445
			continue;
448
			continue;
446
		}
449
		}
447
		if (child->dvo_port != DEVICE_PORT_DVOB &&
450
		if (child->dvo_port != DEVICE_PORT_DVOB &&
448
		    child->dvo_port != DEVICE_PORT_DVOC) {
451
		    child->dvo_port != DEVICE_PORT_DVOC) {
449
			/* skip the incorrect SDVO port */
452
			/* skip the incorrect SDVO port */
450
			DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n");
453
			DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n");
451
			continue;
454
			continue;
452
		}
455
		}
453
		DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on"
456
		DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on"
454
			      " %s port\n",
457
			      " %s port\n",
455
			      child->slave_addr,
458
			      child->slave_addr,
456
			      (child->dvo_port == DEVICE_PORT_DVOB) ?
459
			      (child->dvo_port == DEVICE_PORT_DVOB) ?
457
			      "SDVOB" : "SDVOC");
460
			      "SDVOB" : "SDVOC");
458
		p_mapping = &(dev_priv->sdvo_mappings[child->dvo_port - 1]);
461
		p_mapping = &(dev_priv->sdvo_mappings[child->dvo_port - 1]);
459
		if (!p_mapping->initialized) {
462
		if (!p_mapping->initialized) {
460
			p_mapping->dvo_port = child->dvo_port;
463
			p_mapping->dvo_port = child->dvo_port;
461
			p_mapping->slave_addr = child->slave_addr;
464
			p_mapping->slave_addr = child->slave_addr;
462
			p_mapping->dvo_wiring = child->dvo_wiring;
465
			p_mapping->dvo_wiring = child->dvo_wiring;
463
			p_mapping->ddc_pin = child->ddc_pin;
466
			p_mapping->ddc_pin = child->ddc_pin;
464
			p_mapping->i2c_pin = child->i2c_pin;
467
			p_mapping->i2c_pin = child->i2c_pin;
465
			p_mapping->initialized = 1;
468
			p_mapping->initialized = 1;
466
			DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n",
469
			DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n",
467
				      p_mapping->dvo_port,
470
				      p_mapping->dvo_port,
468
				      p_mapping->slave_addr,
471
				      p_mapping->slave_addr,
469
				      p_mapping->dvo_wiring,
472
				      p_mapping->dvo_wiring,
470
				      p_mapping->ddc_pin,
473
				      p_mapping->ddc_pin,
471
				      p_mapping->i2c_pin);
474
				      p_mapping->i2c_pin);
472
		} else {
475
		} else {
473
			DRM_DEBUG_KMS("Maybe one SDVO port is shared by "
476
			DRM_DEBUG_KMS("Maybe one SDVO port is shared by "
474
					 "two SDVO device.\n");
477
					 "two SDVO device.\n");
475
		}
478
		}
476
		if (child->slave2_addr) {
479
		if (child->slave2_addr) {
477
			/* Maybe this is a SDVO device with multiple inputs */
480
			/* Maybe this is a SDVO device with multiple inputs */
478
			/* And the mapping info is not added */
481
			/* And the mapping info is not added */
479
			DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this"
482
			DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this"
480
				" is a SDVO device with multiple inputs.\n");
483
				" is a SDVO device with multiple inputs.\n");
481
		}
484
		}
482
		count++;
485
		count++;
483
	}
486
	}
484
 
487
 
485
	if (!count) {
488
	if (!count) {
486
		/* No SDVO device info is found */
489
		/* No SDVO device info is found */
487
		DRM_DEBUG_KMS("No SDVO device info is found in VBT\n");
490
		DRM_DEBUG_KMS("No SDVO device info is found in VBT\n");
488
	}
491
	}
489
	return;
492
	return;
490
}
493
}
491
 
494
 
492
static void
495
static void
493
parse_driver_features(struct drm_i915_private *dev_priv,
496
parse_driver_features(struct drm_i915_private *dev_priv,
494
		      const struct bdb_header *bdb)
497
		      const struct bdb_header *bdb)
495
{
498
{
496
	const struct bdb_driver_features *driver;
499
	const struct bdb_driver_features *driver;
497
 
500
 
498
	driver = find_section(bdb, BDB_DRIVER_FEATURES);
501
	driver = find_section(bdb, BDB_DRIVER_FEATURES);
499
	if (!driver)
502
	if (!driver)
500
		return;
503
		return;
501
 
504
 
502
	if (driver->lvds_config == BDB_DRIVER_FEATURE_EDP)
505
	if (driver->lvds_config == BDB_DRIVER_FEATURE_EDP)
503
		dev_priv->vbt.edp_support = 1;
506
		dev_priv->vbt.edp_support = 1;
504
 
507
 
505
	if (driver->dual_frequency)
508
	if (driver->dual_frequency)
506
		dev_priv->render_reclock_avail = true;
509
		dev_priv->render_reclock_avail = true;
507
 
510
 
508
	DRM_DEBUG_KMS("DRRS State Enabled:%d\n", driver->drrs_enabled);
511
	DRM_DEBUG_KMS("DRRS State Enabled:%d\n", driver->drrs_enabled);
509
	/*
512
	/*
510
	 * If DRRS is not supported, drrs_type has to be set to 0.
513
	 * If DRRS is not supported, drrs_type has to be set to 0.
511
	 * This is because, VBT is configured in such a way that
514
	 * This is because, VBT is configured in such a way that
512
	 * static DRRS is 0 and DRRS not supported is represented by
515
	 * static DRRS is 0 and DRRS not supported is represented by
513
	 * driver->drrs_enabled=false
516
	 * driver->drrs_enabled=false
514
	 */
517
	 */
515
	if (!driver->drrs_enabled)
518
	if (!driver->drrs_enabled)
516
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
519
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
517
}
520
}
518
 
521
 
519
static void
522
static void
520
parse_edp(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
523
parse_edp(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
521
{
524
{
522
	const struct bdb_edp *edp;
525
	const struct bdb_edp *edp;
523
	const struct edp_power_seq *edp_pps;
526
	const struct edp_power_seq *edp_pps;
524
	const struct edp_link_params *edp_link_params;
527
	const struct edp_link_params *edp_link_params;
525
 
528
 
526
	edp = find_section(bdb, BDB_EDP);
529
	edp = find_section(bdb, BDB_EDP);
527
	if (!edp) {
530
	if (!edp) {
528
		if (dev_priv->vbt.edp_support)
531
		if (dev_priv->vbt.edp_support)
529
			DRM_DEBUG_KMS("No eDP BDB found but eDP panel supported.\n");
532
			DRM_DEBUG_KMS("No eDP BDB found but eDP panel supported.\n");
530
		return;
533
		return;
531
	}
534
	}
532
 
535
 
533
	switch ((edp->color_depth >> (panel_type * 2)) & 3) {
536
	switch ((edp->color_depth >> (panel_type * 2)) & 3) {
534
	case EDP_18BPP:
537
	case EDP_18BPP:
535
		dev_priv->vbt.edp_bpp = 18;
538
		dev_priv->vbt.edp_bpp = 18;
536
		break;
539
		break;
537
	case EDP_24BPP:
540
	case EDP_24BPP:
538
		dev_priv->vbt.edp_bpp = 24;
541
		dev_priv->vbt.edp_bpp = 24;
539
		break;
542
		break;
540
	case EDP_30BPP:
543
	case EDP_30BPP:
541
		dev_priv->vbt.edp_bpp = 30;
544
		dev_priv->vbt.edp_bpp = 30;
542
		break;
545
		break;
543
	}
546
	}
544
 
547
 
545
	/* Get the eDP sequencing and link info */
548
	/* Get the eDP sequencing and link info */
546
	edp_pps = &edp->power_seqs[panel_type];
549
	edp_pps = &edp->power_seqs[panel_type];
547
	edp_link_params = &edp->link_params[panel_type];
550
	edp_link_params = &edp->link_params[panel_type];
548
 
551
 
549
	dev_priv->vbt.edp_pps = *edp_pps;
552
	dev_priv->vbt.edp_pps = *edp_pps;
550
 
553
 
551
	switch (edp_link_params->rate) {
554
	switch (edp_link_params->rate) {
552
	case EDP_RATE_1_62:
555
	case EDP_RATE_1_62:
553
		dev_priv->vbt.edp_rate = DP_LINK_BW_1_62;
556
		dev_priv->vbt.edp_rate = DP_LINK_BW_1_62;
554
		break;
557
		break;
555
	case EDP_RATE_2_7:
558
	case EDP_RATE_2_7:
556
		dev_priv->vbt.edp_rate = DP_LINK_BW_2_7;
559
		dev_priv->vbt.edp_rate = DP_LINK_BW_2_7;
557
		break;
560
		break;
558
	default:
561
	default:
559
		DRM_DEBUG_KMS("VBT has unknown eDP link rate value %u\n",
562
		DRM_DEBUG_KMS("VBT has unknown eDP link rate value %u\n",
560
			      edp_link_params->rate);
563
			      edp_link_params->rate);
561
		break;
564
		break;
562
	}
565
	}
563
 
566
 
564
	switch (edp_link_params->lanes) {
567
	switch (edp_link_params->lanes) {
565
	case EDP_LANE_1:
568
	case EDP_LANE_1:
566
		dev_priv->vbt.edp_lanes = 1;
569
		dev_priv->vbt.edp_lanes = 1;
567
		break;
570
		break;
568
	case EDP_LANE_2:
571
	case EDP_LANE_2:
569
		dev_priv->vbt.edp_lanes = 2;
572
		dev_priv->vbt.edp_lanes = 2;
570
		break;
573
		break;
571
	case EDP_LANE_4:
574
	case EDP_LANE_4:
572
		dev_priv->vbt.edp_lanes = 4;
575
		dev_priv->vbt.edp_lanes = 4;
573
		break;
576
		break;
574
	default:
577
	default:
575
		DRM_DEBUG_KMS("VBT has unknown eDP lane count value %u\n",
578
		DRM_DEBUG_KMS("VBT has unknown eDP lane count value %u\n",
576
			      edp_link_params->lanes);
579
			      edp_link_params->lanes);
577
		break;
580
		break;
578
	}
581
	}
579
 
582
 
580
	switch (edp_link_params->preemphasis) {
583
	switch (edp_link_params->preemphasis) {
581
	case EDP_PREEMPHASIS_NONE:
584
	case EDP_PREEMPHASIS_NONE:
582
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_0;
585
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_0;
583
		break;
586
		break;
584
	case EDP_PREEMPHASIS_3_5dB:
587
	case EDP_PREEMPHASIS_3_5dB:
585
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_1;
588
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_1;
586
		break;
589
		break;
587
	case EDP_PREEMPHASIS_6dB:
590
	case EDP_PREEMPHASIS_6dB:
588
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_2;
591
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_2;
589
		break;
592
		break;
590
	case EDP_PREEMPHASIS_9_5dB:
593
	case EDP_PREEMPHASIS_9_5dB:
591
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_3;
594
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_3;
592
		break;
595
		break;
593
	default:
596
	default:
594
		DRM_DEBUG_KMS("VBT has unknown eDP pre-emphasis value %u\n",
597
		DRM_DEBUG_KMS("VBT has unknown eDP pre-emphasis value %u\n",
595
			      edp_link_params->preemphasis);
598
			      edp_link_params->preemphasis);
596
		break;
599
		break;
597
	}
600
	}
598
 
601
 
599
	switch (edp_link_params->vswing) {
602
	switch (edp_link_params->vswing) {
600
	case EDP_VSWING_0_4V:
603
	case EDP_VSWING_0_4V:
601
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_0;
604
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_0;
602
		break;
605
		break;
603
	case EDP_VSWING_0_6V:
606
	case EDP_VSWING_0_6V:
604
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_1;
607
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_1;
605
		break;
608
		break;
606
	case EDP_VSWING_0_8V:
609
	case EDP_VSWING_0_8V:
607
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_2;
610
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_2;
608
		break;
611
		break;
609
	case EDP_VSWING_1_2V:
612
	case EDP_VSWING_1_2V:
610
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_3;
613
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_3;
611
		break;
614
		break;
612
	default:
615
	default:
613
		DRM_DEBUG_KMS("VBT has unknown eDP voltage swing value %u\n",
616
		DRM_DEBUG_KMS("VBT has unknown eDP voltage swing value %u\n",
614
			      edp_link_params->vswing);
617
			      edp_link_params->vswing);
615
		break;
618
		break;
616
	}
619
	}
617
 
620
 
618
	if (bdb->version >= 173) {
621
	if (bdb->version >= 173) {
619
		uint8_t vswing;
622
		uint8_t vswing;
620
 
623
 
621
		/* Don't read from VBT if module parameter has valid value*/
624
		/* Don't read from VBT if module parameter has valid value*/
622
		if (i915.edp_vswing) {
625
		if (i915.edp_vswing) {
623
			dev_priv->edp_low_vswing = i915.edp_vswing == 1;
626
			dev_priv->edp_low_vswing = i915.edp_vswing == 1;
624
		} else {
627
		} else {
625
			vswing = (edp->edp_vswing_preemph >> (panel_type * 4)) & 0xF;
628
			vswing = (edp->edp_vswing_preemph >> (panel_type * 4)) & 0xF;
626
			dev_priv->edp_low_vswing = vswing == 0;
629
			dev_priv->edp_low_vswing = vswing == 0;
627
		}
630
		}
628
	}
631
	}
629
}
632
}
630
 
633
 
631
static void
634
static void
632
parse_psr(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
635
parse_psr(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
633
{
636
{
634
	const struct bdb_psr *psr;
637
	const struct bdb_psr *psr;
635
	const struct psr_table *psr_table;
638
	const struct psr_table *psr_table;
636
 
639
 
637
	psr = find_section(bdb, BDB_PSR);
640
	psr = find_section(bdb, BDB_PSR);
638
	if (!psr) {
641
	if (!psr) {
639
		DRM_DEBUG_KMS("No PSR BDB found.\n");
642
		DRM_DEBUG_KMS("No PSR BDB found.\n");
640
		return;
643
		return;
641
	}
644
	}
642
 
645
 
643
	psr_table = &psr->psr_table[panel_type];
646
	psr_table = &psr->psr_table[panel_type];
644
 
647
 
645
	dev_priv->vbt.psr.full_link = psr_table->full_link;
648
	dev_priv->vbt.psr.full_link = psr_table->full_link;
646
	dev_priv->vbt.psr.require_aux_wakeup = psr_table->require_aux_to_wakeup;
649
	dev_priv->vbt.psr.require_aux_wakeup = psr_table->require_aux_to_wakeup;
647
 
650
 
648
	/* Allowed VBT values goes from 0 to 15 */
651
	/* Allowed VBT values goes from 0 to 15 */
649
	dev_priv->vbt.psr.idle_frames = psr_table->idle_frames < 0 ? 0 :
652
	dev_priv->vbt.psr.idle_frames = psr_table->idle_frames < 0 ? 0 :
650
		psr_table->idle_frames > 15 ? 15 : psr_table->idle_frames;
653
		psr_table->idle_frames > 15 ? 15 : psr_table->idle_frames;
651
 
654
 
652
	switch (psr_table->lines_to_wait) {
655
	switch (psr_table->lines_to_wait) {
653
	case 0:
656
	case 0:
654
		dev_priv->vbt.psr.lines_to_wait = PSR_0_LINES_TO_WAIT;
657
		dev_priv->vbt.psr.lines_to_wait = PSR_0_LINES_TO_WAIT;
655
		break;
658
		break;
656
	case 1:
659
	case 1:
657
		dev_priv->vbt.psr.lines_to_wait = PSR_1_LINE_TO_WAIT;
660
		dev_priv->vbt.psr.lines_to_wait = PSR_1_LINE_TO_WAIT;
658
		break;
661
		break;
659
	case 2:
662
	case 2:
660
		dev_priv->vbt.psr.lines_to_wait = PSR_4_LINES_TO_WAIT;
663
		dev_priv->vbt.psr.lines_to_wait = PSR_4_LINES_TO_WAIT;
661
		break;
664
		break;
662
	case 3:
665
	case 3:
663
		dev_priv->vbt.psr.lines_to_wait = PSR_8_LINES_TO_WAIT;
666
		dev_priv->vbt.psr.lines_to_wait = PSR_8_LINES_TO_WAIT;
664
		break;
667
		break;
665
	default:
668
	default:
666
		DRM_DEBUG_KMS("VBT has unknown PSR lines to wait %u\n",
669
		DRM_DEBUG_KMS("VBT has unknown PSR lines to wait %u\n",
667
			      psr_table->lines_to_wait);
670
			      psr_table->lines_to_wait);
668
		break;
671
		break;
669
	}
672
	}
670
 
673
 
671
	dev_priv->vbt.psr.tp1_wakeup_time = psr_table->tp1_wakeup_time;
674
	dev_priv->vbt.psr.tp1_wakeup_time = psr_table->tp1_wakeup_time;
672
	dev_priv->vbt.psr.tp2_tp3_wakeup_time = psr_table->tp2_tp3_wakeup_time;
675
	dev_priv->vbt.psr.tp2_tp3_wakeup_time = psr_table->tp2_tp3_wakeup_time;
673
}
676
}
674
 
677
 
675
static u8 *goto_next_sequence(u8 *data, int *size)
678
static u8 *goto_next_sequence(u8 *data, int *size)
676
{
679
{
677
	u16 len;
680
	u16 len;
678
	int tmp = *size;
681
	int tmp = *size;
679
 
682
 
680
	if (--tmp < 0)
683
	if (--tmp < 0)
681
		return NULL;
684
		return NULL;
682
 
685
 
683
	/* goto first element */
686
	/* goto first element */
684
	data++;
687
	data++;
685
	while (1) {
688
	while (1) {
686
		switch (*data) {
689
		switch (*data) {
687
		case MIPI_SEQ_ELEM_SEND_PKT:
690
		case MIPI_SEQ_ELEM_SEND_PKT:
688
			/*
691
			/*
689
			 * skip by this element payload size
692
			 * skip by this element payload size
690
			 * skip elem id, command flag and data type
693
			 * skip elem id, command flag and data type
691
			 */
694
			 */
692
			tmp -= 5;
695
			tmp -= 5;
693
			if (tmp < 0)
696
			if (tmp < 0)
694
				return NULL;
697
				return NULL;
695
 
698
 
696
			data += 3;
699
			data += 3;
697
			len = *((u16 *)data);
700
			len = *((u16 *)data);
698
 
701
 
699
			tmp -= len;
702
			tmp -= len;
700
			if (tmp < 0)
703
			if (tmp < 0)
701
				return NULL;
704
				return NULL;
702
 
705
 
703
			/* skip by len */
706
			/* skip by len */
704
			data = data + 2 + len;
707
			data = data + 2 + len;
705
			break;
708
			break;
706
		case MIPI_SEQ_ELEM_DELAY:
709
		case MIPI_SEQ_ELEM_DELAY:
707
			/* skip by elem id, and delay is 4 bytes */
710
			/* skip by elem id, and delay is 4 bytes */
708
			tmp -= 5;
711
			tmp -= 5;
709
			if (tmp < 0)
712
			if (tmp < 0)
710
				return NULL;
713
				return NULL;
711
 
714
 
712
			data += 5;
715
			data += 5;
713
			break;
716
			break;
714
		case MIPI_SEQ_ELEM_GPIO:
717
		case MIPI_SEQ_ELEM_GPIO:
715
			tmp -= 3;
718
			tmp -= 3;
716
			if (tmp < 0)
719
			if (tmp < 0)
717
				return NULL;
720
				return NULL;
718
 
721
 
719
			data += 3;
722
			data += 3;
720
			break;
723
			break;
721
		default:
724
		default:
722
			DRM_ERROR("Unknown element\n");
725
			DRM_ERROR("Unknown element\n");
723
			return NULL;
726
			return NULL;
724
		}
727
		}
725
 
728
 
726
		/* end of sequence ? */
729
		/* end of sequence ? */
727
		if (*data == 0)
730
		if (*data == 0)
728
			break;
731
			break;
729
	}
732
	}
730
 
733
 
731
	/* goto next sequence or end of block byte */
734
	/* goto next sequence or end of block byte */
732
	if (--tmp < 0)
735
	if (--tmp < 0)
733
		return NULL;
736
		return NULL;
734
 
737
 
735
	data++;
738
	data++;
736
 
739
 
737
	/* update amount of data left for the sequence block to be parsed */
740
	/* update amount of data left for the sequence block to be parsed */
738
	*size = tmp;
741
	*size = tmp;
739
	return data;
742
	return data;
740
}
743
}
741
 
744
 
742
static void
745
static void
743
parse_mipi(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
746
parse_mipi(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
744
{
747
{
745
	const struct bdb_mipi_config *start;
748
	const struct bdb_mipi_config *start;
746
	const struct bdb_mipi_sequence *sequence;
749
	const struct bdb_mipi_sequence *sequence;
747
	const struct mipi_config *config;
750
	const struct mipi_config *config;
748
	const struct mipi_pps_data *pps;
751
	const struct mipi_pps_data *pps;
749
	u8 *data;
752
	u8 *data;
750
	const u8 *seq_data;
753
	const u8 *seq_data;
751
	int i, panel_id, seq_size;
754
	int i, panel_id, seq_size;
752
	u16 block_size;
755
	u16 block_size;
753
 
756
 
754
	/* parse MIPI blocks only if LFP type is MIPI */
757
	/* parse MIPI blocks only if LFP type is MIPI */
755
	if (!dev_priv->vbt.has_mipi)
758
	if (!dev_priv->vbt.has_mipi)
756
		return;
759
		return;
757
 
760
 
758
	/* Initialize this to undefined indicating no generic MIPI support */
761
	/* Initialize this to undefined indicating no generic MIPI support */
759
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_UNDEFINED_PANEL_ID;
762
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_UNDEFINED_PANEL_ID;
760
 
763
 
761
	/* Block #40 is already parsed and panel_fixed_mode is
764
	/* Block #40 is already parsed and panel_fixed_mode is
762
	 * stored in dev_priv->lfp_lvds_vbt_mode
765
	 * stored in dev_priv->lfp_lvds_vbt_mode
763
	 * resuse this when needed
766
	 * resuse this when needed
764
	 */
767
	 */
765
 
768
 
766
	/* Parse #52 for panel index used from panel_type already
769
	/* Parse #52 for panel index used from panel_type already
767
	 * parsed
770
	 * parsed
768
	 */
771
	 */
769
	start = find_section(bdb, BDB_MIPI_CONFIG);
772
	start = find_section(bdb, BDB_MIPI_CONFIG);
770
	if (!start) {
773
	if (!start) {
771
		DRM_DEBUG_KMS("No MIPI config BDB found");
774
		DRM_DEBUG_KMS("No MIPI config BDB found");
772
		return;
775
		return;
773
	}
776
	}
774
 
777
 
775
	DRM_DEBUG_DRIVER("Found MIPI Config block, panel index = %d\n",
778
	DRM_DEBUG_DRIVER("Found MIPI Config block, panel index = %d\n",
776
								panel_type);
779
								panel_type);
777
 
780
 
778
	/*
781
	/*
779
	 * get hold of the correct configuration block and pps data as per
782
	 * get hold of the correct configuration block and pps data as per
780
	 * the panel_type as index
783
	 * the panel_type as index
781
	 */
784
	 */
782
	config = &start->config[panel_type];
785
	config = &start->config[panel_type];
783
	pps = &start->pps[panel_type];
786
	pps = &start->pps[panel_type];
784
 
787
 
785
	/* store as of now full data. Trim when we realise all is not needed */
788
	/* store as of now full data. Trim when we realise all is not needed */
786
	dev_priv->vbt.dsi.config = kmemdup(config, sizeof(struct mipi_config), GFP_KERNEL);
789
	dev_priv->vbt.dsi.config = kmemdup(config, sizeof(struct mipi_config), GFP_KERNEL);
787
	if (!dev_priv->vbt.dsi.config)
790
	if (!dev_priv->vbt.dsi.config)
788
		return;
791
		return;
789
 
792
 
790
	dev_priv->vbt.dsi.pps = kmemdup(pps, sizeof(struct mipi_pps_data), GFP_KERNEL);
793
	dev_priv->vbt.dsi.pps = kmemdup(pps, sizeof(struct mipi_pps_data), GFP_KERNEL);
791
	if (!dev_priv->vbt.dsi.pps) {
794
	if (!dev_priv->vbt.dsi.pps) {
792
		kfree(dev_priv->vbt.dsi.config);
795
		kfree(dev_priv->vbt.dsi.config);
793
		return;
796
		return;
794
	}
797
	}
795
 
798
 
796
	/* We have mandatory mipi config blocks. Initialize as generic panel */
799
	/* We have mandatory mipi config blocks. Initialize as generic panel */
797
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_GENERIC_PANEL_ID;
800
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_GENERIC_PANEL_ID;
798
 
801
 
799
	/* Check if we have sequence block as well */
802
	/* Check if we have sequence block as well */
800
	sequence = find_section(bdb, BDB_MIPI_SEQUENCE);
803
	sequence = find_section(bdb, BDB_MIPI_SEQUENCE);
801
	if (!sequence) {
804
	if (!sequence) {
802
		DRM_DEBUG_KMS("No MIPI Sequence found, parsing complete\n");
805
		DRM_DEBUG_KMS("No MIPI Sequence found, parsing complete\n");
803
		return;
806
		return;
804
	}
807
	}
805
 
808
 
806
	/* Fail gracefully for forward incompatible sequence block. */
809
	/* Fail gracefully for forward incompatible sequence block. */
807
	if (sequence->version >= 3) {
810
	if (sequence->version >= 3) {
808
		DRM_ERROR("Unable to parse MIPI Sequence Block v3+\n");
811
		DRM_ERROR("Unable to parse MIPI Sequence Block v3+\n");
809
		return;
812
		return;
810
	}
813
	}
811
 
814
 
812
	DRM_DEBUG_DRIVER("Found MIPI sequence block\n");
815
	DRM_DEBUG_DRIVER("Found MIPI sequence block\n");
813
 
816
 
814
	block_size = get_blocksize(sequence);
817
	block_size = get_blocksize(sequence);
815
 
818
 
816
	/*
819
	/*
817
	 * parse the sequence block for individual sequences
820
	 * parse the sequence block for individual sequences
818
	 */
821
	 */
819
	dev_priv->vbt.dsi.seq_version = sequence->version;
822
	dev_priv->vbt.dsi.seq_version = sequence->version;
820
 
823
 
821
	seq_data = &sequence->data[0];
824
	seq_data = &sequence->data[0];
822
 
825
 
823
	/*
826
	/*
824
	 * sequence block is variable length and hence we need to parse and
827
	 * sequence block is variable length and hence we need to parse and
825
	 * get the sequence data for specific panel id
828
	 * get the sequence data for specific panel id
826
	 */
829
	 */
827
	for (i = 0; i < MAX_MIPI_CONFIGURATIONS; i++) {
830
	for (i = 0; i < MAX_MIPI_CONFIGURATIONS; i++) {
828
		panel_id = *seq_data;
831
		panel_id = *seq_data;
829
		seq_size = *((u16 *) (seq_data + 1));
832
		seq_size = *((u16 *) (seq_data + 1));
830
		if (panel_id == panel_type)
833
		if (panel_id == panel_type)
831
			break;
834
			break;
832
 
835
 
833
		/* skip the sequence including seq header of 3 bytes */
836
		/* skip the sequence including seq header of 3 bytes */
834
		seq_data = seq_data + 3 + seq_size;
837
		seq_data = seq_data + 3 + seq_size;
835
		if ((seq_data - &sequence->data[0]) > block_size) {
838
		if ((seq_data - &sequence->data[0]) > block_size) {
836
			DRM_ERROR("Sequence start is beyond sequence block size, corrupted sequence block\n");
839
			DRM_ERROR("Sequence start is beyond sequence block size, corrupted sequence block\n");
837
			return;
840
			return;
838
		}
841
		}
839
	}
842
	}
840
 
843
 
841
	if (i == MAX_MIPI_CONFIGURATIONS) {
844
	if (i == MAX_MIPI_CONFIGURATIONS) {
842
		DRM_ERROR("Sequence block detected but no valid configuration\n");
845
		DRM_ERROR("Sequence block detected but no valid configuration\n");
843
		return;
846
		return;
844
	}
847
	}
845
 
848
 
846
	/* check if found sequence is completely within the sequence block
849
	/* check if found sequence is completely within the sequence block
847
	 * just being paranoid */
850
	 * just being paranoid */
848
	if (seq_size > block_size) {
851
	if (seq_size > block_size) {
849
		DRM_ERROR("Corrupted sequence/size, bailing out\n");
852
		DRM_ERROR("Corrupted sequence/size, bailing out\n");
850
		return;
853
		return;
851
	}
854
	}
852
 
855
 
853
	/* skip the panel id(1 byte) and seq size(2 bytes) */
856
	/* skip the panel id(1 byte) and seq size(2 bytes) */
854
	dev_priv->vbt.dsi.data = kmemdup(seq_data + 3, seq_size, GFP_KERNEL);
857
	dev_priv->vbt.dsi.data = kmemdup(seq_data + 3, seq_size, GFP_KERNEL);
855
	if (!dev_priv->vbt.dsi.data)
858
	if (!dev_priv->vbt.dsi.data)
856
		return;
859
		return;
857
 
860
 
858
	/*
861
	/*
859
	 * loop into the sequence data and split into multiple sequneces
862
	 * loop into the sequence data and split into multiple sequneces
860
	 * There are only 5 types of sequences as of now
863
	 * There are only 5 types of sequences as of now
861
	 */
864
	 */
862
	data = dev_priv->vbt.dsi.data;
865
	data = dev_priv->vbt.dsi.data;
863
	dev_priv->vbt.dsi.size = seq_size;
866
	dev_priv->vbt.dsi.size = seq_size;
864
 
867
 
865
	/* two consecutive 0x00 indicate end of all sequences */
868
	/* two consecutive 0x00 indicate end of all sequences */
866
	while (1) {
869
	while (1) {
867
		int seq_id = *data;
870
		int seq_id = *data;
868
		if (MIPI_SEQ_MAX > seq_id && seq_id > MIPI_SEQ_UNDEFINED) {
871
		if (MIPI_SEQ_MAX > seq_id && seq_id > MIPI_SEQ_UNDEFINED) {
869
			dev_priv->vbt.dsi.sequence[seq_id] = data;
872
			dev_priv->vbt.dsi.sequence[seq_id] = data;
870
			DRM_DEBUG_DRIVER("Found mipi sequence - %d\n", seq_id);
873
			DRM_DEBUG_DRIVER("Found mipi sequence - %d\n", seq_id);
871
		} else {
874
		} else {
872
			DRM_ERROR("undefined sequence\n");
875
			DRM_ERROR("undefined sequence\n");
873
			goto err;
876
			goto err;
874
		}
877
		}
875
 
878
 
876
		/* partial parsing to skip elements */
879
		/* partial parsing to skip elements */
877
		data = goto_next_sequence(data, &seq_size);
880
		data = goto_next_sequence(data, &seq_size);
878
 
881
 
879
		if (data == NULL) {
882
		if (data == NULL) {
880
			DRM_ERROR("Sequence elements going beyond block itself. Sequence block parsing failed\n");
883
			DRM_ERROR("Sequence elements going beyond block itself. Sequence block parsing failed\n");
881
			goto err;
884
			goto err;
882
		}
885
		}
883
 
886
 
884
		if (*data == 0)
887
		if (*data == 0)
885
			break; /* end of sequence reached */
888
			break; /* end of sequence reached */
886
	}
889
	}
887
 
890
 
888
	DRM_DEBUG_DRIVER("MIPI related vbt parsing complete\n");
891
	DRM_DEBUG_DRIVER("MIPI related vbt parsing complete\n");
889
	return;
892
	return;
890
err:
893
err:
891
	kfree(dev_priv->vbt.dsi.data);
894
	kfree(dev_priv->vbt.dsi.data);
892
	dev_priv->vbt.dsi.data = NULL;
895
	dev_priv->vbt.dsi.data = NULL;
893
 
896
 
894
	/* error during parsing so set all pointers to null
897
	/* error during parsing so set all pointers to null
895
	 * because of partial parsing */
898
	 * because of partial parsing */
896
	memset(dev_priv->vbt.dsi.sequence, 0, sizeof(dev_priv->vbt.dsi.sequence));
899
	memset(dev_priv->vbt.dsi.sequence, 0, sizeof(dev_priv->vbt.dsi.sequence));
897
}
900
}
898
 
901
 
899
static u8 translate_iboost(u8 val)
902
static u8 translate_iboost(u8 val)
900
{
903
{
901
	static const u8 mapping[] = { 1, 3, 7 }; /* See VBT spec */
904
	static const u8 mapping[] = { 1, 3, 7 }; /* See VBT spec */
902
 
905
 
903
	if (val >= ARRAY_SIZE(mapping)) {
906
	if (val >= ARRAY_SIZE(mapping)) {
904
		DRM_DEBUG_KMS("Unsupported I_boost value found in VBT (%d), display may not work properly\n", val);
907
		DRM_DEBUG_KMS("Unsupported I_boost value found in VBT (%d), display may not work properly\n", val);
905
		return 0;
908
		return 0;
906
	}
909
	}
907
	return mapping[val];
910
	return mapping[val];
908
}
911
}
909
 
912
 
910
static void parse_ddi_port(struct drm_i915_private *dev_priv, enum port port,
913
static void parse_ddi_port(struct drm_i915_private *dev_priv, enum port port,
911
			   const struct bdb_header *bdb)
914
			   const struct bdb_header *bdb)
912
{
915
{
913
	union child_device_config *it, *child = NULL;
916
	union child_device_config *it, *child = NULL;
914
	struct ddi_vbt_port_info *info = &dev_priv->vbt.ddi_port_info[port];
917
	struct ddi_vbt_port_info *info = &dev_priv->vbt.ddi_port_info[port];
915
	uint8_t hdmi_level_shift;
918
	uint8_t hdmi_level_shift;
916
	int i, j;
919
	int i, j;
917
	bool is_dvi, is_hdmi, is_dp, is_edp, is_crt;
920
	bool is_dvi, is_hdmi, is_dp, is_edp, is_crt;
918
	uint8_t aux_channel, ddc_pin;
921
	uint8_t aux_channel, ddc_pin;
919
	/* Each DDI port can have more than one value on the "DVO Port" field,
922
	/* Each DDI port can have more than one value on the "DVO Port" field,
920
	 * so look for all the possible values for each port and abort if more
923
	 * so look for all the possible values for each port and abort if more
921
	 * than one is found. */
924
	 * than one is found. */
922
	int dvo_ports[][3] = {
925
	int dvo_ports[][3] = {
923
		{DVO_PORT_HDMIA, DVO_PORT_DPA, -1},
926
		{DVO_PORT_HDMIA, DVO_PORT_DPA, -1},
924
		{DVO_PORT_HDMIB, DVO_PORT_DPB, -1},
927
		{DVO_PORT_HDMIB, DVO_PORT_DPB, -1},
925
		{DVO_PORT_HDMIC, DVO_PORT_DPC, -1},
928
		{DVO_PORT_HDMIC, DVO_PORT_DPC, -1},
926
		{DVO_PORT_HDMID, DVO_PORT_DPD, -1},
929
		{DVO_PORT_HDMID, DVO_PORT_DPD, -1},
927
		{DVO_PORT_CRT, DVO_PORT_HDMIE, DVO_PORT_DPE},
930
		{DVO_PORT_CRT, DVO_PORT_HDMIE, DVO_PORT_DPE},
928
	};
931
	};
929
 
932
 
930
	/* Find the child device to use, abort if more than one found. */
933
	/* Find the child device to use, abort if more than one found. */
931
	for (i = 0; i < dev_priv->vbt.child_dev_num; i++) {
934
	for (i = 0; i < dev_priv->vbt.child_dev_num; i++) {
932
		it = dev_priv->vbt.child_dev + i;
935
		it = dev_priv->vbt.child_dev + i;
933
 
936
 
934
		for (j = 0; j < 3; j++) {
937
		for (j = 0; j < 3; j++) {
935
			if (dvo_ports[port][j] == -1)
938
			if (dvo_ports[port][j] == -1)
936
				break;
939
				break;
937
 
940
 
938
			if (it->common.dvo_port == dvo_ports[port][j]) {
941
			if (it->common.dvo_port == dvo_ports[port][j]) {
939
				if (child) {
942
				if (child) {
940
					DRM_DEBUG_KMS("More than one child device for port %c in VBT.\n",
943
					DRM_DEBUG_KMS("More than one child device for port %c in VBT.\n",
941
						      port_name(port));
944
						      port_name(port));
942
					return;
945
					return;
943
				}
946
				}
944
				child = it;
947
				child = it;
945
			}
948
			}
946
		}
949
		}
947
	}
950
	}
948
	if (!child)
951
	if (!child)
949
		return;
952
		return;
950
 
953
 
951
	aux_channel = child->raw[25];
954
	aux_channel = child->raw[25];
952
	ddc_pin = child->common.ddc_pin;
955
	ddc_pin = child->common.ddc_pin;
953
 
956
 
954
	is_dvi = child->common.device_type & DEVICE_TYPE_TMDS_DVI_SIGNALING;
957
	is_dvi = child->common.device_type & DEVICE_TYPE_TMDS_DVI_SIGNALING;
955
	is_dp = child->common.device_type & DEVICE_TYPE_DISPLAYPORT_OUTPUT;
958
	is_dp = child->common.device_type & DEVICE_TYPE_DISPLAYPORT_OUTPUT;
956
	is_crt = child->common.device_type & DEVICE_TYPE_ANALOG_OUTPUT;
959
	is_crt = child->common.device_type & DEVICE_TYPE_ANALOG_OUTPUT;
957
	is_hdmi = is_dvi && (child->common.device_type & DEVICE_TYPE_NOT_HDMI_OUTPUT) == 0;
960
	is_hdmi = is_dvi && (child->common.device_type & DEVICE_TYPE_NOT_HDMI_OUTPUT) == 0;
958
	is_edp = is_dp && (child->common.device_type & DEVICE_TYPE_INTERNAL_CONNECTOR);
961
	is_edp = is_dp && (child->common.device_type & DEVICE_TYPE_INTERNAL_CONNECTOR);
959
 
962
 
960
	info->supports_dvi = is_dvi;
963
	info->supports_dvi = is_dvi;
961
	info->supports_hdmi = is_hdmi;
964
	info->supports_hdmi = is_hdmi;
962
	info->supports_dp = is_dp;
965
	info->supports_dp = is_dp;
963
 
966
 
964
	DRM_DEBUG_KMS("Port %c VBT info: DP:%d HDMI:%d DVI:%d EDP:%d CRT:%d\n",
967
	DRM_DEBUG_KMS("Port %c VBT info: DP:%d HDMI:%d DVI:%d EDP:%d CRT:%d\n",
965
		      port_name(port), is_dp, is_hdmi, is_dvi, is_edp, is_crt);
968
		      port_name(port), is_dp, is_hdmi, is_dvi, is_edp, is_crt);
966
 
969
 
967
	if (is_edp && is_dvi)
970
	if (is_edp && is_dvi)
968
		DRM_DEBUG_KMS("Internal DP port %c is TMDS compatible\n",
971
		DRM_DEBUG_KMS("Internal DP port %c is TMDS compatible\n",
969
			      port_name(port));
972
			      port_name(port));
970
	if (is_crt && port != PORT_E)
973
	if (is_crt && port != PORT_E)
971
		DRM_DEBUG_KMS("Port %c is analog\n", port_name(port));
974
		DRM_DEBUG_KMS("Port %c is analog\n", port_name(port));
972
	if (is_crt && (is_dvi || is_dp))
975
	if (is_crt && (is_dvi || is_dp))
973
		DRM_DEBUG_KMS("Analog port %c is also DP or TMDS compatible\n",
976
		DRM_DEBUG_KMS("Analog port %c is also DP or TMDS compatible\n",
974
			      port_name(port));
977
			      port_name(port));
975
	if (is_dvi && (port == PORT_A || port == PORT_E))
978
	if (is_dvi && (port == PORT_A || port == PORT_E))
976
		DRM_DEBUG_KMS("Port %c is TMDS compatible\n", port_name(port));
979
		DRM_DEBUG_KMS("Port %c is TMDS compatible\n", port_name(port));
977
	if (!is_dvi && !is_dp && !is_crt)
980
	if (!is_dvi && !is_dp && !is_crt)
978
		DRM_DEBUG_KMS("Port %c is not DP/TMDS/CRT compatible\n",
981
		DRM_DEBUG_KMS("Port %c is not DP/TMDS/CRT compatible\n",
979
			      port_name(port));
982
			      port_name(port));
980
	if (is_edp && (port == PORT_B || port == PORT_C || port == PORT_E))
983
	if (is_edp && (port == PORT_B || port == PORT_C || port == PORT_E))
981
		DRM_DEBUG_KMS("Port %c is internal DP\n", port_name(port));
984
		DRM_DEBUG_KMS("Port %c is internal DP\n", port_name(port));
982
 
985
 
983
	if (is_dvi) {
986
	if (is_dvi) {
984
		if (port == PORT_E) {
987
		if (port == PORT_E) {
985
			info->alternate_ddc_pin = ddc_pin;
988
			info->alternate_ddc_pin = ddc_pin;
986
			/* if DDIE share ddc pin with other port, then
989
			/* if DDIE share ddc pin with other port, then
987
			 * dvi/hdmi couldn't exist on the shared port.
990
			 * dvi/hdmi couldn't exist on the shared port.
988
			 * Otherwise they share the same ddc bin and system
991
			 * Otherwise they share the same ddc bin and system
989
			 * couldn't communicate with them seperately. */
992
			 * couldn't communicate with them seperately. */
990
			if (ddc_pin == DDC_PIN_B) {
993
			if (ddc_pin == DDC_PIN_B) {
991
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dvi = 0;
994
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dvi = 0;
992
				dev_priv->vbt.ddi_port_info[PORT_B].supports_hdmi = 0;
995
				dev_priv->vbt.ddi_port_info[PORT_B].supports_hdmi = 0;
993
			} else if (ddc_pin == DDC_PIN_C) {
996
			} else if (ddc_pin == DDC_PIN_C) {
994
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dvi = 0;
997
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dvi = 0;
995
				dev_priv->vbt.ddi_port_info[PORT_C].supports_hdmi = 0;
998
				dev_priv->vbt.ddi_port_info[PORT_C].supports_hdmi = 0;
996
			} else if (ddc_pin == DDC_PIN_D) {
999
			} else if (ddc_pin == DDC_PIN_D) {
997
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dvi = 0;
1000
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dvi = 0;
998
				dev_priv->vbt.ddi_port_info[PORT_D].supports_hdmi = 0;
1001
				dev_priv->vbt.ddi_port_info[PORT_D].supports_hdmi = 0;
999
			}
1002
			}
1000
		} else if (ddc_pin == DDC_PIN_B && port != PORT_B)
1003
		} else if (ddc_pin == DDC_PIN_B && port != PORT_B)
1001
			DRM_DEBUG_KMS("Unexpected DDC pin for port B\n");
1004
			DRM_DEBUG_KMS("Unexpected DDC pin for port B\n");
1002
		else if (ddc_pin == DDC_PIN_C && port != PORT_C)
1005
		else if (ddc_pin == DDC_PIN_C && port != PORT_C)
1003
			DRM_DEBUG_KMS("Unexpected DDC pin for port C\n");
1006
			DRM_DEBUG_KMS("Unexpected DDC pin for port C\n");
1004
		else if (ddc_pin == DDC_PIN_D && port != PORT_D)
1007
		else if (ddc_pin == DDC_PIN_D && port != PORT_D)
1005
			DRM_DEBUG_KMS("Unexpected DDC pin for port D\n");
1008
			DRM_DEBUG_KMS("Unexpected DDC pin for port D\n");
1006
	}
1009
	}
1007
 
1010
 
1008
	if (is_dp) {
1011
	if (is_dp) {
1009
		if (port == PORT_E) {
1012
		if (port == PORT_E) {
1010
			info->alternate_aux_channel = aux_channel;
1013
			info->alternate_aux_channel = aux_channel;
1011
			/* if DDIE share aux channel with other port, then
1014
			/* if DDIE share aux channel with other port, then
1012
			 * DP couldn't exist on the shared port. Otherwise
1015
			 * DP couldn't exist on the shared port. Otherwise
1013
			 * they share the same aux channel and system
1016
			 * they share the same aux channel and system
1014
			 * couldn't communicate with them seperately. */
1017
			 * couldn't communicate with them seperately. */
1015
			if (aux_channel == DP_AUX_A)
1018
			if (aux_channel == DP_AUX_A)
1016
				dev_priv->vbt.ddi_port_info[PORT_A].supports_dp = 0;
1019
				dev_priv->vbt.ddi_port_info[PORT_A].supports_dp = 0;
1017
			else if (aux_channel == DP_AUX_B)
1020
			else if (aux_channel == DP_AUX_B)
1018
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dp = 0;
1021
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dp = 0;
1019
			else if (aux_channel == DP_AUX_C)
1022
			else if (aux_channel == DP_AUX_C)
1020
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dp = 0;
1023
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dp = 0;
1021
			else if (aux_channel == DP_AUX_D)
1024
			else if (aux_channel == DP_AUX_D)
1022
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dp = 0;
1025
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dp = 0;
1023
		}
1026
		}
1024
		else if (aux_channel == DP_AUX_A && port != PORT_A)
1027
		else if (aux_channel == DP_AUX_A && port != PORT_A)
1025
			DRM_DEBUG_KMS("Unexpected AUX channel for port A\n");
1028
			DRM_DEBUG_KMS("Unexpected AUX channel for port A\n");
1026
		else if (aux_channel == DP_AUX_B && port != PORT_B)
1029
		else if (aux_channel == DP_AUX_B && port != PORT_B)
1027
			DRM_DEBUG_KMS("Unexpected AUX channel for port B\n");
1030
			DRM_DEBUG_KMS("Unexpected AUX channel for port B\n");
1028
		else if (aux_channel == DP_AUX_C && port != PORT_C)
1031
		else if (aux_channel == DP_AUX_C && port != PORT_C)
1029
			DRM_DEBUG_KMS("Unexpected AUX channel for port C\n");
1032
			DRM_DEBUG_KMS("Unexpected AUX channel for port C\n");
1030
		else if (aux_channel == DP_AUX_D && port != PORT_D)
1033
		else if (aux_channel == DP_AUX_D && port != PORT_D)
1031
			DRM_DEBUG_KMS("Unexpected AUX channel for port D\n");
1034
			DRM_DEBUG_KMS("Unexpected AUX channel for port D\n");
1032
	}
1035
	}
1033
 
1036
 
1034
	if (bdb->version >= 158) {
1037
	if (bdb->version >= 158) {
1035
		/* The VBT HDMI level shift values match the table we have. */
1038
		/* The VBT HDMI level shift values match the table we have. */
1036
		hdmi_level_shift = child->raw[7] & 0xF;
1039
		hdmi_level_shift = child->raw[7] & 0xF;
1037
		DRM_DEBUG_KMS("VBT HDMI level shift for port %c: %d\n",
1040
		DRM_DEBUG_KMS("VBT HDMI level shift for port %c: %d\n",
1038
			      port_name(port),
1041
			      port_name(port),
1039
			      hdmi_level_shift);
1042
			      hdmi_level_shift);
1040
		info->hdmi_level_shift = hdmi_level_shift;
1043
		info->hdmi_level_shift = hdmi_level_shift;
1041
	}
1044
	}
1042
 
1045
 
1043
	/* Parse the I_boost config for SKL and above */
1046
	/* Parse the I_boost config for SKL and above */
1044
	if (bdb->version >= 196 && (child->common.flags_1 & IBOOST_ENABLE)) {
1047
	if (bdb->version >= 196 && (child->common.flags_1 & IBOOST_ENABLE)) {
1045
		info->dp_boost_level = translate_iboost(child->common.iboost_level & 0xF);
1048
		info->dp_boost_level = translate_iboost(child->common.iboost_level & 0xF);
1046
		DRM_DEBUG_KMS("VBT (e)DP boost level for port %c: %d\n",
1049
		DRM_DEBUG_KMS("VBT (e)DP boost level for port %c: %d\n",
1047
			      port_name(port), info->dp_boost_level);
1050
			      port_name(port), info->dp_boost_level);
1048
		info->hdmi_boost_level = translate_iboost(child->common.iboost_level >> 4);
1051
		info->hdmi_boost_level = translate_iboost(child->common.iboost_level >> 4);
1049
		DRM_DEBUG_KMS("VBT HDMI boost level for port %c: %d\n",
1052
		DRM_DEBUG_KMS("VBT HDMI boost level for port %c: %d\n",
1050
			      port_name(port), info->hdmi_boost_level);
1053
			      port_name(port), info->hdmi_boost_level);
1051
	}
1054
	}
1052
}
1055
}
1053
 
1056
 
1054
static void parse_ddi_ports(struct drm_i915_private *dev_priv,
1057
static void parse_ddi_ports(struct drm_i915_private *dev_priv,
1055
			    const struct bdb_header *bdb)
1058
			    const struct bdb_header *bdb)
1056
{
1059
{
1057
	struct drm_device *dev = dev_priv->dev;
-
 
1058
	enum port port;
1060
	enum port port;
1059
 
1061
 
1060
	if (!HAS_DDI(dev))
1062
	if (!HAS_DDI(dev_priv))
1061
		return;
1063
		return;
1062
 
1064
 
1063
	if (!dev_priv->vbt.child_dev_num)
1065
	if (!dev_priv->vbt.child_dev_num)
1064
		return;
1066
		return;
1065
 
1067
 
1066
	if (bdb->version < 155)
1068
	if (bdb->version < 155)
1067
		return;
1069
		return;
1068
 
1070
 
1069
	for (port = PORT_A; port < I915_MAX_PORTS; port++)
1071
	for (port = PORT_A; port < I915_MAX_PORTS; port++)
1070
		parse_ddi_port(dev_priv, port, bdb);
1072
		parse_ddi_port(dev_priv, port, bdb);
1071
}
1073
}
1072
 
1074
 
1073
static void
1075
static void
1074
parse_device_mapping(struct drm_i915_private *dev_priv,
1076
parse_device_mapping(struct drm_i915_private *dev_priv,
1075
		     const struct bdb_header *bdb)
1077
		     const struct bdb_header *bdb)
1076
{
1078
{
1077
	const struct bdb_general_definitions *p_defs;
1079
	const struct bdb_general_definitions *p_defs;
1078
	const union child_device_config *p_child;
1080
	const union child_device_config *p_child;
1079
	union child_device_config *child_dev_ptr;
1081
	union child_device_config *child_dev_ptr;
1080
	int i, child_device_num, count;
1082
	int i, child_device_num, count;
1081
	u8 expected_size;
1083
	u8 expected_size;
1082
	u16 block_size;
1084
	u16 block_size;
1083
 
1085
 
1084
	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
1086
	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
1085
	if (!p_defs) {
1087
	if (!p_defs) {
1086
		DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
1088
		DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
1087
		return;
1089
		return;
1088
	}
1090
	}
1089
	if (bdb->version < 195) {
1091
	if (bdb->version < 195) {
1090
		expected_size = sizeof(struct old_child_dev_config);
1092
		expected_size = sizeof(struct old_child_dev_config);
1091
	} else if (bdb->version == 195) {
1093
	} else if (bdb->version == 195) {
1092
		expected_size = 37;
1094
		expected_size = 37;
1093
	} else if (bdb->version <= 197) {
1095
	} else if (bdb->version <= 197) {
1094
		expected_size = 38;
1096
		expected_size = 38;
1095
	} else {
1097
	} else {
1096
		expected_size = 38;
1098
		expected_size = 38;
1097
		BUILD_BUG_ON(sizeof(*p_child) < 38);
1099
		BUILD_BUG_ON(sizeof(*p_child) < 38);
1098
		DRM_DEBUG_DRIVER("Expected child device config size for VBT version %u not known; assuming %u\n",
1100
		DRM_DEBUG_DRIVER("Expected child device config size for VBT version %u not known; assuming %u\n",
1099
				 bdb->version, expected_size);
1101
				 bdb->version, expected_size);
1100
	}
1102
	}
1101
 
1103
 
1102
	/* The legacy sized child device config is the minimum we need. */
1104
	/* The legacy sized child device config is the minimum we need. */
1103
	if (p_defs->child_dev_size < sizeof(struct old_child_dev_config)) {
1105
	if (p_defs->child_dev_size < sizeof(struct old_child_dev_config)) {
1104
		DRM_ERROR("Child device config size %u is too small.\n",
1106
		DRM_ERROR("Child device config size %u is too small.\n",
1105
			  p_defs->child_dev_size);
1107
			  p_defs->child_dev_size);
1106
		return;
1108
		return;
1107
	}
1109
	}
1108
 
1110
 
1109
	/* Flag an error for unexpected size, but continue anyway. */
1111
	/* Flag an error for unexpected size, but continue anyway. */
1110
	if (p_defs->child_dev_size != expected_size)
1112
	if (p_defs->child_dev_size != expected_size)
1111
		DRM_ERROR("Unexpected child device config size %u (expected %u for VBT version %u)\n",
1113
		DRM_ERROR("Unexpected child device config size %u (expected %u for VBT version %u)\n",
1112
			  p_defs->child_dev_size, expected_size, bdb->version);
1114
			  p_defs->child_dev_size, expected_size, bdb->version);
1113
 
1115
 
1114
	/* get the block size of general definitions */
1116
	/* get the block size of general definitions */
1115
	block_size = get_blocksize(p_defs);
1117
	block_size = get_blocksize(p_defs);
1116
	/* get the number of child device */
1118
	/* get the number of child device */
1117
	child_device_num = (block_size - sizeof(*p_defs)) /
1119
	child_device_num = (block_size - sizeof(*p_defs)) /
1118
				p_defs->child_dev_size;
1120
				p_defs->child_dev_size;
1119
	count = 0;
1121
	count = 0;
1120
	/* get the number of child device that is present */
1122
	/* get the number of child device that is present */
1121
	for (i = 0; i < child_device_num; i++) {
1123
	for (i = 0; i < child_device_num; i++) {
1122
		p_child = child_device_ptr(p_defs, i);
1124
		p_child = child_device_ptr(p_defs, i);
1123
		if (!p_child->common.device_type) {
1125
		if (!p_child->common.device_type) {
1124
			/* skip the device block if device type is invalid */
1126
			/* skip the device block if device type is invalid */
1125
			continue;
1127
			continue;
1126
		}
1128
		}
1127
		count++;
1129
		count++;
1128
	}
1130
	}
1129
	if (!count) {
1131
	if (!count) {
1130
		DRM_DEBUG_KMS("no child dev is parsed from VBT\n");
1132
		DRM_DEBUG_KMS("no child dev is parsed from VBT\n");
1131
		return;
1133
		return;
1132
	}
1134
	}
1133
	dev_priv->vbt.child_dev = kcalloc(count, sizeof(*p_child), GFP_KERNEL);
1135
	dev_priv->vbt.child_dev = kcalloc(count, sizeof(*p_child), GFP_KERNEL);
1134
	if (!dev_priv->vbt.child_dev) {
1136
	if (!dev_priv->vbt.child_dev) {
1135
		DRM_DEBUG_KMS("No memory space for child device\n");
1137
		DRM_DEBUG_KMS("No memory space for child device\n");
1136
		return;
1138
		return;
1137
	}
1139
	}
1138
 
1140
 
1139
	dev_priv->vbt.child_dev_num = count;
1141
	dev_priv->vbt.child_dev_num = count;
1140
	count = 0;
1142
	count = 0;
1141
	for (i = 0; i < child_device_num; i++) {
1143
	for (i = 0; i < child_device_num; i++) {
1142
		p_child = child_device_ptr(p_defs, i);
1144
		p_child = child_device_ptr(p_defs, i);
1143
		if (!p_child->common.device_type) {
1145
		if (!p_child->common.device_type) {
1144
			/* skip the device block if device type is invalid */
1146
			/* skip the device block if device type is invalid */
1145
			continue;
1147
			continue;
1146
		}
1148
		}
1147
 
1149
 
1148
		if (p_child->common.dvo_port >= DVO_PORT_MIPIA
1150
		if (p_child->common.dvo_port >= DVO_PORT_MIPIA
1149
		    && p_child->common.dvo_port <= DVO_PORT_MIPID
1151
		    && p_child->common.dvo_port <= DVO_PORT_MIPID
1150
		    &&p_child->common.device_type & DEVICE_TYPE_MIPI_OUTPUT) {
1152
		    &&p_child->common.device_type & DEVICE_TYPE_MIPI_OUTPUT) {
1151
			DRM_DEBUG_KMS("Found MIPI as LFP\n");
1153
			DRM_DEBUG_KMS("Found MIPI as LFP\n");
1152
			dev_priv->vbt.has_mipi = 1;
1154
			dev_priv->vbt.has_mipi = 1;
1153
			dev_priv->vbt.dsi.port = p_child->common.dvo_port;
1155
			dev_priv->vbt.dsi.port = p_child->common.dvo_port;
1154
		}
1156
		}
1155
 
1157
 
1156
		child_dev_ptr = dev_priv->vbt.child_dev + count;
1158
		child_dev_ptr = dev_priv->vbt.child_dev + count;
1157
		count++;
1159
		count++;
1158
 
1160
 
1159
		/*
1161
		/*
1160
		 * Copy as much as we know (sizeof) and is available
1162
		 * Copy as much as we know (sizeof) and is available
1161
		 * (child_dev_size) of the child device. Accessing the data must
1163
		 * (child_dev_size) of the child device. Accessing the data must
1162
		 * depend on VBT version.
1164
		 * depend on VBT version.
1163
		 */
1165
		 */
1164
		memcpy(child_dev_ptr, p_child,
1166
		memcpy(child_dev_ptr, p_child,
1165
		       min_t(size_t, p_defs->child_dev_size, sizeof(*p_child)));
1167
		       min_t(size_t, p_defs->child_dev_size, sizeof(*p_child)));
1166
	}
1168
	}
1167
	return;
1169
	return;
1168
}
1170
}
1169
 
1171
 
1170
static void
1172
static void
1171
init_vbt_defaults(struct drm_i915_private *dev_priv)
1173
init_vbt_defaults(struct drm_i915_private *dev_priv)
1172
{
1174
{
1173
	struct drm_device *dev = dev_priv->dev;
-
 
1174
	enum port port;
1175
	enum port port;
1175
 
1176
 
1176
	dev_priv->vbt.crt_ddc_pin = GMBUS_PIN_VGADDC;
1177
	dev_priv->vbt.crt_ddc_pin = GMBUS_PIN_VGADDC;
1177
 
1178
 
1178
	/* Default to having backlight */
1179
	/* Default to having backlight */
1179
	dev_priv->vbt.backlight.present = true;
1180
	dev_priv->vbt.backlight.present = true;
1180
 
1181
 
1181
	/* LFP panel data */
1182
	/* LFP panel data */
1182
	dev_priv->vbt.lvds_dither = 1;
1183
	dev_priv->vbt.lvds_dither = 1;
1183
	dev_priv->vbt.lvds_vbt = 0;
1184
	dev_priv->vbt.lvds_vbt = 0;
1184
 
1185
 
1185
	/* SDVO panel data */
1186
	/* SDVO panel data */
1186
	dev_priv->vbt.sdvo_lvds_vbt_mode = NULL;
1187
	dev_priv->vbt.sdvo_lvds_vbt_mode = NULL;
1187
 
1188
 
1188
	/* general features */
1189
	/* general features */
1189
	dev_priv->vbt.int_tv_support = 1;
1190
	dev_priv->vbt.int_tv_support = 1;
1190
	dev_priv->vbt.int_crt_support = 1;
1191
	dev_priv->vbt.int_crt_support = 1;
1191
 
1192
 
1192
	/* Default to using SSC */
1193
	/* Default to using SSC */
1193
	dev_priv->vbt.lvds_use_ssc = 1;
1194
	dev_priv->vbt.lvds_use_ssc = 1;
1194
	/*
1195
	/*
1195
	 * Core/SandyBridge/IvyBridge use alternative (120MHz) reference
1196
	 * Core/SandyBridge/IvyBridge use alternative (120MHz) reference
1196
	 * clock for LVDS.
1197
	 * clock for LVDS.
1197
	 */
1198
	 */
1198
	dev_priv->vbt.lvds_ssc_freq = intel_bios_ssc_frequency(dev,
1199
	dev_priv->vbt.lvds_ssc_freq = intel_bios_ssc_frequency(dev_priv,
1199
			!HAS_PCH_SPLIT(dev));
1200
			!HAS_PCH_SPLIT(dev_priv));
1200
	DRM_DEBUG_KMS("Set default to SSC at %d kHz\n", dev_priv->vbt.lvds_ssc_freq);
1201
	DRM_DEBUG_KMS("Set default to SSC at %d kHz\n", dev_priv->vbt.lvds_ssc_freq);
1201
 
1202
 
1202
	for (port = PORT_A; port < I915_MAX_PORTS; port++) {
1203
	for (port = PORT_A; port < I915_MAX_PORTS; port++) {
1203
		struct ddi_vbt_port_info *info =
1204
		struct ddi_vbt_port_info *info =
1204
			&dev_priv->vbt.ddi_port_info[port];
1205
			&dev_priv->vbt.ddi_port_info[port];
1205
 
1206
 
1206
		info->hdmi_level_shift = HDMI_LEVEL_SHIFT_UNKNOWN;
1207
		info->hdmi_level_shift = HDMI_LEVEL_SHIFT_UNKNOWN;
1207
 
1208
 
1208
		info->supports_dvi = (port != PORT_A && port != PORT_E);
1209
		info->supports_dvi = (port != PORT_A && port != PORT_E);
1209
		info->supports_hdmi = info->supports_dvi;
1210
		info->supports_hdmi = info->supports_dvi;
1210
		info->supports_dp = (port != PORT_E);
1211
		info->supports_dp = (port != PORT_E);
1211
	}
1212
	}
1212
}
1213
}
1213
 
1214
 
1214
static int intel_no_opregion_vbt_callback(const struct dmi_system_id *id)
1215
static const struct bdb_header *get_bdb_header(const struct vbt_header *vbt)
1215
{
-
 
1216
	DRM_DEBUG_KMS("Falling back to manually reading VBT from "
-
 
1217
		      "VBIOS ROM for %s\n",
1216
{
1218
		      id->ident);
-
 
1219
	return 1;
-
 
1220
}
-
 
1221
 
-
 
1222
static const struct dmi_system_id intel_no_opregion_vbt[] = {
-
 
1223
	{
-
 
1224
		.callback = intel_no_opregion_vbt_callback,
-
 
1225
		.ident = "ThinkCentre A57",
-
 
1226
		.matches = {
-
 
1227
			DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
-
 
1228
			DMI_MATCH(DMI_PRODUCT_NAME, "97027RG"),
-
 
1229
		},
-
 
1230
	},
-
 
1231
	{ }
-
 
-
 
1217
	const void *_vbt = vbt;
-
 
1218
 
-
 
1219
	return _vbt + vbt->bdb_offset;
-
 
1220
}
1232
};
1221
 
-
 
1222
/**
1233
 
1223
 * intel_bios_is_valid_vbt - does the given buffer contain a valid VBT
-
 
1224
 * @buf:	pointer to a buffer to validate
1234
static const struct bdb_header *validate_vbt(const void *base,
1225
 * @size:	size of the buffer
-
 
1226
 *
1235
					     size_t size,
1227
 * Returns true on valid VBT.
1236
					     const void *_vbt,
1228
 */
1237
					     const char *source)
-
 
1238
{
1229
bool intel_bios_is_valid_vbt(const void *buf, size_t size)
1239
	size_t offset = _vbt - base;
1230
	{
-
 
1231
	const struct vbt_header *vbt = buf;
-
 
1232
	const struct bdb_header *bdb;
-
 
1233
 
1240
	const struct vbt_header *vbt = _vbt;
1234
	if (!vbt)
1241
	const struct bdb_header *bdb;
1235
		return false;
1242
 
1236
 
1243
	if (offset + sizeof(struct vbt_header) > size) {
1237
	if (sizeof(struct vbt_header) > size) {
1244
		DRM_DEBUG_DRIVER("VBT header incomplete\n");
1238
		DRM_DEBUG_DRIVER("VBT header incomplete\n");
1245
		return NULL;
1239
		return false;
1246
	}
1240
	}
1247
 
1241
 
1248
	if (memcmp(vbt->signature, "$VBT", 4)) {
1242
	if (memcmp(vbt->signature, "$VBT", 4)) {
1249
		DRM_DEBUG_DRIVER("VBT invalid signature\n");
1243
		DRM_DEBUG_DRIVER("VBT invalid signature\n");
1250
		return NULL;
1244
		return false;
1251
	}
1245
	}
1252
 
-
 
1253
	offset += vbt->bdb_offset;
1246
 
1254
	if (offset + sizeof(struct bdb_header) > size) {
1247
	if (vbt->bdb_offset + sizeof(struct bdb_header) > size) {
1255
		DRM_DEBUG_DRIVER("BDB header incomplete\n");
1248
		DRM_DEBUG_DRIVER("BDB header incomplete\n");
1256
		return NULL;
1249
		return false;
1257
	}
1250
	}
1258
 
1251
 
1259
	bdb = base + offset;
1252
	bdb = get_bdb_header(vbt);
1260
	if (offset + bdb->bdb_size > size) {
1253
	if (vbt->bdb_offset + bdb->bdb_size > size) {
1261
		DRM_DEBUG_DRIVER("BDB incomplete\n");
1254
		DRM_DEBUG_DRIVER("BDB incomplete\n");
1262
		return NULL;
-
 
1263
	}
-
 
1264
 
1255
		return false;
1265
	DRM_DEBUG_KMS("Using VBT from %s: %20s\n",
1256
	}
1266
		      source, vbt->signature);
1257
 
1267
	return bdb;
1258
	return vbt;
1268
}
-
 
1269
 
1259
}
1270
static const struct bdb_header *find_vbt(void __iomem *bios, size_t size)
1260
 
1271
{
1261
static const struct vbt_header *find_vbt(void __iomem *bios, size_t size)
1272
	const struct bdb_header *bdb = NULL;
1262
{
1273
	size_t i;
1263
	size_t i;
1274
 
1264
 
1275
	/* Scour memory looking for the VBT signature. */
1265
	/* Scour memory looking for the VBT signature. */
1276
	for (i = 0; i + 4 < size; i++) {
1266
	for (i = 0; i + 4 < size; i++) {
-
 
1267
		void *vbt;
-
 
1268
 
1277
		if (ioread32(bios + i) == *((const u32 *) "$VBT")) {
1269
		if (ioread32(bios + i) != *((const u32 *) "$VBT"))
-
 
1270
			continue;
-
 
1271
 
1278
			/*
1272
			/*
1279
			 * This is the one place where we explicitly discard the
1273
		 * This is the one place where we explicitly discard the address
1280
			 * address space (__iomem) of the BIOS/VBT. From now on
1274
		 * space (__iomem) of the BIOS/VBT.
1281
			 * everything is based on 'base', and treated as regular
-
 
1282
			 * memory.
-
 
1283
			 */
1275
			 */
1284
			void *_bios = (void __force *) bios;
1276
		vbt = (void __force *) bios + i;
-
 
1277
		if (intel_bios_is_valid_vbt(vbt, size - i))
-
 
1278
			return vbt;
1285
 
-
 
1286
			bdb = validate_vbt(_bios, size, _bios + i, "PCI ROM");
1279
 
1287
			break;
1280
			break;
1288
		}
-
 
1289
	}
1281
		}
1290
 
1282
 
1291
	return bdb;
1283
	return NULL;
1292
}
1284
}
1293
 
1285
 
1294
/**
1286
/**
1295
 * intel_parse_bios - find VBT and initialize settings from the BIOS
1287
 * intel_bios_init - find VBT and initialize settings from the BIOS
1296
 * @dev: DRM device
1288
 * @dev: DRM device
1297
 *
1289
 *
1298
 * Loads the Video BIOS and checks that the VBT exists.  Sets scratch registers
1290
 * Loads the Video BIOS and checks that the VBT exists.  Sets scratch registers
1299
 * to appropriate values.
1291
 * to appropriate values.
1300
 *
1292
 *
1301
 * Returns 0 on success, nonzero on failure.
1293
 * Returns 0 on success, nonzero on failure.
1302
 */
1294
 */
1303
int
1295
int
1304
intel_parse_bios(struct drm_device *dev)
1296
intel_bios_init(struct drm_i915_private *dev_priv)
1305
{
1297
{
1306
	struct drm_i915_private *dev_priv = dev->dev_private;
1298
	struct pci_dev *pdev = dev_priv->dev->pdev;
1307
	struct pci_dev *pdev = dev->pdev;
1299
	const struct vbt_header *vbt = dev_priv->opregion.vbt;
1308
	const struct bdb_header *bdb = NULL;
1300
	const struct bdb_header *bdb;
1309
	u8 __iomem *bios = NULL;
1301
	u8 __iomem *bios = NULL;
1310
 
1302
 
1311
	if (HAS_PCH_NOP(dev))
1303
	if (HAS_PCH_NOP(dev_priv))
1312
		return -ENODEV;
1304
		return -ENODEV;
1313
 
1305
 
1314
	init_vbt_defaults(dev_priv);
1306
	init_vbt_defaults(dev_priv);
1315
 
-
 
1316
	/* XXX Should this validation be moved to intel_opregion.c? */
-
 
1317
	if (!dmi_check_system(intel_no_opregion_vbt) && dev_priv->opregion.vbt)
-
 
1318
		bdb = validate_vbt(dev_priv->opregion.header, OPREGION_SIZE,
-
 
1319
				   dev_priv->opregion.vbt, "OpRegion");
-
 
1320
 
1307
 
1321
	if (bdb == NULL) {
1308
	if (!vbt) {
1322
		size_t size;
1309
		size_t size;
1323
 
1310
 
1324
		bios = pci_map_rom(pdev, &size);
1311
		bios = pci_map_rom(pdev, &size);
1325
		if (!bios)
1312
		if (!bios)
1326
			return -1;
1313
			return -1;
1327
 
1314
 
1328
		bdb = find_vbt(bios, size);
1315
		vbt = find_vbt(bios, size);
1329
		if (!bdb) {
1316
		if (!vbt) {
1330
			pci_unmap_rom(pdev, bios);
1317
			pci_unmap_rom(pdev, bios);
1331
			return -1;
1318
			return -1;
1332
		}
1319
		}
-
 
1320
 
-
 
1321
		DRM_DEBUG_KMS("Found valid VBT in PCI ROM\n");
1333
	}
1322
	}
-
 
1323
 
-
 
1324
	bdb = get_bdb_header(vbt);
-
 
1325
 
-
 
1326
	DRM_DEBUG_KMS("VBT signature \"%.*s\", BDB version %d\n",
-
 
1327
		      (int)sizeof(vbt->signature), vbt->signature, bdb->version);
1334
 
1328
 
1335
	/* Grab useful general definitions */
1329
	/* Grab useful general definitions */
1336
	parse_general_features(dev_priv, bdb);
1330
	parse_general_features(dev_priv, bdb);
1337
	parse_general_definitions(dev_priv, bdb);
1331
	parse_general_definitions(dev_priv, bdb);
1338
	parse_lfp_panel_data(dev_priv, bdb);
1332
	parse_lfp_panel_data(dev_priv, bdb);
1339
	parse_lfp_backlight(dev_priv, bdb);
1333
	parse_lfp_backlight(dev_priv, bdb);
1340
	parse_sdvo_panel_data(dev_priv, bdb);
1334
	parse_sdvo_panel_data(dev_priv, bdb);
1341
	parse_sdvo_device_mapping(dev_priv, bdb);
1335
	parse_sdvo_device_mapping(dev_priv, bdb);
1342
	parse_device_mapping(dev_priv, bdb);
1336
	parse_device_mapping(dev_priv, bdb);
1343
	parse_driver_features(dev_priv, bdb);
1337
	parse_driver_features(dev_priv, bdb);
1344
	parse_edp(dev_priv, bdb);
1338
	parse_edp(dev_priv, bdb);
1345
	parse_psr(dev_priv, bdb);
1339
	parse_psr(dev_priv, bdb);
1346
	parse_mipi(dev_priv, bdb);
1340
	parse_mipi(dev_priv, bdb);
1347
	parse_ddi_ports(dev_priv, bdb);
1341
	parse_ddi_ports(dev_priv, bdb);
1348
 
1342
 
1349
	if (bios)
1343
	if (bios)
1350
		pci_unmap_rom(pdev, bios);
1344
		pci_unmap_rom(pdev, bios);
1351
 
1345
 
1352
	return 0;
1346
	return 0;
1353
}
1347
}
1354
 
-
 
1355
/**
-
 
1356
 * intel_bios_is_port_present - is the specified digital port present
-
 
1357
 * @dev_priv:	i915 device instance
-
 
1358
 * @port:	port to check
-
 
1359
 *
-
 
1360
 * Return true if the device in %port is present.
-
 
1361
 */
-
 
1362
bool intel_bios_is_port_present(struct drm_i915_private *dev_priv, enum port port)
-
 
1363
{
-
 
1364
	static const struct {
-
 
1365
		u16 dp, hdmi;
-
 
1366
	} port_mapping[] = {
-
 
1367
		[PORT_B] = { DVO_PORT_DPB, DVO_PORT_HDMIB, },
-
 
1368
		[PORT_C] = { DVO_PORT_DPC, DVO_PORT_HDMIC, },
-
 
1369
		[PORT_D] = { DVO_PORT_DPD, DVO_PORT_HDMID, },
-
 
1370
		[PORT_E] = { DVO_PORT_DPE, DVO_PORT_HDMIE, },
-
 
1371
	};
-
 
1372
	int i;
-
 
1373
 
-
 
1374
	/* FIXME maybe deal with port A as well? */
-
 
1375
	if (WARN_ON(port == PORT_A) || port >= ARRAY_SIZE(port_mapping))
-
 
1376
		return false;
-
 
1377
 
-
 
1378
	if (!dev_priv->vbt.child_dev_num)
-
 
1379
		return false;
-
 
1380
 
-
 
1381
	for (i = 0; i < dev_priv->vbt.child_dev_num; i++) {
-
 
1382
		const union child_device_config *p_child =
-
 
1383
			&dev_priv->vbt.child_dev[i];
-
 
1384
		if ((p_child->common.dvo_port == port_mapping[port].dp ||
-
 
1385
		     p_child->common.dvo_port == port_mapping[port].hdmi) &&
-
 
1386
		    (p_child->common.device_type & (DEVICE_TYPE_TMDS_DVI_SIGNALING |
-
 
1387
						    DEVICE_TYPE_DISPLAYPORT_OUTPUT)))
-
 
1388
			return true;
-
 
1389
	}
-
 
1390
 
-
 
1391
	return false;
-
 
1392
}
-