1/*
2 * Copyright 2007-8 Advanced Micro Devices, Inc.
3 * Copyright 2008 Red Hat Inc.
4 *
5 * Permission is hereby granted, free of charge, to any person obtaining a
6 * copy of this software and associated documentation files (the "Software"),
7 * to deal in the Software without restriction, including without limitation
8 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
9 * and/or sell copies of the Software, and to permit persons to whom the
10 * Software is furnished to do so, subject to the following conditions:
11 *
12 * The above copyright notice and this permission notice shall be included in
13 * all copies or substantial portions of the Software.
14 *
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,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
19 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
20 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
21 * OTHER DEALINGS IN THE SOFTWARE.
22 *
23 * Authors: Dave Airlie
24 *          Alex Deucher
25 */
26
27#include <drm/amdgpu_drm.h>
28#include "amdgpu.h"
29#include "amdgpu_atombios.h"
30#include "amdgpu_atomfirmware.h"
31#include "amdgpu_i2c.h"
32#include "amdgpu_display.h"
33
34#include "atom.h"
35#include "atom-bits.h"
36#include "atombios_encoders.h"
37#include "bif/bif_4_1_d.h"
38
39static void amdgpu_atombios_lookup_i2c_gpio_quirks(struct amdgpu_device *adev,
40					  ATOM_GPIO_I2C_ASSIGMENT *gpio,
41					  u8 index)
42{
43
44}
45
46static struct amdgpu_i2c_bus_rec amdgpu_atombios_get_bus_rec_for_i2c_gpio(ATOM_GPIO_I2C_ASSIGMENT *gpio)
47{
48	struct amdgpu_i2c_bus_rec i2c;
49
50	memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
51
52	i2c.mask_clk_reg = le16_to_cpu(gpio->usClkMaskRegisterIndex);
53	i2c.mask_data_reg = le16_to_cpu(gpio->usDataMaskRegisterIndex);
54	i2c.en_clk_reg = le16_to_cpu(gpio->usClkEnRegisterIndex);
55	i2c.en_data_reg = le16_to_cpu(gpio->usDataEnRegisterIndex);
56	i2c.y_clk_reg = le16_to_cpu(gpio->usClkY_RegisterIndex);
57	i2c.y_data_reg = le16_to_cpu(gpio->usDataY_RegisterIndex);
58	i2c.a_clk_reg = le16_to_cpu(gpio->usClkA_RegisterIndex);
59	i2c.a_data_reg = le16_to_cpu(gpio->usDataA_RegisterIndex);
60	i2c.mask_clk_mask = (1 << gpio->ucClkMaskShift);
61	i2c.mask_data_mask = (1 << gpio->ucDataMaskShift);
62	i2c.en_clk_mask = (1 << gpio->ucClkEnShift);
63	i2c.en_data_mask = (1 << gpio->ucDataEnShift);
64	i2c.y_clk_mask = (1 << gpio->ucClkY_Shift);
65	i2c.y_data_mask = (1 << gpio->ucDataY_Shift);
66	i2c.a_clk_mask = (1 << gpio->ucClkA_Shift);
67	i2c.a_data_mask = (1 << gpio->ucDataA_Shift);
68
69	if (gpio->sucI2cId.sbfAccess.bfHW_Capable)
70		i2c.hw_capable = true;
71	else
72		i2c.hw_capable = false;
73
74	if (gpio->sucI2cId.ucAccess == 0xa0)
75		i2c.mm_i2c = true;
76	else
77		i2c.mm_i2c = false;
78
79	i2c.i2c_id = gpio->sucI2cId.ucAccess;
80
81	if (i2c.mask_clk_reg)
82		i2c.valid = true;
83	else
84		i2c.valid = false;
85
86	return i2c;
87}
88
89struct amdgpu_i2c_bus_rec amdgpu_atombios_lookup_i2c_gpio(struct amdgpu_device *adev,
90							  uint8_t id)
91{
92	struct atom_context *ctx = adev->mode_info.atom_context;
93	ATOM_GPIO_I2C_ASSIGMENT *gpio;
94	struct amdgpu_i2c_bus_rec i2c;
95	int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
96	struct _ATOM_GPIO_I2C_INFO *i2c_info;
97	uint16_t data_offset, size;
98	int i, num_indices;
99
100	memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
101	i2c.valid = false;
102
103	if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
104		i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
105
106		num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
107			sizeof(ATOM_GPIO_I2C_ASSIGMENT);
108
109		gpio = &i2c_info->asGPIO_Info[0];
110		for (i = 0; i < num_indices; i++) {
111
112			amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
113
114			if (gpio->sucI2cId.ucAccess == id) {
115				i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
116				break;
117			}
118			gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
119				((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
120		}
121	}
122
123	return i2c;
124}
125
126void amdgpu_atombios_i2c_init(struct amdgpu_device *adev)
127{
128	struct atom_context *ctx = adev->mode_info.atom_context;
129	ATOM_GPIO_I2C_ASSIGMENT *gpio;
130	struct amdgpu_i2c_bus_rec i2c;
131	int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
132	struct _ATOM_GPIO_I2C_INFO *i2c_info;
133	uint16_t data_offset, size;
134	int i, num_indices;
135	char stmp[32];
136
137	if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
138		i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
139
140		num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
141			sizeof(ATOM_GPIO_I2C_ASSIGMENT);
142
143		gpio = &i2c_info->asGPIO_Info[0];
144		for (i = 0; i < num_indices; i++) {
145			amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
146
147			i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
148
149			if (i2c.valid) {
150				sprintf(stmp, "0x%x", i2c.i2c_id);
151				adev->i2c_bus[i] = amdgpu_i2c_create(adev_to_drm(adev), &i2c, stmp);
152			}
153			gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
154				((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
155		}
156	}
157}
158
159struct amdgpu_gpio_rec
160amdgpu_atombios_lookup_gpio(struct amdgpu_device *adev,
161			    u8 id)
162{
163	struct atom_context *ctx = adev->mode_info.atom_context;
164	struct amdgpu_gpio_rec gpio;
165	int index = GetIndexIntoMasterTable(DATA, GPIO_Pin_LUT);
166	struct _ATOM_GPIO_PIN_LUT *gpio_info;
167	ATOM_GPIO_PIN_ASSIGNMENT *pin;
168	u16 data_offset, size;
169	int i, num_indices;
170
171	memset(&gpio, 0, sizeof(struct amdgpu_gpio_rec));
172	gpio.valid = false;
173
174	if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
175		gpio_info = (struct _ATOM_GPIO_PIN_LUT *)(ctx->bios + data_offset);
176
177		num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
178			sizeof(ATOM_GPIO_PIN_ASSIGNMENT);
179
180		pin = gpio_info->asGPIO_Pin;
181		for (i = 0; i < num_indices; i++) {
182			if (id == pin->ucGPIO_ID) {
183				gpio.id = pin->ucGPIO_ID;
184				gpio.reg = le16_to_cpu(pin->usGpioPin_AIndex);
185				gpio.shift = pin->ucGpioPinBitShift;
186				gpio.mask = (1 << pin->ucGpioPinBitShift);
187				gpio.valid = true;
188				break;
189			}
190			pin = (ATOM_GPIO_PIN_ASSIGNMENT *)
191				((u8 *)pin + sizeof(ATOM_GPIO_PIN_ASSIGNMENT));
192		}
193	}
194
195	return gpio;
196}
197
198static struct amdgpu_hpd
199amdgpu_atombios_get_hpd_info_from_gpio(struct amdgpu_device *adev,
200				       struct amdgpu_gpio_rec *gpio)
201{
202	struct amdgpu_hpd hpd;
203	u32 reg;
204
205	memset(&hpd, 0, sizeof(struct amdgpu_hpd));
206
207	reg = amdgpu_display_hpd_get_gpio_reg(adev);
208
209	hpd.gpio = *gpio;
210	if (gpio->reg == reg) {
211		switch(gpio->mask) {
212		case (1 << 0):
213			hpd.hpd = AMDGPU_HPD_1;
214			break;
215		case (1 << 8):
216			hpd.hpd = AMDGPU_HPD_2;
217			break;
218		case (1 << 16):
219			hpd.hpd = AMDGPU_HPD_3;
220			break;
221		case (1 << 24):
222			hpd.hpd = AMDGPU_HPD_4;
223			break;
224		case (1 << 26):
225			hpd.hpd = AMDGPU_HPD_5;
226			break;
227		case (1 << 28):
228			hpd.hpd = AMDGPU_HPD_6;
229			break;
230		default:
231			hpd.hpd = AMDGPU_HPD_NONE;
232			break;
233		}
234	} else
235		hpd.hpd = AMDGPU_HPD_NONE;
236	return hpd;
237}
238
239static const int object_connector_convert[] = {
240	DRM_MODE_CONNECTOR_Unknown,
241	DRM_MODE_CONNECTOR_DVII,
242	DRM_MODE_CONNECTOR_DVII,
243	DRM_MODE_CONNECTOR_DVID,
244	DRM_MODE_CONNECTOR_DVID,
245	DRM_MODE_CONNECTOR_VGA,
246	DRM_MODE_CONNECTOR_Composite,
247	DRM_MODE_CONNECTOR_SVIDEO,
248	DRM_MODE_CONNECTOR_Unknown,
249	DRM_MODE_CONNECTOR_Unknown,
250	DRM_MODE_CONNECTOR_9PinDIN,
251	DRM_MODE_CONNECTOR_Unknown,
252	DRM_MODE_CONNECTOR_HDMIA,
253	DRM_MODE_CONNECTOR_HDMIB,
254	DRM_MODE_CONNECTOR_LVDS,
255	DRM_MODE_CONNECTOR_9PinDIN,
256	DRM_MODE_CONNECTOR_Unknown,
257	DRM_MODE_CONNECTOR_Unknown,
258	DRM_MODE_CONNECTOR_Unknown,
259	DRM_MODE_CONNECTOR_DisplayPort,
260	DRM_MODE_CONNECTOR_eDP,
261	DRM_MODE_CONNECTOR_Unknown
262};
263
264bool amdgpu_atombios_has_dce_engine_info(struct amdgpu_device *adev)
265{
266	struct amdgpu_mode_info *mode_info = &adev->mode_info;
267	struct atom_context *ctx = mode_info->atom_context;
268	int index = GetIndexIntoMasterTable(DATA, Object_Header);
269	u16 size, data_offset;
270	u8 frev, crev;
271	ATOM_DISPLAY_OBJECT_PATH_TABLE *path_obj;
272	ATOM_OBJECT_HEADER *obj_header;
273
274	if (!amdgpu_atom_parse_data_header(ctx, index, &size, &frev, &crev, &data_offset))
275		return false;
276
277	if (crev < 2)
278		return false;
279
280	obj_header = (ATOM_OBJECT_HEADER *) (ctx->bios + data_offset);
281	path_obj = (ATOM_DISPLAY_OBJECT_PATH_TABLE *)
282	    (ctx->bios + data_offset +
283	     le16_to_cpu(obj_header->usDisplayPathTableOffset));
284
285	if (path_obj->ucNumOfDispPath)
286		return true;
287	else
288		return false;
289}
290
291bool amdgpu_atombios_get_connector_info_from_object_table(struct amdgpu_device *adev)
292{
293	struct amdgpu_mode_info *mode_info = &adev->mode_info;
294	struct atom_context *ctx = mode_info->atom_context;
295	int index = GetIndexIntoMasterTable(DATA, Object_Header);
296	u16 size, data_offset;
297	u8 frev, crev;
298	ATOM_CONNECTOR_OBJECT_TABLE *con_obj;
299	ATOM_ENCODER_OBJECT_TABLE *enc_obj;
300	ATOM_OBJECT_TABLE *router_obj;
301	ATOM_DISPLAY_OBJECT_PATH_TABLE *path_obj;
302	ATOM_OBJECT_HEADER *obj_header;
303	int i, j, k, path_size, device_support;
304	int connector_type;
305	u16 conn_id, connector_object_id;
306	struct amdgpu_i2c_bus_rec ddc_bus;
307	struct amdgpu_router router;
308	struct amdgpu_gpio_rec gpio;
309	struct amdgpu_hpd hpd;
310
311	if (!amdgpu_atom_parse_data_header(ctx, index, &size, &frev, &crev, &data_offset))
312		return false;
313
314	if (crev < 2)
315		return false;
316
317	obj_header = (ATOM_OBJECT_HEADER *) (ctx->bios + data_offset);
318	path_obj = (ATOM_DISPLAY_OBJECT_PATH_TABLE *)
319	    (ctx->bios + data_offset +
320	     le16_to_cpu(obj_header->usDisplayPathTableOffset));
321	con_obj = (ATOM_CONNECTOR_OBJECT_TABLE *)
322	    (ctx->bios + data_offset +
323	     le16_to_cpu(obj_header->usConnectorObjectTableOffset));
324	enc_obj = (ATOM_ENCODER_OBJECT_TABLE *)
325	    (ctx->bios + data_offset +
326	     le16_to_cpu(obj_header->usEncoderObjectTableOffset));
327	router_obj = (ATOM_OBJECT_TABLE *)
328		(ctx->bios + data_offset +
329		 le16_to_cpu(obj_header->usRouterObjectTableOffset));
330	device_support = le16_to_cpu(obj_header->usDeviceSupport);
331
332	path_size = 0;
333	for (i = 0; i < path_obj->ucNumOfDispPath; i++) {
334		uint8_t *addr = (uint8_t *) path_obj->asDispPath;
335		ATOM_DISPLAY_OBJECT_PATH *path;
336		addr += path_size;
337		path = (ATOM_DISPLAY_OBJECT_PATH *) addr;
338		path_size += le16_to_cpu(path->usSize);
339
340		if (device_support & le16_to_cpu(path->usDeviceTag)) {
341			uint8_t con_obj_id =
342			    (le16_to_cpu(path->usConnObjectId) & OBJECT_ID_MASK)
343			    >> OBJECT_ID_SHIFT;
344
345			/* Skip TV/CV support */
346			if ((le16_to_cpu(path->usDeviceTag) ==
347			     ATOM_DEVICE_TV1_SUPPORT) ||
348			    (le16_to_cpu(path->usDeviceTag) ==
349			     ATOM_DEVICE_CV_SUPPORT))
350				continue;
351
352			if (con_obj_id >= ARRAY_SIZE(object_connector_convert)) {
353				DRM_ERROR("invalid con_obj_id %d for device tag 0x%04x\n",
354					  con_obj_id, le16_to_cpu(path->usDeviceTag));
355				continue;
356			}
357
358			connector_type =
359				object_connector_convert[con_obj_id];
360			connector_object_id = con_obj_id;
361
362			if (connector_type == DRM_MODE_CONNECTOR_Unknown)
363				continue;
364
365			router.ddc_valid = false;
366			router.cd_valid = false;
367			for (j = 0; j < ((le16_to_cpu(path->usSize) - 8) / 2); j++) {
368				uint8_t grph_obj_type =
369				    (le16_to_cpu(path->usGraphicObjIds[j]) &
370				     OBJECT_TYPE_MASK) >> OBJECT_TYPE_SHIFT;
371
372				if (grph_obj_type == GRAPH_OBJECT_TYPE_ENCODER) {
373					for (k = 0; k < enc_obj->ucNumberOfObjects; k++) {
374						u16 encoder_obj = le16_to_cpu(enc_obj->asObjects[k].usObjectID);
375						if (le16_to_cpu(path->usGraphicObjIds[j]) == encoder_obj) {
376							ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
377								(ctx->bios + data_offset +
378								 le16_to_cpu(enc_obj->asObjects[k].usRecordOffset));
379							ATOM_ENCODER_CAP_RECORD *cap_record;
380							u16 caps = 0;
381
382							while (record->ucRecordSize > 0 &&
383							       record->ucRecordType > 0 &&
384							       record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
385								switch (record->ucRecordType) {
386								case ATOM_ENCODER_CAP_RECORD_TYPE:
387									cap_record =(ATOM_ENCODER_CAP_RECORD *)
388										record;
389									caps = le16_to_cpu(cap_record->usEncoderCap);
390									break;
391								}
392								record = (ATOM_COMMON_RECORD_HEADER *)
393									((char *)record + record->ucRecordSize);
394							}
395							amdgpu_display_add_encoder(adev, encoder_obj,
396										    le16_to_cpu(path->usDeviceTag),
397										    caps);
398						}
399					}
400				} else if (grph_obj_type == GRAPH_OBJECT_TYPE_ROUTER) {
401					for (k = 0; k < router_obj->ucNumberOfObjects; k++) {
402						u16 router_obj_id = le16_to_cpu(router_obj->asObjects[k].usObjectID);
403						if (le16_to_cpu(path->usGraphicObjIds[j]) == router_obj_id) {
404							ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
405								(ctx->bios + data_offset +
406								 le16_to_cpu(router_obj->asObjects[k].usRecordOffset));
407							ATOM_I2C_RECORD *i2c_record;
408							ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
409							ATOM_ROUTER_DDC_PATH_SELECT_RECORD *ddc_path;
410							ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *cd_path;
411							ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *router_src_dst_table =
412								(ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *)
413								(ctx->bios + data_offset +
414								 le16_to_cpu(router_obj->asObjects[k].usSrcDstTableOffset));
415							u8 *num_dst_objs = (u8 *)
416								((u8 *)router_src_dst_table + 1 +
417								 (router_src_dst_table->ucNumberOfSrc * 2));
418							u16 *dst_objs = (u16 *)(num_dst_objs + 1);
419							int enum_id;
420
421							router.router_id = router_obj_id;
422							for (enum_id = 0; enum_id < (*num_dst_objs); enum_id++) {
423								if (le16_to_cpu(path->usConnObjectId) ==
424								    le16_to_cpu(dst_objs[enum_id]))
425									break;
426							}
427
428							while (record->ucRecordSize > 0 &&
429							       record->ucRecordType > 0 &&
430							       record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
431								switch (record->ucRecordType) {
432								case ATOM_I2C_RECORD_TYPE:
433									i2c_record =
434										(ATOM_I2C_RECORD *)
435										record;
436									i2c_config =
437										(ATOM_I2C_ID_CONFIG_ACCESS *)
438										&i2c_record->sucI2cId;
439									router.i2c_info =
440										amdgpu_atombios_lookup_i2c_gpio(adev,
441												       i2c_config->
442												       ucAccess);
443									router.i2c_addr = i2c_record->ucI2CAddr >> 1;
444									break;
445								case ATOM_ROUTER_DDC_PATH_SELECT_RECORD_TYPE:
446									ddc_path = (ATOM_ROUTER_DDC_PATH_SELECT_RECORD *)
447										record;
448									router.ddc_valid = true;
449									router.ddc_mux_type = ddc_path->ucMuxType;
450									router.ddc_mux_control_pin = ddc_path->ucMuxControlPin;
451									router.ddc_mux_state = ddc_path->ucMuxState[enum_id];
452									break;
453								case ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD_TYPE:
454									cd_path = (ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *)
455										record;
456									router.cd_valid = true;
457									router.cd_mux_type = cd_path->ucMuxType;
458									router.cd_mux_control_pin = cd_path->ucMuxControlPin;
459									router.cd_mux_state = cd_path->ucMuxState[enum_id];
460									break;
461								}
462								record = (ATOM_COMMON_RECORD_HEADER *)
463									((char *)record + record->ucRecordSize);
464							}
465						}
466					}
467				}
468			}
469
470			/* look up gpio for ddc, hpd */
471			ddc_bus.valid = false;
472			hpd.hpd = AMDGPU_HPD_NONE;
473			if ((le16_to_cpu(path->usDeviceTag) &
474			     (ATOM_DEVICE_TV_SUPPORT | ATOM_DEVICE_CV_SUPPORT)) == 0) {
475				for (j = 0; j < con_obj->ucNumberOfObjects; j++) {
476					if (le16_to_cpu(path->usConnObjectId) ==
477					    le16_to_cpu(con_obj->asObjects[j].
478							usObjectID)) {
479						ATOM_COMMON_RECORD_HEADER
480						    *record =
481						    (ATOM_COMMON_RECORD_HEADER
482						     *)
483						    (ctx->bios + data_offset +
484						     le16_to_cpu(con_obj->
485								 asObjects[j].
486								 usRecordOffset));
487						ATOM_I2C_RECORD *i2c_record;
488						ATOM_HPD_INT_RECORD *hpd_record;
489						ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
490
491						while (record->ucRecordSize > 0 &&
492						       record->ucRecordType > 0 &&
493						       record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
494							switch (record->ucRecordType) {
495							case ATOM_I2C_RECORD_TYPE:
496								i2c_record =
497								    (ATOM_I2C_RECORD *)
498									record;
499								i2c_config =
500									(ATOM_I2C_ID_CONFIG_ACCESS *)
501									&i2c_record->sucI2cId;
502								ddc_bus = amdgpu_atombios_lookup_i2c_gpio(adev,
503												 i2c_config->
504												 ucAccess);
505								break;
506							case ATOM_HPD_INT_RECORD_TYPE:
507								hpd_record =
508									(ATOM_HPD_INT_RECORD *)
509									record;
510								gpio = amdgpu_atombios_lookup_gpio(adev,
511											  hpd_record->ucHPDIntGPIOID);
512								hpd = amdgpu_atombios_get_hpd_info_from_gpio(adev, &gpio);
513								hpd.plugged_state = hpd_record->ucPlugged_PinState;
514								break;
515							}
516							record =
517							    (ATOM_COMMON_RECORD_HEADER
518							     *) ((char *)record
519								 +
520								 record->
521								 ucRecordSize);
522						}
523						break;
524					}
525				}
526			}
527
528			/* needed for aux chan transactions */
529			ddc_bus.hpd = hpd.hpd;
530
531			conn_id = le16_to_cpu(path->usConnObjectId);
532
533			amdgpu_display_add_connector(adev,
534						      conn_id,
535						      le16_to_cpu(path->usDeviceTag),
536						      connector_type, &ddc_bus,
537						      connector_object_id,
538						      &hpd,
539						      &router);
540
541		}
542	}
543
544	amdgpu_link_encoder_connector(adev_to_drm(adev));
545
546	return true;
547}
548
549union firmware_info {
550	ATOM_FIRMWARE_INFO info;
551	ATOM_FIRMWARE_INFO_V1_2 info_12;
552	ATOM_FIRMWARE_INFO_V1_3 info_13;
553	ATOM_FIRMWARE_INFO_V1_4 info_14;
554	ATOM_FIRMWARE_INFO_V2_1 info_21;
555	ATOM_FIRMWARE_INFO_V2_2 info_22;
556};
557
558int amdgpu_atombios_get_clock_info(struct amdgpu_device *adev)
559{
560	struct amdgpu_mode_info *mode_info = &adev->mode_info;
561	int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
562	uint8_t frev, crev;
563	uint16_t data_offset;
564	int ret = -EINVAL;
565
566	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
567				   &frev, &crev, &data_offset)) {
568		int i;
569		struct amdgpu_pll *ppll = &adev->clock.ppll[0];
570		struct amdgpu_pll *spll = &adev->clock.spll;
571		struct amdgpu_pll *mpll = &adev->clock.mpll;
572		union firmware_info *firmware_info =
573			(union firmware_info *)(mode_info->atom_context->bios +
574						data_offset);
575		/* pixel clocks */
576		ppll->reference_freq =
577		    le16_to_cpu(firmware_info->info.usReferenceClock);
578		ppll->reference_div = 0;
579
580		ppll->pll_out_min =
581			le32_to_cpu(firmware_info->info_12.ulMinPixelClockPLL_Output);
582		ppll->pll_out_max =
583		    le32_to_cpu(firmware_info->info.ulMaxPixelClockPLL_Output);
584
585		ppll->lcd_pll_out_min =
586			le16_to_cpu(firmware_info->info_14.usLcdMinPixelClockPLL_Output) * 100;
587		if (ppll->lcd_pll_out_min == 0)
588			ppll->lcd_pll_out_min = ppll->pll_out_min;
589		ppll->lcd_pll_out_max =
590			le16_to_cpu(firmware_info->info_14.usLcdMaxPixelClockPLL_Output) * 100;
591		if (ppll->lcd_pll_out_max == 0)
592			ppll->lcd_pll_out_max = ppll->pll_out_max;
593
594		if (ppll->pll_out_min == 0)
595			ppll->pll_out_min = 64800;
596
597		ppll->pll_in_min =
598		    le16_to_cpu(firmware_info->info.usMinPixelClockPLL_Input);
599		ppll->pll_in_max =
600		    le16_to_cpu(firmware_info->info.usMaxPixelClockPLL_Input);
601
602		ppll->min_post_div = 2;
603		ppll->max_post_div = 0x7f;
604		ppll->min_frac_feedback_div = 0;
605		ppll->max_frac_feedback_div = 9;
606		ppll->min_ref_div = 2;
607		ppll->max_ref_div = 0x3ff;
608		ppll->min_feedback_div = 4;
609		ppll->max_feedback_div = 0xfff;
610		ppll->best_vco = 0;
611
612		for (i = 1; i < AMDGPU_MAX_PPLL; i++)
613			adev->clock.ppll[i] = *ppll;
614
615		/* system clock */
616		spll->reference_freq =
617			le16_to_cpu(firmware_info->info_21.usCoreReferenceClock);
618		spll->reference_div = 0;
619
620		spll->pll_out_min =
621		    le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Output);
622		spll->pll_out_max =
623		    le32_to_cpu(firmware_info->info.ulMaxEngineClockPLL_Output);
624
625		/* ??? */
626		if (spll->pll_out_min == 0)
627			spll->pll_out_min = 64800;
628
629		spll->pll_in_min =
630		    le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Input);
631		spll->pll_in_max =
632		    le16_to_cpu(firmware_info->info.usMaxEngineClockPLL_Input);
633
634		spll->min_post_div = 1;
635		spll->max_post_div = 1;
636		spll->min_ref_div = 2;
637		spll->max_ref_div = 0xff;
638		spll->min_feedback_div = 4;
639		spll->max_feedback_div = 0xff;
640		spll->best_vco = 0;
641
642		/* memory clock */
643		mpll->reference_freq =
644			le16_to_cpu(firmware_info->info_21.usMemoryReferenceClock);
645		mpll->reference_div = 0;
646
647		mpll->pll_out_min =
648		    le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Output);
649		mpll->pll_out_max =
650		    le32_to_cpu(firmware_info->info.ulMaxMemoryClockPLL_Output);
651
652		/* ??? */
653		if (mpll->pll_out_min == 0)
654			mpll->pll_out_min = 64800;
655
656		mpll->pll_in_min =
657		    le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Input);
658		mpll->pll_in_max =
659		    le16_to_cpu(firmware_info->info.usMaxMemoryClockPLL_Input);
660
661		adev->clock.default_sclk =
662		    le32_to_cpu(firmware_info->info.ulDefaultEngineClock);
663		adev->clock.default_mclk =
664		    le32_to_cpu(firmware_info->info.ulDefaultMemoryClock);
665
666		mpll->min_post_div = 1;
667		mpll->max_post_div = 1;
668		mpll->min_ref_div = 2;
669		mpll->max_ref_div = 0xff;
670		mpll->min_feedback_div = 4;
671		mpll->max_feedback_div = 0xff;
672		mpll->best_vco = 0;
673
674		/* disp clock */
675		adev->clock.default_dispclk =
676			le32_to_cpu(firmware_info->info_21.ulDefaultDispEngineClkFreq);
677		/* set a reasonable default for DP */
678		if (adev->clock.default_dispclk < 53900) {
679			DRM_DEBUG("Changing default dispclk from %dMhz to 600Mhz\n",
680				  adev->clock.default_dispclk / 100);
681			adev->clock.default_dispclk = 60000;
682		} else if (adev->clock.default_dispclk <= 60000) {
683			DRM_DEBUG("Changing default dispclk from %dMhz to 625Mhz\n",
684				  adev->clock.default_dispclk / 100);
685			adev->clock.default_dispclk = 62500;
686		}
687		adev->clock.dp_extclk =
688			le16_to_cpu(firmware_info->info_21.usUniphyDPModeExtClkFreq);
689		adev->clock.current_dispclk = adev->clock.default_dispclk;
690
691		adev->clock.max_pixel_clock = le16_to_cpu(firmware_info->info.usMaxPixelClock);
692		if (adev->clock.max_pixel_clock == 0)
693			adev->clock.max_pixel_clock = 40000;
694
695		/* not technically a clock, but... */
696		adev->mode_info.firmware_flags =
697			le16_to_cpu(firmware_info->info.usFirmwareCapability.susAccess);
698
699		ret = 0;
700	}
701
702	adev->pm.current_sclk = adev->clock.default_sclk;
703	adev->pm.current_mclk = adev->clock.default_mclk;
704
705	return ret;
706}
707
708union gfx_info {
709	ATOM_GFX_INFO_V2_1 info;
710};
711
712int amdgpu_atombios_get_gfx_info(struct amdgpu_device *adev)
713{
714	struct amdgpu_mode_info *mode_info = &adev->mode_info;
715	int index = GetIndexIntoMasterTable(DATA, GFX_Info);
716	uint8_t frev, crev;
717	uint16_t data_offset;
718	int ret = -EINVAL;
719
720	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
721				   &frev, &crev, &data_offset)) {
722		union gfx_info *gfx_info = (union gfx_info *)
723			(mode_info->atom_context->bios + data_offset);
724
725		adev->gfx.config.max_shader_engines = gfx_info->info.max_shader_engines;
726		adev->gfx.config.max_tile_pipes = gfx_info->info.max_tile_pipes;
727		adev->gfx.config.max_cu_per_sh = gfx_info->info.max_cu_per_sh;
728		adev->gfx.config.max_sh_per_se = gfx_info->info.max_sh_per_se;
729		adev->gfx.config.max_backends_per_se = gfx_info->info.max_backends_per_se;
730		adev->gfx.config.max_texture_channel_caches =
731			gfx_info->info.max_texture_channel_caches;
732
733		ret = 0;
734	}
735	return ret;
736}
737
738union igp_info {
739	struct _ATOM_INTEGRATED_SYSTEM_INFO info;
740	struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
741	struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
742	struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_7 info_7;
743	struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_8 info_8;
744	struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_9 info_9;
745};
746
747/*
748 * Return vram width from integrated system info table, if available,
749 * or 0 if not.
750 */
751int amdgpu_atombios_get_vram_width(struct amdgpu_device *adev)
752{
753	struct amdgpu_mode_info *mode_info = &adev->mode_info;
754	int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
755	u16 data_offset, size;
756	union igp_info *igp_info;
757	u8 frev, crev;
758
759	/* get any igp specific overrides */
760	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
761				   &frev, &crev, &data_offset)) {
762		igp_info = (union igp_info *)
763			(mode_info->atom_context->bios + data_offset);
764		switch (crev) {
765		case 8:
766		case 9:
767			return igp_info->info_8.ucUMAChannelNumber * 64;
768		default:
769			return 0;
770		}
771	}
772
773	return 0;
774}
775
776static void amdgpu_atombios_get_igp_ss_overrides(struct amdgpu_device *adev,
777						 struct amdgpu_atom_ss *ss,
778						 int id)
779{
780	struct amdgpu_mode_info *mode_info = &adev->mode_info;
781	int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
782	u16 data_offset, size;
783	union igp_info *igp_info;
784	u8 frev, crev;
785	u16 percentage = 0, rate = 0;
786
787	/* get any igp specific overrides */
788	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
789				   &frev, &crev, &data_offset)) {
790		igp_info = (union igp_info *)
791			(mode_info->atom_context->bios + data_offset);
792		switch (crev) {
793		case 6:
794			switch (id) {
795			case ASIC_INTERNAL_SS_ON_TMDS:
796				percentage = le16_to_cpu(igp_info->info_6.usDVISSPercentage);
797				rate = le16_to_cpu(igp_info->info_6.usDVISSpreadRateIn10Hz);
798				break;
799			case ASIC_INTERNAL_SS_ON_HDMI:
800				percentage = le16_to_cpu(igp_info->info_6.usHDMISSPercentage);
801				rate = le16_to_cpu(igp_info->info_6.usHDMISSpreadRateIn10Hz);
802				break;
803			case ASIC_INTERNAL_SS_ON_LVDS:
804				percentage = le16_to_cpu(igp_info->info_6.usLvdsSSPercentage);
805				rate = le16_to_cpu(igp_info->info_6.usLvdsSSpreadRateIn10Hz);
806				break;
807			}
808			break;
809		case 7:
810			switch (id) {
811			case ASIC_INTERNAL_SS_ON_TMDS:
812				percentage = le16_to_cpu(igp_info->info_7.usDVISSPercentage);
813				rate = le16_to_cpu(igp_info->info_7.usDVISSpreadRateIn10Hz);
814				break;
815			case ASIC_INTERNAL_SS_ON_HDMI:
816				percentage = le16_to_cpu(igp_info->info_7.usHDMISSPercentage);
817				rate = le16_to_cpu(igp_info->info_7.usHDMISSpreadRateIn10Hz);
818				break;
819			case ASIC_INTERNAL_SS_ON_LVDS:
820				percentage = le16_to_cpu(igp_info->info_7.usLvdsSSPercentage);
821				rate = le16_to_cpu(igp_info->info_7.usLvdsSSpreadRateIn10Hz);
822				break;
823			}
824			break;
825		case 8:
826			switch (id) {
827			case ASIC_INTERNAL_SS_ON_TMDS:
828				percentage = le16_to_cpu(igp_info->info_8.usDVISSPercentage);
829				rate = le16_to_cpu(igp_info->info_8.usDVISSpreadRateIn10Hz);
830				break;
831			case ASIC_INTERNAL_SS_ON_HDMI:
832				percentage = le16_to_cpu(igp_info->info_8.usHDMISSPercentage);
833				rate = le16_to_cpu(igp_info->info_8.usHDMISSpreadRateIn10Hz);
834				break;
835			case ASIC_INTERNAL_SS_ON_LVDS:
836				percentage = le16_to_cpu(igp_info->info_8.usLvdsSSPercentage);
837				rate = le16_to_cpu(igp_info->info_8.usLvdsSSpreadRateIn10Hz);
838				break;
839			}
840			break;
841		case 9:
842			switch (id) {
843			case ASIC_INTERNAL_SS_ON_TMDS:
844				percentage = le16_to_cpu(igp_info->info_9.usDVISSPercentage);
845				rate = le16_to_cpu(igp_info->info_9.usDVISSpreadRateIn10Hz);
846				break;
847			case ASIC_INTERNAL_SS_ON_HDMI:
848				percentage = le16_to_cpu(igp_info->info_9.usHDMISSPercentage);
849				rate = le16_to_cpu(igp_info->info_9.usHDMISSpreadRateIn10Hz);
850				break;
851			case ASIC_INTERNAL_SS_ON_LVDS:
852				percentage = le16_to_cpu(igp_info->info_9.usLvdsSSPercentage);
853				rate = le16_to_cpu(igp_info->info_9.usLvdsSSpreadRateIn10Hz);
854				break;
855			}
856			break;
857		default:
858			DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
859			break;
860		}
861		if (percentage)
862			ss->percentage = percentage;
863		if (rate)
864			ss->rate = rate;
865	}
866}
867
868union asic_ss_info {
869	struct _ATOM_ASIC_INTERNAL_SS_INFO info;
870	struct _ATOM_ASIC_INTERNAL_SS_INFO_V2 info_2;
871	struct _ATOM_ASIC_INTERNAL_SS_INFO_V3 info_3;
872};
873
874union asic_ss_assignment {
875	struct _ATOM_ASIC_SS_ASSIGNMENT v1;
876	struct _ATOM_ASIC_SS_ASSIGNMENT_V2 v2;
877	struct _ATOM_ASIC_SS_ASSIGNMENT_V3 v3;
878};
879
880bool amdgpu_atombios_get_asic_ss_info(struct amdgpu_device *adev,
881				      struct amdgpu_atom_ss *ss,
882				      int id, u32 clock)
883{
884	struct amdgpu_mode_info *mode_info = &adev->mode_info;
885	int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
886	uint16_t data_offset, size;
887	union asic_ss_info *ss_info;
888	union asic_ss_assignment *ss_assign;
889	uint8_t frev, crev;
890	int i, num_indices;
891
892	if (id == ASIC_INTERNAL_MEMORY_SS) {
893		if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_MEMORY_CLOCK_SS_SUPPORT))
894			return false;
895	}
896	if (id == ASIC_INTERNAL_ENGINE_SS) {
897		if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_ENGINE_CLOCK_SS_SUPPORT))
898			return false;
899	}
900
901	memset(ss, 0, sizeof(struct amdgpu_atom_ss));
902	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
903				   &frev, &crev, &data_offset)) {
904
905		ss_info =
906			(union asic_ss_info *)(mode_info->atom_context->bios + data_offset);
907
908		switch (frev) {
909		case 1:
910			num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
911				sizeof(ATOM_ASIC_SS_ASSIGNMENT);
912
913			ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info.asSpreadSpectrum[0]);
914			for (i = 0; i < num_indices; i++) {
915				if ((ss_assign->v1.ucClockIndication == id) &&
916				    (clock <= le32_to_cpu(ss_assign->v1.ulTargetClockRange))) {
917					ss->percentage =
918						le16_to_cpu(ss_assign->v1.usSpreadSpectrumPercentage);
919					ss->type = ss_assign->v1.ucSpreadSpectrumMode;
920					ss->rate = le16_to_cpu(ss_assign->v1.usSpreadRateInKhz);
921					ss->percentage_divider = 100;
922					return true;
923				}
924				ss_assign = (union asic_ss_assignment *)
925					((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT));
926			}
927			break;
928		case 2:
929			num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
930				sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2);
931			ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_2.asSpreadSpectrum[0]);
932			for (i = 0; i < num_indices; i++) {
933				if ((ss_assign->v2.ucClockIndication == id) &&
934				    (clock <= le32_to_cpu(ss_assign->v2.ulTargetClockRange))) {
935					ss->percentage =
936						le16_to_cpu(ss_assign->v2.usSpreadSpectrumPercentage);
937					ss->type = ss_assign->v2.ucSpreadSpectrumMode;
938					ss->rate = le16_to_cpu(ss_assign->v2.usSpreadRateIn10Hz);
939					ss->percentage_divider = 100;
940					if ((crev == 2) &&
941					    ((id == ASIC_INTERNAL_ENGINE_SS) ||
942					     (id == ASIC_INTERNAL_MEMORY_SS)))
943						ss->rate /= 100;
944					return true;
945				}
946				ss_assign = (union asic_ss_assignment *)
947					((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2));
948			}
949			break;
950		case 3:
951			num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
952				sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3);
953			ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_3.asSpreadSpectrum[0]);
954			for (i = 0; i < num_indices; i++) {
955				if ((ss_assign->v3.ucClockIndication == id) &&
956				    (clock <= le32_to_cpu(ss_assign->v3.ulTargetClockRange))) {
957					ss->percentage =
958						le16_to_cpu(ss_assign->v3.usSpreadSpectrumPercentage);
959					ss->type = ss_assign->v3.ucSpreadSpectrumMode;
960					ss->rate = le16_to_cpu(ss_assign->v3.usSpreadRateIn10Hz);
961					if (ss_assign->v3.ucSpreadSpectrumMode &
962					    SS_MODE_V3_PERCENTAGE_DIV_BY_1000_MASK)
963						ss->percentage_divider = 1000;
964					else
965						ss->percentage_divider = 100;
966					if ((id == ASIC_INTERNAL_ENGINE_SS) ||
967					    (id == ASIC_INTERNAL_MEMORY_SS))
968						ss->rate /= 100;
969					if (adev->flags & AMD_IS_APU)
970						amdgpu_atombios_get_igp_ss_overrides(adev, ss, id);
971					return true;
972				}
973				ss_assign = (union asic_ss_assignment *)
974					((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3));
975			}
976			break;
977		default:
978			DRM_ERROR("Unsupported ASIC_InternalSS_Info table: %d %d\n", frev, crev);
979			break;
980		}
981
982	}
983	return false;
984}
985
986union get_clock_dividers {
987	struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS v1;
988	struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V2 v2;
989	struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V3 v3;
990	struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V4 v4;
991	struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V5 v5;
992	struct _COMPUTE_GPU_CLOCK_INPUT_PARAMETERS_V1_6 v6_in;
993	struct _COMPUTE_GPU_CLOCK_OUTPUT_PARAMETERS_V1_6 v6_out;
994};
995
996int amdgpu_atombios_get_clock_dividers(struct amdgpu_device *adev,
997				       u8 clock_type,
998				       u32 clock,
999				       bool strobe_mode,
1000				       struct atom_clock_dividers *dividers)
1001{
1002	union get_clock_dividers args;
1003	int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryEnginePLL);
1004	u8 frev, crev;
1005
1006	memset(&args, 0, sizeof(args));
1007	memset(dividers, 0, sizeof(struct atom_clock_dividers));
1008
1009	if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1010		return -EINVAL;
1011
1012	switch (crev) {
1013	case 2:
1014	case 3:
1015	case 5:
1016		/* r6xx, r7xx, evergreen, ni, si.
1017		 * TODO: add support for asic_type <= CHIP_RV770*/
1018		if (clock_type == COMPUTE_ENGINE_PLL_PARAM) {
1019			args.v3.ulClockParams = cpu_to_le32((clock_type << 24) | clock);
1020
1021			amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1022				sizeof(args));
1023
1024			dividers->post_div = args.v3.ucPostDiv;
1025			dividers->enable_post_div = (args.v3.ucCntlFlag &
1026						     ATOM_PLL_CNTL_FLAG_PLL_POST_DIV_EN) ? true : false;
1027			dividers->enable_dithen = (args.v3.ucCntlFlag &
1028						   ATOM_PLL_CNTL_FLAG_FRACTION_DISABLE) ? false : true;
1029			dividers->whole_fb_div = le16_to_cpu(args.v3.ulFbDiv.usFbDiv);
1030			dividers->frac_fb_div = le16_to_cpu(args.v3.ulFbDiv.usFbDivFrac);
1031			dividers->ref_div = args.v3.ucRefDiv;
1032			dividers->vco_mode = (args.v3.ucCntlFlag &
1033					      ATOM_PLL_CNTL_FLAG_MPLL_VCO_MODE) ? 1 : 0;
1034		} else {
1035			/* for SI we use ComputeMemoryClockParam for memory plls */
1036			if (adev->asic_type >= CHIP_TAHITI)
1037				return -EINVAL;
1038			args.v5.ulClockParams = cpu_to_le32((clock_type << 24) | clock);
1039			if (strobe_mode)
1040				args.v5.ucInputFlag = ATOM_PLL_INPUT_FLAG_PLL_STROBE_MODE_EN;
1041
1042			amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1043				sizeof(args));
1044
1045			dividers->post_div = args.v5.ucPostDiv;
1046			dividers->enable_post_div = (args.v5.ucCntlFlag &
1047						     ATOM_PLL_CNTL_FLAG_PLL_POST_DIV_EN) ? true : false;
1048			dividers->enable_dithen = (args.v5.ucCntlFlag &
1049						   ATOM_PLL_CNTL_FLAG_FRACTION_DISABLE) ? false : true;
1050			dividers->whole_fb_div = le16_to_cpu(args.v5.ulFbDiv.usFbDiv);
1051			dividers->frac_fb_div = le16_to_cpu(args.v5.ulFbDiv.usFbDivFrac);
1052			dividers->ref_div = args.v5.ucRefDiv;
1053			dividers->vco_mode = (args.v5.ucCntlFlag &
1054					      ATOM_PLL_CNTL_FLAG_MPLL_VCO_MODE) ? 1 : 0;
1055		}
1056		break;
1057	case 4:
1058		/* fusion */
1059		args.v4.ulClock = cpu_to_le32(clock);	/* 10 khz */
1060
1061		amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1062			sizeof(args));
1063
1064		dividers->post_divider = dividers->post_div = args.v4.ucPostDiv;
1065		dividers->real_clock = le32_to_cpu(args.v4.ulClock);
1066		break;
1067	case 6:
1068		/* CI */
1069		/* COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK, COMPUTE_GPUCLK_INPUT_FLAG_SCLK */
1070		args.v6_in.ulClock.ulComputeClockFlag = clock_type;
1071		args.v6_in.ulClock.ulClockFreq = cpu_to_le32(clock);	/* 10 khz */
1072
1073		amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1074			sizeof(args));
1075
1076		dividers->whole_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDiv);
1077		dividers->frac_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDivFrac);
1078		dividers->ref_div = args.v6_out.ucPllRefDiv;
1079		dividers->post_div = args.v6_out.ucPllPostDiv;
1080		dividers->flags = args.v6_out.ucPllCntlFlag;
1081		dividers->real_clock = le32_to_cpu(args.v6_out.ulClock.ulClock);
1082		dividers->post_divider = args.v6_out.ulClock.ucPostDiv;
1083		break;
1084	default:
1085		return -EINVAL;
1086	}
1087	return 0;
1088}
1089
1090#ifdef CONFIG_DRM_AMDGPU_SI
1091int amdgpu_atombios_get_memory_pll_dividers(struct amdgpu_device *adev,
1092					    u32 clock,
1093					    bool strobe_mode,
1094					    struct atom_mpll_param *mpll_param)
1095{
1096	COMPUTE_MEMORY_CLOCK_PARAM_PARAMETERS_V2_1 args;
1097	int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryClockParam);
1098	u8 frev, crev;
1099
1100	memset(&args, 0, sizeof(args));
1101	memset(mpll_param, 0, sizeof(struct atom_mpll_param));
1102
1103	if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1104		return -EINVAL;
1105
1106	switch (frev) {
1107	case 2:
1108		switch (crev) {
1109		case 1:
1110			/* SI */
1111			args.ulClock = cpu_to_le32(clock);	/* 10 khz */
1112			args.ucInputFlag = 0;
1113			if (strobe_mode)
1114				args.ucInputFlag |= MPLL_INPUT_FLAG_STROBE_MODE_EN;
1115
1116			amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1117				sizeof(args));
1118
1119			mpll_param->clkfrac = le16_to_cpu(args.ulFbDiv.usFbDivFrac);
1120			mpll_param->clkf = le16_to_cpu(args.ulFbDiv.usFbDiv);
1121			mpll_param->post_div = args.ucPostDiv;
1122			mpll_param->dll_speed = args.ucDllSpeed;
1123			mpll_param->bwcntl = args.ucBWCntl;
1124			mpll_param->vco_mode =
1125				(args.ucPllCntlFlag & MPLL_CNTL_FLAG_VCO_MODE_MASK);
1126			mpll_param->yclk_sel =
1127				(args.ucPllCntlFlag & MPLL_CNTL_FLAG_BYPASS_DQ_PLL) ? 1 : 0;
1128			mpll_param->qdr =
1129				(args.ucPllCntlFlag & MPLL_CNTL_FLAG_QDR_ENABLE) ? 1 : 0;
1130			mpll_param->half_rate =
1131				(args.ucPllCntlFlag & MPLL_CNTL_FLAG_AD_HALF_RATE) ? 1 : 0;
1132			break;
1133		default:
1134			return -EINVAL;
1135		}
1136		break;
1137	default:
1138		return -EINVAL;
1139	}
1140	return 0;
1141}
1142
1143void amdgpu_atombios_set_engine_dram_timings(struct amdgpu_device *adev,
1144					     u32 eng_clock, u32 mem_clock)
1145{
1146	SET_ENGINE_CLOCK_PS_ALLOCATION args;
1147	int index = GetIndexIntoMasterTable(COMMAND, DynamicMemorySettings);
1148	u32 tmp;
1149
1150	memset(&args, 0, sizeof(args));
1151
1152	tmp = eng_clock & SET_CLOCK_FREQ_MASK;
1153	tmp |= (COMPUTE_ENGINE_PLL_PARAM << 24);
1154
1155	args.ulTargetEngineClock = cpu_to_le32(tmp);
1156	if (mem_clock)
1157		args.sReserved.ulClock = cpu_to_le32(mem_clock & SET_CLOCK_FREQ_MASK);
1158
1159	amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1160		sizeof(args));
1161}
1162
1163void amdgpu_atombios_get_default_voltages(struct amdgpu_device *adev,
1164					  u16 *vddc, u16 *vddci, u16 *mvdd)
1165{
1166	struct amdgpu_mode_info *mode_info = &adev->mode_info;
1167	int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
1168	u8 frev, crev;
1169	u16 data_offset;
1170	union firmware_info *firmware_info;
1171
1172	*vddc = 0;
1173	*vddci = 0;
1174	*mvdd = 0;
1175
1176	if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
1177				   &frev, &crev, &data_offset)) {
1178		firmware_info =
1179			(union firmware_info *)(mode_info->atom_context->bios +
1180						data_offset);
1181		*vddc = le16_to_cpu(firmware_info->info_14.usBootUpVDDCVoltage);
1182		if ((frev == 2) && (crev >= 2)) {
1183			*vddci = le16_to_cpu(firmware_info->info_22.usBootUpVDDCIVoltage);
1184			*mvdd = le16_to_cpu(firmware_info->info_22.usBootUpMVDDCVoltage);
1185		}
1186	}
1187}
1188
1189union set_voltage {
1190	struct _SET_VOLTAGE_PS_ALLOCATION alloc;
1191	struct _SET_VOLTAGE_PARAMETERS v1;
1192	struct _SET_VOLTAGE_PARAMETERS_V2 v2;
1193	struct _SET_VOLTAGE_PARAMETERS_V1_3 v3;
1194};
1195
1196int amdgpu_atombios_get_max_vddc(struct amdgpu_device *adev, u8 voltage_type,
1197			     u16 voltage_id, u16 *voltage)
1198{
1199	union set_voltage args;
1200	int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
1201	u8 frev, crev;
1202
1203	if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1204		return -EINVAL;
1205
1206	switch (crev) {
1207	case 1:
1208		return -EINVAL;
1209	case 2:
1210		args.v2.ucVoltageType = SET_VOLTAGE_GET_MAX_VOLTAGE;
1211		args.v2.ucVoltageMode = 0;
1212		args.v2.usVoltageLevel = 0;
1213
1214		amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1215			sizeof(args));
1216
1217		*voltage = le16_to_cpu(args.v2.usVoltageLevel);
1218		break;
1219	case 3:
1220		args.v3.ucVoltageType = voltage_type;
1221		args.v3.ucVoltageMode = ATOM_GET_VOLTAGE_LEVEL;
1222		args.v3.usVoltageLevel = cpu_to_le16(voltage_id);
1223
1224		amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args,
1225			sizeof(args));
1226
1227		*voltage = le16_to_cpu(args.v3.usVoltageLevel);
1228		break;
1229	default:
1230		DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1231		return -EINVAL;
1232	}
1233
1234	return 0;
1235}
1236
1237int amdgpu_atombios_get_leakage_vddc_based_on_leakage_idx(struct amdgpu_device *adev,
1238						      u16 *voltage,
1239						      u16 leakage_idx)
1240{
1241	return amdgpu_atombios_get_max_vddc(adev, VOLTAGE_TYPE_VDDC, leakage_idx, voltage);
1242}
1243
1244union voltage_object_info {
1245	struct _ATOM_VOLTAGE_OBJECT_INFO v1;
1246	struct _ATOM_VOLTAGE_OBJECT_INFO_V2 v2;
1247	struct _ATOM_VOLTAGE_OBJECT_INFO_V3_1 v3;
1248};
1249
1250union voltage_object {
1251	struct _ATOM_VOLTAGE_OBJECT v1;
1252	struct _ATOM_VOLTAGE_OBJECT_V2 v2;
1253	union _ATOM_VOLTAGE_OBJECT_V3 v3;
1254};
1255
1256
1257static ATOM_VOLTAGE_OBJECT_V3 *amdgpu_atombios_lookup_voltage_object_v3(ATOM_VOLTAGE_OBJECT_INFO_V3_1 *v3,
1258									u8 voltage_type, u8 voltage_mode)
1259{
1260	u32 size = le16_to_cpu(v3->sHeader.usStructureSize);
1261	u32 offset = offsetof(ATOM_VOLTAGE_OBJECT_INFO_V3_1, asVoltageObj[0]);
1262	u8 *start = (u8 *)v3;
1263
1264	while (offset < size) {
1265		ATOM_VOLTAGE_OBJECT_V3 *vo = (ATOM_VOLTAGE_OBJECT_V3 *)(start + offset);
1266		if ((vo->asGpioVoltageObj.sHeader.ucVoltageType == voltage_type) &&
1267		    (vo->asGpioVoltageObj.sHeader.ucVoltageMode == voltage_mode))
1268			return vo;
1269		offset += le16_to_cpu(vo->asGpioVoltageObj.sHeader.usSize);
1270	}
1271	return NULL;
1272}
1273
1274int amdgpu_atombios_get_svi2_info(struct amdgpu_device *adev,
1275			      u8 voltage_type,
1276			      u8 *svd_gpio_id, u8 *svc_gpio_id)
1277{
1278	int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1279	u8 frev, crev;
1280	u16 data_offset, size;
1281	union voltage_object_info *voltage_info;
1282	union voltage_object *voltage_object = NULL;
1283
1284	if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1285				   &frev, &crev, &data_offset)) {
1286		voltage_info = (union voltage_object_info *)
1287			(adev->mode_info.atom_context->bios + data_offset);
1288
1289		switch (frev) {
1290		case 3:
1291			switch (crev) {
1292			case 1:
1293				voltage_object = (union voltage_object *)
1294					amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1295								      voltage_type,
1296								      VOLTAGE_OBJ_SVID2);
1297				if (voltage_object) {
1298					*svd_gpio_id = voltage_object->v3.asSVID2Obj.ucSVDGpioId;
1299					*svc_gpio_id = voltage_object->v3.asSVID2Obj.ucSVCGpioId;
1300				} else {
1301					return -EINVAL;
1302				}
1303				break;
1304			default:
1305				DRM_ERROR("unknown voltage object table\n");
1306				return -EINVAL;
1307			}
1308			break;
1309		default:
1310			DRM_ERROR("unknown voltage object table\n");
1311			return -EINVAL;
1312		}
1313
1314	}
1315	return 0;
1316}
1317
1318bool
1319amdgpu_atombios_is_voltage_gpio(struct amdgpu_device *adev,
1320				u8 voltage_type, u8 voltage_mode)
1321{
1322	int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1323	u8 frev, crev;
1324	u16 data_offset, size;
1325	union voltage_object_info *voltage_info;
1326
1327	if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1328				   &frev, &crev, &data_offset)) {
1329		voltage_info = (union voltage_object_info *)
1330			(adev->mode_info.atom_context->bios + data_offset);
1331
1332		switch (frev) {
1333		case 3:
1334			switch (crev) {
1335			case 1:
1336				if (amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1337								  voltage_type, voltage_mode))
1338					return true;
1339				break;
1340			default:
1341				DRM_ERROR("unknown voltage object table\n");
1342				return false;
1343			}
1344			break;
1345		default:
1346			DRM_ERROR("unknown voltage object table\n");
1347			return false;
1348		}
1349
1350	}
1351	return false;
1352}
1353
1354int amdgpu_atombios_get_voltage_table(struct amdgpu_device *adev,
1355				      u8 voltage_type, u8 voltage_mode,
1356				      struct atom_voltage_table *voltage_table)
1357{
1358	int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1359	u8 frev, crev;
1360	u16 data_offset, size;
1361	int i;
1362	union voltage_object_info *voltage_info;
1363	union voltage_object *voltage_object = NULL;
1364
1365	if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1366				   &frev, &crev, &data_offset)) {
1367		voltage_info = (union voltage_object_info *)
1368			(adev->mode_info.atom_context->bios + data_offset);
1369
1370		switch (frev) {
1371		case 3:
1372			switch (crev) {
1373			case 1:
1374				voltage_object = (union voltage_object *)
1375					amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1376								      voltage_type, voltage_mode);
1377				if (voltage_object) {
1378					ATOM_GPIO_VOLTAGE_OBJECT_V3 *gpio =
1379						&voltage_object->v3.asGpioVoltageObj;
1380					VOLTAGE_LUT_ENTRY_V2 *lut;
1381					if (gpio->ucGpioEntryNum > MAX_VOLTAGE_ENTRIES)
1382						return -EINVAL;
1383					lut = &gpio->asVolGpioLut[0];
1384					for (i = 0; i < gpio->ucGpioEntryNum; i++) {
1385						voltage_table->entries[i].value =
1386							le16_to_cpu(lut->usVoltageValue);
1387						voltage_table->entries[i].smio_low =
1388							le32_to_cpu(lut->ulVoltageId);
1389						lut = (VOLTAGE_LUT_ENTRY_V2 *)
1390							((u8 *)lut + sizeof(VOLTAGE_LUT_ENTRY_V2));
1391					}
1392					voltage_table->mask_low = le32_to_cpu(gpio->ulGpioMaskVal);
1393					voltage_table->count = gpio->ucGpioEntryNum;
1394					voltage_table->phase_delay = gpio->ucPhaseDelay;
1395					return 0;
1396				}
1397				break;
1398			default:
1399				DRM_ERROR("unknown voltage object table\n");
1400				return -EINVAL;
1401			}
1402			break;
1403		default:
1404			DRM_ERROR("unknown voltage object table\n");
1405			return -EINVAL;
1406		}
1407	}
1408	return -EINVAL;
1409}
1410
1411union vram_info {
1412	struct _ATOM_VRAM_INFO_V3 v1_3;
1413	struct _ATOM_VRAM_INFO_V4 v1_4;
1414	struct _ATOM_VRAM_INFO_HEADER_V2_1 v2_1;
1415};
1416
1417#define MEM_ID_MASK           0xff000000
1418#define MEM_ID_SHIFT          24
1419#define CLOCK_RANGE_MASK      0x00ffffff
1420#define CLOCK_RANGE_SHIFT     0
1421#define LOW_NIBBLE_MASK       0xf
1422#define DATA_EQU_PREV         0
1423#define DATA_FROM_TABLE       4
1424
1425int amdgpu_atombios_init_mc_reg_table(struct amdgpu_device *adev,
1426				      u8 module_index,
1427				      struct atom_mc_reg_table *reg_table)
1428{
1429	int index = GetIndexIntoMasterTable(DATA, VRAM_Info);
1430	u8 frev, crev, num_entries, t_mem_id, num_ranges = 0;
1431	u32 i = 0, j;
1432	u16 data_offset, size;
1433	union vram_info *vram_info;
1434
1435	memset(reg_table, 0, sizeof(struct atom_mc_reg_table));
1436
1437	if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1438				   &frev, &crev, &data_offset)) {
1439		vram_info = (union vram_info *)
1440			(adev->mode_info.atom_context->bios + data_offset);
1441		switch (frev) {
1442		case 1:
1443			DRM_ERROR("old table version %d, %d\n", frev, crev);
1444			return -EINVAL;
1445		case 2:
1446			switch (crev) {
1447			case 1:
1448				if (module_index < vram_info->v2_1.ucNumOfVRAMModule) {
1449					ATOM_INIT_REG_BLOCK *reg_block =
1450						(ATOM_INIT_REG_BLOCK *)
1451						((u8 *)vram_info + le16_to_cpu(vram_info->v2_1.usMemClkPatchTblOffset));
1452					ATOM_MEMORY_SETTING_DATA_BLOCK *reg_data =
1453						(ATOM_MEMORY_SETTING_DATA_BLOCK *)
1454						((u8 *)reg_block + (2 * sizeof(u16)) +
1455						 le16_to_cpu(reg_block->usRegIndexTblSize));
1456					ATOM_INIT_REG_INDEX_FORMAT *format = &reg_block->asRegIndexBuf[0];
1457					num_entries = (u8)((le16_to_cpu(reg_block->usRegIndexTblSize)) /
1458							   sizeof(ATOM_INIT_REG_INDEX_FORMAT)) - 1;
1459					if (num_entries > VBIOS_MC_REGISTER_ARRAY_SIZE)
1460						return -EINVAL;
1461					while (i < num_entries) {
1462						if (format->ucPreRegDataLength & ACCESS_PLACEHOLDER)
1463							break;
1464						reg_table->mc_reg_address[i].s1 =
1465							(u16)(le16_to_cpu(format->usRegIndex));
1466						reg_table->mc_reg_address[i].pre_reg_data =
1467							(u8)(format->ucPreRegDataLength);
1468						i++;
1469						format = (ATOM_INIT_REG_INDEX_FORMAT *)
1470							((u8 *)format + sizeof(ATOM_INIT_REG_INDEX_FORMAT));
1471					}
1472					reg_table->last = i;
1473					while ((le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK) &&
1474					       (num_ranges < VBIOS_MAX_AC_TIMING_ENTRIES)) {
1475						t_mem_id = (u8)((le32_to_cpu(*(u32 *)reg_data) & MEM_ID_MASK)
1476								>> MEM_ID_SHIFT);
1477						if (module_index == t_mem_id) {
1478							reg_table->mc_reg_table_entry[num_ranges].mclk_max =
1479								(u32)((le32_to_cpu(*(u32 *)reg_data) & CLOCK_RANGE_MASK)
1480								      >> CLOCK_RANGE_SHIFT);
1481							for (i = 0, j = 1; i < reg_table->last; i++) {
1482								if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_FROM_TABLE) {
1483									reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
1484										(u32)le32_to_cpu(*((u32 *)reg_data + j));
1485									j++;
1486								} else if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_EQU_PREV) {
1487									reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
1488										reg_table->mc_reg_table_entry[num_ranges].mc_data[i - 1];
1489								}
1490							}
1491							num_ranges++;
1492						}
1493						reg_data = (ATOM_MEMORY_SETTING_DATA_BLOCK *)
1494							((u8 *)reg_data + le16_to_cpu(reg_block->usRegDataBlkSize));
1495					}
1496					if (le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK)
1497						return -EINVAL;
1498					reg_table->num_entries = num_ranges;
1499				} else
1500					return -EINVAL;
1501				break;
1502			default:
1503				DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1504				return -EINVAL;
1505			}
1506			break;
1507		default:
1508			DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1509			return -EINVAL;
1510		}
1511		return 0;
1512	}
1513	return -EINVAL;
1514}
1515#endif
1516
1517bool amdgpu_atombios_has_gpu_virtualization_table(struct amdgpu_device *adev)
1518{
1519	int index = GetIndexIntoMasterTable(DATA, GPUVirtualizationInfo);
1520	u8 frev, crev;
1521	u16 data_offset, size;
1522
1523	if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1524					  &frev, &crev, &data_offset))
1525		return true;
1526
1527	return false;
1528}
1529
1530void amdgpu_atombios_scratch_regs_lock(struct amdgpu_device *adev, bool lock)
1531{
1532	uint32_t bios_6_scratch;
1533
1534	bios_6_scratch = RREG32(adev->bios_scratch_reg_offset + 6);
1535
1536	if (lock) {
1537		bios_6_scratch |= ATOM_S6_CRITICAL_STATE;
1538		bios_6_scratch &= ~ATOM_S6_ACC_MODE;
1539	} else {
1540		bios_6_scratch &= ~ATOM_S6_CRITICAL_STATE;
1541		bios_6_scratch |= ATOM_S6_ACC_MODE;
1542	}
1543
1544	WREG32(adev->bios_scratch_reg_offset + 6, bios_6_scratch);
1545}
1546
1547static void amdgpu_atombios_scratch_regs_init(struct amdgpu_device *adev)
1548{
1549	uint32_t bios_2_scratch, bios_6_scratch;
1550
1551	adev->bios_scratch_reg_offset = mmBIOS_SCRATCH_0;
1552
1553	bios_2_scratch = RREG32(adev->bios_scratch_reg_offset + 2);
1554	bios_6_scratch = RREG32(adev->bios_scratch_reg_offset + 6);
1555
1556	/* let the bios control the backlight */
1557	bios_2_scratch &= ~ATOM_S2_VRI_BRIGHT_ENABLE;
1558
1559	/* tell the bios not to handle mode switching */
1560	bios_6_scratch |= ATOM_S6_ACC_BLOCK_DISPLAY_SWITCH;
1561
1562	/* clear the vbios dpms state */
1563	bios_2_scratch &= ~ATOM_S2_DEVICE_DPMS_STATE;
1564
1565	WREG32(adev->bios_scratch_reg_offset + 2, bios_2_scratch);
1566	WREG32(adev->bios_scratch_reg_offset + 6, bios_6_scratch);
1567}
1568
1569void amdgpu_atombios_scratch_regs_engine_hung(struct amdgpu_device *adev,
1570					      bool hung)
1571{
1572	u32 tmp = RREG32(adev->bios_scratch_reg_offset + 3);
1573
1574	if (hung)
1575		tmp |= ATOM_S3_ASIC_GUI_ENGINE_HUNG;
1576	else
1577		tmp &= ~ATOM_S3_ASIC_GUI_ENGINE_HUNG;
1578
1579	WREG32(adev->bios_scratch_reg_offset + 3, tmp);
1580}
1581
1582void amdgpu_atombios_scratch_regs_set_backlight_level(struct amdgpu_device *adev,
1583						      u32 backlight_level)
1584{
1585	u32 tmp = RREG32(adev->bios_scratch_reg_offset + 2);
1586
1587	tmp &= ~ATOM_S2_CURRENT_BL_LEVEL_MASK;
1588	tmp |= (backlight_level << ATOM_S2_CURRENT_BL_LEVEL_SHIFT) &
1589		ATOM_S2_CURRENT_BL_LEVEL_MASK;
1590
1591	WREG32(adev->bios_scratch_reg_offset + 2, tmp);
1592}
1593
1594bool amdgpu_atombios_scratch_need_asic_init(struct amdgpu_device *adev)
1595{
1596	u32 tmp = RREG32(adev->bios_scratch_reg_offset + 7);
1597
1598	if (tmp & ATOM_S7_ASIC_INIT_COMPLETE_MASK)
1599		return false;
1600	else
1601		return true;
1602}
1603
1604/* Atom needs data in little endian format so swap as appropriate when copying
1605 * data to or from atom. Note that atom operates on dw units.
1606 *
1607 * Use to_le=true when sending data to atom and provide at least
1608 * ALIGN(num_bytes,4) bytes in the dst buffer.
1609 *
1610 * Use to_le=false when receiving data from atom and provide ALIGN(num_bytes,4)
1611 * byes in the src buffer.
1612 */
1613void amdgpu_atombios_copy_swap(u8 *dst, u8 *src, u8 num_bytes, bool to_le)
1614{
1615#ifdef __BIG_ENDIAN
1616	u32 src_tmp[5], dst_tmp[5];
1617	int i;
1618	u8 align_num_bytes = ALIGN(num_bytes, 4);
1619
1620	if (to_le) {
1621		memcpy(src_tmp, src, num_bytes);
1622		for (i = 0; i < align_num_bytes / 4; i++)
1623			dst_tmp[i] = cpu_to_le32(src_tmp[i]);
1624		memcpy(dst, dst_tmp, align_num_bytes);
1625	} else {
1626		memcpy(src_tmp, src, align_num_bytes);
1627		for (i = 0; i < align_num_bytes / 4; i++)
1628			dst_tmp[i] = le32_to_cpu(src_tmp[i]);
1629		memcpy(dst, dst_tmp, num_bytes);
1630	}
1631#else
1632	memcpy(dst, src, num_bytes);
1633#endif
1634}
1635
1636static int amdgpu_atombios_allocate_fb_scratch(struct amdgpu_device *adev)
1637{
1638	struct atom_context *ctx = adev->mode_info.atom_context;
1639	int index = GetIndexIntoMasterTable(DATA, VRAM_UsageByFirmware);
1640	uint16_t data_offset;
1641	int usage_bytes = 0;
1642	struct _ATOM_VRAM_USAGE_BY_FIRMWARE *firmware_usage;
1643	u64 start_addr;
1644	u64 size;
1645
1646	if (amdgpu_atom_parse_data_header(ctx, index, NULL, NULL, NULL, &data_offset)) {
1647		firmware_usage = (struct _ATOM_VRAM_USAGE_BY_FIRMWARE *)(ctx->bios + data_offset);
1648
1649		DRM_DEBUG("atom firmware requested %08x %dkb\n",
1650			  le32_to_cpu(firmware_usage->asFirmwareVramReserveInfo[0].ulStartAddrUsedByFirmware),
1651			  le16_to_cpu(firmware_usage->asFirmwareVramReserveInfo[0].usFirmwareUseInKb));
1652
1653		start_addr = firmware_usage->asFirmwareVramReserveInfo[0].ulStartAddrUsedByFirmware;
1654		size = firmware_usage->asFirmwareVramReserveInfo[0].usFirmwareUseInKb;
1655
1656		if ((uint32_t)(start_addr & ATOM_VRAM_OPERATION_FLAGS_MASK) ==
1657			(uint32_t)(ATOM_VRAM_BLOCK_SRIOV_MSG_SHARE_RESERVATION <<
1658			ATOM_VRAM_OPERATION_FLAGS_SHIFT)) {
1659			/* Firmware request VRAM reservation for SR-IOV */
1660			adev->mman.fw_vram_usage_start_offset = (start_addr &
1661				(~ATOM_VRAM_OPERATION_FLAGS_MASK)) << 10;
1662			adev->mman.fw_vram_usage_size = size << 10;
1663			/* Use the default scratch size */
1664			usage_bytes = 0;
1665		} else {
1666			usage_bytes = le16_to_cpu(firmware_usage->asFirmwareVramReserveInfo[0].usFirmwareUseInKb) * 1024;
1667		}
1668	}
1669	ctx->scratch_size_bytes = 0;
1670	if (usage_bytes == 0)
1671		usage_bytes = 20 * 1024;
1672	/* allocate some scratch memory */
1673	ctx->scratch = kzalloc(usage_bytes, GFP_KERNEL);
1674	if (!ctx->scratch)
1675		return -ENOMEM;
1676	ctx->scratch_size_bytes = usage_bytes;
1677	return 0;
1678}
1679
1680/* ATOM accessor methods */
1681/*
1682 * ATOM is an interpreted byte code stored in tables in the vbios.  The
1683 * driver registers callbacks to access registers and the interpreter
1684 * in the driver parses the tables and executes then to program specific
1685 * actions (set display modes, asic init, etc.).  See amdgpu_atombios.c,
1686 * atombios.h, and atom.c
1687 */
1688
1689/**
1690 * cail_pll_read - read PLL register
1691 *
1692 * @info: atom card_info pointer
1693 * @reg: PLL register offset
1694 *
1695 * Provides a PLL register accessor for the atom interpreter (r4xx+).
1696 * Returns the value of the PLL register.
1697 */
1698static uint32_t cail_pll_read(struct card_info *info, uint32_t reg)
1699{
1700	return 0;
1701}
1702
1703/**
1704 * cail_pll_write - write PLL register
1705 *
1706 * @info: atom card_info pointer
1707 * @reg: PLL register offset
1708 * @val: value to write to the pll register
1709 *
1710 * Provides a PLL register accessor for the atom interpreter (r4xx+).
1711 */
1712static void cail_pll_write(struct card_info *info, uint32_t reg, uint32_t val)
1713{
1714
1715}
1716
1717/**
1718 * cail_mc_read - read MC (Memory Controller) register
1719 *
1720 * @info: atom card_info pointer
1721 * @reg: MC register offset
1722 *
1723 * Provides an MC register accessor for the atom interpreter (r4xx+).
1724 * Returns the value of the MC register.
1725 */
1726static uint32_t cail_mc_read(struct card_info *info, uint32_t reg)
1727{
1728	return 0;
1729}
1730
1731/**
1732 * cail_mc_write - write MC (Memory Controller) register
1733 *
1734 * @info: atom card_info pointer
1735 * @reg: MC register offset
1736 * @val: value to write to the pll register
1737 *
1738 * Provides a MC register accessor for the atom interpreter (r4xx+).
1739 */
1740static void cail_mc_write(struct card_info *info, uint32_t reg, uint32_t val)
1741{
1742
1743}
1744
1745/**
1746 * cail_reg_write - write MMIO register
1747 *
1748 * @info: atom card_info pointer
1749 * @reg: MMIO register offset
1750 * @val: value to write to the pll register
1751 *
1752 * Provides a MMIO register accessor for the atom interpreter (r4xx+).
1753 */
1754static void cail_reg_write(struct card_info *info, uint32_t reg, uint32_t val)
1755{
1756	struct amdgpu_device *adev = drm_to_adev(info->dev);
1757
1758	WREG32(reg, val);
1759}
1760
1761/**
1762 * cail_reg_read - read MMIO register
1763 *
1764 * @info: atom card_info pointer
1765 * @reg: MMIO register offset
1766 *
1767 * Provides an MMIO register accessor for the atom interpreter (r4xx+).
1768 * Returns the value of the MMIO register.
1769 */
1770static uint32_t cail_reg_read(struct card_info *info, uint32_t reg)
1771{
1772	struct amdgpu_device *adev = drm_to_adev(info->dev);
1773	uint32_t r;
1774
1775	r = RREG32(reg);
1776	return r;
1777}
1778
1779static ssize_t amdgpu_atombios_get_vbios_version(struct device *dev,
1780						 struct device_attribute *attr,
1781						 char *buf)
1782{
1783	struct drm_device *ddev = dev_get_drvdata(dev);
1784	struct amdgpu_device *adev = drm_to_adev(ddev);
1785	struct atom_context *ctx = adev->mode_info.atom_context;
1786
1787	return sysfs_emit(buf, "%s\n", ctx->vbios_pn);
1788}
1789
1790static DEVICE_ATTR(vbios_version, 0444, amdgpu_atombios_get_vbios_version,
1791		   NULL);
1792
1793static struct attribute *amdgpu_vbios_version_attrs[] = {
1794	&dev_attr_vbios_version.attr,
1795	NULL
1796};
1797
1798const struct attribute_group amdgpu_vbios_version_attr_group = {
1799	.attrs = amdgpu_vbios_version_attrs
1800};
1801
1802int amdgpu_atombios_sysfs_init(struct amdgpu_device *adev)
1803{
1804	if (adev->mode_info.atom_context)
1805		return devm_device_add_group(adev->dev,
1806					     &amdgpu_vbios_version_attr_group);
1807
1808	return 0;
1809}
1810
1811/**
1812 * amdgpu_atombios_fini - free the driver info and callbacks for atombios
1813 *
1814 * @adev: amdgpu_device pointer
1815 *
1816 * Frees the driver info and register access callbacks for the ATOM
1817 * interpreter (r4xx+).
1818 * Called at driver shutdown.
1819 */
1820void amdgpu_atombios_fini(struct amdgpu_device *adev)
1821{
1822	if (adev->mode_info.atom_context) {
1823		kfree(adev->mode_info.atom_context->scratch);
1824		kfree(adev->mode_info.atom_context->iio);
1825	}
1826	kfree(adev->mode_info.atom_context);
1827	adev->mode_info.atom_context = NULL;
1828	kfree(adev->mode_info.atom_card_info);
1829	adev->mode_info.atom_card_info = NULL;
1830}
1831
1832/**
1833 * amdgpu_atombios_init - init the driver info and callbacks for atombios
1834 *
1835 * @adev: amdgpu_device pointer
1836 *
1837 * Initializes the driver info and register access callbacks for the
1838 * ATOM interpreter (r4xx+).
1839 * Returns 0 on sucess, -ENOMEM on failure.
1840 * Called at driver startup.
1841 */
1842int amdgpu_atombios_init(struct amdgpu_device *adev)
1843{
1844	struct card_info *atom_card_info =
1845	    kzalloc(sizeof(struct card_info), GFP_KERNEL);
1846
1847	if (!atom_card_info)
1848		return -ENOMEM;
1849
1850	adev->mode_info.atom_card_info = atom_card_info;
1851	atom_card_info->dev = adev_to_drm(adev);
1852	atom_card_info->reg_read = cail_reg_read;
1853	atom_card_info->reg_write = cail_reg_write;
1854	atom_card_info->mc_read = cail_mc_read;
1855	atom_card_info->mc_write = cail_mc_write;
1856	atom_card_info->pll_read = cail_pll_read;
1857	atom_card_info->pll_write = cail_pll_write;
1858
1859	adev->mode_info.atom_context = amdgpu_atom_parse(atom_card_info, adev->bios);
1860	if (!adev->mode_info.atom_context) {
1861		amdgpu_atombios_fini(adev);
1862		return -ENOMEM;
1863	}
1864
1865	mutex_init(&adev->mode_info.atom_context->mutex);
1866	if (adev->is_atom_fw) {
1867		amdgpu_atomfirmware_scratch_regs_init(adev);
1868		amdgpu_atomfirmware_allocate_fb_scratch(adev);
1869		/* cached firmware_flags for further usage */
1870		adev->mode_info.firmware_flags =
1871			amdgpu_atomfirmware_query_firmware_capability(adev);
1872	} else {
1873		amdgpu_atombios_scratch_regs_init(adev);
1874		amdgpu_atombios_allocate_fb_scratch(adev);
1875	}
1876
1877	return 0;
1878}
1879
1880int amdgpu_atombios_get_data_table(struct amdgpu_device *adev,
1881				   uint32_t table,
1882				   uint16_t *size,
1883				   uint8_t *frev,
1884				   uint8_t *crev,
1885				   uint8_t **addr)
1886{
1887	uint16_t data_start;
1888
1889	if (!amdgpu_atom_parse_data_header(adev->mode_info.atom_context, table,
1890					   size, frev, crev, &data_start))
1891		return -EINVAL;
1892
1893	*addr = (uint8_t *)adev->mode_info.atom_context->bios + data_start;
1894
1895	return 0;
1896}
1897