amdgpu_atombios.c 50 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634
  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. #include <drm/drmP.h>
  27. #include <drm/amdgpu_drm.h>
  28. #include "amdgpu.h"
  29. #include "amdgpu_atombios.h"
  30. #include "amdgpu_i2c.h"
  31. #include "atom.h"
  32. #include "atom-bits.h"
  33. #include "atombios_encoders.h"
  34. #include "bif/bif_4_1_d.h"
  35. static void amdgpu_atombios_lookup_i2c_gpio_quirks(struct amdgpu_device *adev,
  36. ATOM_GPIO_I2C_ASSIGMENT *gpio,
  37. u8 index)
  38. {
  39. }
  40. static struct amdgpu_i2c_bus_rec amdgpu_atombios_get_bus_rec_for_i2c_gpio(ATOM_GPIO_I2C_ASSIGMENT *gpio)
  41. {
  42. struct amdgpu_i2c_bus_rec i2c;
  43. memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
  44. i2c.mask_clk_reg = le16_to_cpu(gpio->usClkMaskRegisterIndex);
  45. i2c.mask_data_reg = le16_to_cpu(gpio->usDataMaskRegisterIndex);
  46. i2c.en_clk_reg = le16_to_cpu(gpio->usClkEnRegisterIndex);
  47. i2c.en_data_reg = le16_to_cpu(gpio->usDataEnRegisterIndex);
  48. i2c.y_clk_reg = le16_to_cpu(gpio->usClkY_RegisterIndex);
  49. i2c.y_data_reg = le16_to_cpu(gpio->usDataY_RegisterIndex);
  50. i2c.a_clk_reg = le16_to_cpu(gpio->usClkA_RegisterIndex);
  51. i2c.a_data_reg = le16_to_cpu(gpio->usDataA_RegisterIndex);
  52. i2c.mask_clk_mask = (1 << gpio->ucClkMaskShift);
  53. i2c.mask_data_mask = (1 << gpio->ucDataMaskShift);
  54. i2c.en_clk_mask = (1 << gpio->ucClkEnShift);
  55. i2c.en_data_mask = (1 << gpio->ucDataEnShift);
  56. i2c.y_clk_mask = (1 << gpio->ucClkY_Shift);
  57. i2c.y_data_mask = (1 << gpio->ucDataY_Shift);
  58. i2c.a_clk_mask = (1 << gpio->ucClkA_Shift);
  59. i2c.a_data_mask = (1 << gpio->ucDataA_Shift);
  60. if (gpio->sucI2cId.sbfAccess.bfHW_Capable)
  61. i2c.hw_capable = true;
  62. else
  63. i2c.hw_capable = false;
  64. if (gpio->sucI2cId.ucAccess == 0xa0)
  65. i2c.mm_i2c = true;
  66. else
  67. i2c.mm_i2c = false;
  68. i2c.i2c_id = gpio->sucI2cId.ucAccess;
  69. if (i2c.mask_clk_reg)
  70. i2c.valid = true;
  71. else
  72. i2c.valid = false;
  73. return i2c;
  74. }
  75. struct amdgpu_i2c_bus_rec amdgpu_atombios_lookup_i2c_gpio(struct amdgpu_device *adev,
  76. uint8_t id)
  77. {
  78. struct atom_context *ctx = adev->mode_info.atom_context;
  79. ATOM_GPIO_I2C_ASSIGMENT *gpio;
  80. struct amdgpu_i2c_bus_rec i2c;
  81. int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
  82. struct _ATOM_GPIO_I2C_INFO *i2c_info;
  83. uint16_t data_offset, size;
  84. int i, num_indices;
  85. memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
  86. i2c.valid = false;
  87. if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
  88. i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
  89. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  90. sizeof(ATOM_GPIO_I2C_ASSIGMENT);
  91. gpio = &i2c_info->asGPIO_Info[0];
  92. for (i = 0; i < num_indices; i++) {
  93. amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
  94. if (gpio->sucI2cId.ucAccess == id) {
  95. i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
  96. break;
  97. }
  98. gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
  99. ((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
  100. }
  101. }
  102. return i2c;
  103. }
  104. void amdgpu_atombios_i2c_init(struct amdgpu_device *adev)
  105. {
  106. struct atom_context *ctx = adev->mode_info.atom_context;
  107. ATOM_GPIO_I2C_ASSIGMENT *gpio;
  108. struct amdgpu_i2c_bus_rec i2c;
  109. int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
  110. struct _ATOM_GPIO_I2C_INFO *i2c_info;
  111. uint16_t data_offset, size;
  112. int i, num_indices;
  113. char stmp[32];
  114. if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
  115. i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
  116. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  117. sizeof(ATOM_GPIO_I2C_ASSIGMENT);
  118. gpio = &i2c_info->asGPIO_Info[0];
  119. for (i = 0; i < num_indices; i++) {
  120. amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
  121. i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
  122. if (i2c.valid) {
  123. sprintf(stmp, "0x%x", i2c.i2c_id);
  124. adev->i2c_bus[i] = amdgpu_i2c_create(adev->ddev, &i2c, stmp);
  125. }
  126. gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
  127. ((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
  128. }
  129. }
  130. }
  131. struct amdgpu_gpio_rec
  132. amdgpu_atombios_lookup_gpio(struct amdgpu_device *adev,
  133. u8 id)
  134. {
  135. struct atom_context *ctx = adev->mode_info.atom_context;
  136. struct amdgpu_gpio_rec gpio;
  137. int index = GetIndexIntoMasterTable(DATA, GPIO_Pin_LUT);
  138. struct _ATOM_GPIO_PIN_LUT *gpio_info;
  139. ATOM_GPIO_PIN_ASSIGNMENT *pin;
  140. u16 data_offset, size;
  141. int i, num_indices;
  142. memset(&gpio, 0, sizeof(struct amdgpu_gpio_rec));
  143. gpio.valid = false;
  144. if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
  145. gpio_info = (struct _ATOM_GPIO_PIN_LUT *)(ctx->bios + data_offset);
  146. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  147. sizeof(ATOM_GPIO_PIN_ASSIGNMENT);
  148. pin = gpio_info->asGPIO_Pin;
  149. for (i = 0; i < num_indices; i++) {
  150. if (id == pin->ucGPIO_ID) {
  151. gpio.id = pin->ucGPIO_ID;
  152. gpio.reg = le16_to_cpu(pin->usGpioPin_AIndex);
  153. gpio.shift = pin->ucGpioPinBitShift;
  154. gpio.mask = (1 << pin->ucGpioPinBitShift);
  155. gpio.valid = true;
  156. break;
  157. }
  158. pin = (ATOM_GPIO_PIN_ASSIGNMENT *)
  159. ((u8 *)pin + sizeof(ATOM_GPIO_PIN_ASSIGNMENT));
  160. }
  161. }
  162. return gpio;
  163. }
  164. static struct amdgpu_hpd
  165. amdgpu_atombios_get_hpd_info_from_gpio(struct amdgpu_device *adev,
  166. struct amdgpu_gpio_rec *gpio)
  167. {
  168. struct amdgpu_hpd hpd;
  169. u32 reg;
  170. memset(&hpd, 0, sizeof(struct amdgpu_hpd));
  171. reg = amdgpu_display_hpd_get_gpio_reg(adev);
  172. hpd.gpio = *gpio;
  173. if (gpio->reg == reg) {
  174. switch(gpio->mask) {
  175. case (1 << 0):
  176. hpd.hpd = AMDGPU_HPD_1;
  177. break;
  178. case (1 << 8):
  179. hpd.hpd = AMDGPU_HPD_2;
  180. break;
  181. case (1 << 16):
  182. hpd.hpd = AMDGPU_HPD_3;
  183. break;
  184. case (1 << 24):
  185. hpd.hpd = AMDGPU_HPD_4;
  186. break;
  187. case (1 << 26):
  188. hpd.hpd = AMDGPU_HPD_5;
  189. break;
  190. case (1 << 28):
  191. hpd.hpd = AMDGPU_HPD_6;
  192. break;
  193. default:
  194. hpd.hpd = AMDGPU_HPD_NONE;
  195. break;
  196. }
  197. } else
  198. hpd.hpd = AMDGPU_HPD_NONE;
  199. return hpd;
  200. }
  201. static const int object_connector_convert[] = {
  202. DRM_MODE_CONNECTOR_Unknown,
  203. DRM_MODE_CONNECTOR_DVII,
  204. DRM_MODE_CONNECTOR_DVII,
  205. DRM_MODE_CONNECTOR_DVID,
  206. DRM_MODE_CONNECTOR_DVID,
  207. DRM_MODE_CONNECTOR_VGA,
  208. DRM_MODE_CONNECTOR_Composite,
  209. DRM_MODE_CONNECTOR_SVIDEO,
  210. DRM_MODE_CONNECTOR_Unknown,
  211. DRM_MODE_CONNECTOR_Unknown,
  212. DRM_MODE_CONNECTOR_9PinDIN,
  213. DRM_MODE_CONNECTOR_Unknown,
  214. DRM_MODE_CONNECTOR_HDMIA,
  215. DRM_MODE_CONNECTOR_HDMIB,
  216. DRM_MODE_CONNECTOR_LVDS,
  217. DRM_MODE_CONNECTOR_9PinDIN,
  218. DRM_MODE_CONNECTOR_Unknown,
  219. DRM_MODE_CONNECTOR_Unknown,
  220. DRM_MODE_CONNECTOR_Unknown,
  221. DRM_MODE_CONNECTOR_DisplayPort,
  222. DRM_MODE_CONNECTOR_eDP,
  223. DRM_MODE_CONNECTOR_Unknown
  224. };
  225. bool amdgpu_atombios_get_connector_info_from_object_table(struct amdgpu_device *adev)
  226. {
  227. struct amdgpu_mode_info *mode_info = &adev->mode_info;
  228. struct atom_context *ctx = mode_info->atom_context;
  229. int index = GetIndexIntoMasterTable(DATA, Object_Header);
  230. u16 size, data_offset;
  231. u8 frev, crev;
  232. ATOM_CONNECTOR_OBJECT_TABLE *con_obj;
  233. ATOM_ENCODER_OBJECT_TABLE *enc_obj;
  234. ATOM_OBJECT_TABLE *router_obj;
  235. ATOM_DISPLAY_OBJECT_PATH_TABLE *path_obj;
  236. ATOM_OBJECT_HEADER *obj_header;
  237. int i, j, k, path_size, device_support;
  238. int connector_type;
  239. u16 conn_id, connector_object_id;
  240. struct amdgpu_i2c_bus_rec ddc_bus;
  241. struct amdgpu_router router;
  242. struct amdgpu_gpio_rec gpio;
  243. struct amdgpu_hpd hpd;
  244. if (!amdgpu_atom_parse_data_header(ctx, index, &size, &frev, &crev, &data_offset))
  245. return false;
  246. if (crev < 2)
  247. return false;
  248. obj_header = (ATOM_OBJECT_HEADER *) (ctx->bios + data_offset);
  249. path_obj = (ATOM_DISPLAY_OBJECT_PATH_TABLE *)
  250. (ctx->bios + data_offset +
  251. le16_to_cpu(obj_header->usDisplayPathTableOffset));
  252. con_obj = (ATOM_CONNECTOR_OBJECT_TABLE *)
  253. (ctx->bios + data_offset +
  254. le16_to_cpu(obj_header->usConnectorObjectTableOffset));
  255. enc_obj = (ATOM_ENCODER_OBJECT_TABLE *)
  256. (ctx->bios + data_offset +
  257. le16_to_cpu(obj_header->usEncoderObjectTableOffset));
  258. router_obj = (ATOM_OBJECT_TABLE *)
  259. (ctx->bios + data_offset +
  260. le16_to_cpu(obj_header->usRouterObjectTableOffset));
  261. device_support = le16_to_cpu(obj_header->usDeviceSupport);
  262. path_size = 0;
  263. for (i = 0; i < path_obj->ucNumOfDispPath; i++) {
  264. uint8_t *addr = (uint8_t *) path_obj->asDispPath;
  265. ATOM_DISPLAY_OBJECT_PATH *path;
  266. addr += path_size;
  267. path = (ATOM_DISPLAY_OBJECT_PATH *) addr;
  268. path_size += le16_to_cpu(path->usSize);
  269. if (device_support & le16_to_cpu(path->usDeviceTag)) {
  270. uint8_t con_obj_id, con_obj_num, con_obj_type;
  271. con_obj_id =
  272. (le16_to_cpu(path->usConnObjectId) & OBJECT_ID_MASK)
  273. >> OBJECT_ID_SHIFT;
  274. con_obj_num =
  275. (le16_to_cpu(path->usConnObjectId) & ENUM_ID_MASK)
  276. >> ENUM_ID_SHIFT;
  277. con_obj_type =
  278. (le16_to_cpu(path->usConnObjectId) &
  279. OBJECT_TYPE_MASK) >> OBJECT_TYPE_SHIFT;
  280. /* Skip TV/CV support */
  281. if ((le16_to_cpu(path->usDeviceTag) ==
  282. ATOM_DEVICE_TV1_SUPPORT) ||
  283. (le16_to_cpu(path->usDeviceTag) ==
  284. ATOM_DEVICE_CV_SUPPORT))
  285. continue;
  286. if (con_obj_id >= ARRAY_SIZE(object_connector_convert)) {
  287. DRM_ERROR("invalid con_obj_id %d for device tag 0x%04x\n",
  288. con_obj_id, le16_to_cpu(path->usDeviceTag));
  289. continue;
  290. }
  291. connector_type =
  292. object_connector_convert[con_obj_id];
  293. connector_object_id = con_obj_id;
  294. if (connector_type == DRM_MODE_CONNECTOR_Unknown)
  295. continue;
  296. router.ddc_valid = false;
  297. router.cd_valid = false;
  298. for (j = 0; j < ((le16_to_cpu(path->usSize) - 8) / 2); j++) {
  299. uint8_t grph_obj_id, grph_obj_num, grph_obj_type;
  300. grph_obj_id =
  301. (le16_to_cpu(path->usGraphicObjIds[j]) &
  302. OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
  303. grph_obj_num =
  304. (le16_to_cpu(path->usGraphicObjIds[j]) &
  305. ENUM_ID_MASK) >> ENUM_ID_SHIFT;
  306. grph_obj_type =
  307. (le16_to_cpu(path->usGraphicObjIds[j]) &
  308. OBJECT_TYPE_MASK) >> OBJECT_TYPE_SHIFT;
  309. if (grph_obj_type == GRAPH_OBJECT_TYPE_ENCODER) {
  310. for (k = 0; k < enc_obj->ucNumberOfObjects; k++) {
  311. u16 encoder_obj = le16_to_cpu(enc_obj->asObjects[k].usObjectID);
  312. if (le16_to_cpu(path->usGraphicObjIds[j]) == encoder_obj) {
  313. ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
  314. (ctx->bios + data_offset +
  315. le16_to_cpu(enc_obj->asObjects[k].usRecordOffset));
  316. ATOM_ENCODER_CAP_RECORD *cap_record;
  317. u16 caps = 0;
  318. while (record->ucRecordSize > 0 &&
  319. record->ucRecordType > 0 &&
  320. record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
  321. switch (record->ucRecordType) {
  322. case ATOM_ENCODER_CAP_RECORD_TYPE:
  323. cap_record =(ATOM_ENCODER_CAP_RECORD *)
  324. record;
  325. caps = le16_to_cpu(cap_record->usEncoderCap);
  326. break;
  327. }
  328. record = (ATOM_COMMON_RECORD_HEADER *)
  329. ((char *)record + record->ucRecordSize);
  330. }
  331. amdgpu_display_add_encoder(adev, encoder_obj,
  332. le16_to_cpu(path->usDeviceTag),
  333. caps);
  334. }
  335. }
  336. } else if (grph_obj_type == GRAPH_OBJECT_TYPE_ROUTER) {
  337. for (k = 0; k < router_obj->ucNumberOfObjects; k++) {
  338. u16 router_obj_id = le16_to_cpu(router_obj->asObjects[k].usObjectID);
  339. if (le16_to_cpu(path->usGraphicObjIds[j]) == router_obj_id) {
  340. ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
  341. (ctx->bios + data_offset +
  342. le16_to_cpu(router_obj->asObjects[k].usRecordOffset));
  343. ATOM_I2C_RECORD *i2c_record;
  344. ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
  345. ATOM_ROUTER_DDC_PATH_SELECT_RECORD *ddc_path;
  346. ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *cd_path;
  347. ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *router_src_dst_table =
  348. (ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *)
  349. (ctx->bios + data_offset +
  350. le16_to_cpu(router_obj->asObjects[k].usSrcDstTableOffset));
  351. u8 *num_dst_objs = (u8 *)
  352. ((u8 *)router_src_dst_table + 1 +
  353. (router_src_dst_table->ucNumberOfSrc * 2));
  354. u16 *dst_objs = (u16 *)(num_dst_objs + 1);
  355. int enum_id;
  356. router.router_id = router_obj_id;
  357. for (enum_id = 0; enum_id < (*num_dst_objs); enum_id++) {
  358. if (le16_to_cpu(path->usConnObjectId) ==
  359. le16_to_cpu(dst_objs[enum_id]))
  360. break;
  361. }
  362. while (record->ucRecordSize > 0 &&
  363. record->ucRecordType > 0 &&
  364. record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
  365. switch (record->ucRecordType) {
  366. case ATOM_I2C_RECORD_TYPE:
  367. i2c_record =
  368. (ATOM_I2C_RECORD *)
  369. record;
  370. i2c_config =
  371. (ATOM_I2C_ID_CONFIG_ACCESS *)
  372. &i2c_record->sucI2cId;
  373. router.i2c_info =
  374. amdgpu_atombios_lookup_i2c_gpio(adev,
  375. i2c_config->
  376. ucAccess);
  377. router.i2c_addr = i2c_record->ucI2CAddr >> 1;
  378. break;
  379. case ATOM_ROUTER_DDC_PATH_SELECT_RECORD_TYPE:
  380. ddc_path = (ATOM_ROUTER_DDC_PATH_SELECT_RECORD *)
  381. record;
  382. router.ddc_valid = true;
  383. router.ddc_mux_type = ddc_path->ucMuxType;
  384. router.ddc_mux_control_pin = ddc_path->ucMuxControlPin;
  385. router.ddc_mux_state = ddc_path->ucMuxState[enum_id];
  386. break;
  387. case ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD_TYPE:
  388. cd_path = (ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *)
  389. record;
  390. router.cd_valid = true;
  391. router.cd_mux_type = cd_path->ucMuxType;
  392. router.cd_mux_control_pin = cd_path->ucMuxControlPin;
  393. router.cd_mux_state = cd_path->ucMuxState[enum_id];
  394. break;
  395. }
  396. record = (ATOM_COMMON_RECORD_HEADER *)
  397. ((char *)record + record->ucRecordSize);
  398. }
  399. }
  400. }
  401. }
  402. }
  403. /* look up gpio for ddc, hpd */
  404. ddc_bus.valid = false;
  405. hpd.hpd = AMDGPU_HPD_NONE;
  406. if ((le16_to_cpu(path->usDeviceTag) &
  407. (ATOM_DEVICE_TV_SUPPORT | ATOM_DEVICE_CV_SUPPORT)) == 0) {
  408. for (j = 0; j < con_obj->ucNumberOfObjects; j++) {
  409. if (le16_to_cpu(path->usConnObjectId) ==
  410. le16_to_cpu(con_obj->asObjects[j].
  411. usObjectID)) {
  412. ATOM_COMMON_RECORD_HEADER
  413. *record =
  414. (ATOM_COMMON_RECORD_HEADER
  415. *)
  416. (ctx->bios + data_offset +
  417. le16_to_cpu(con_obj->
  418. asObjects[j].
  419. usRecordOffset));
  420. ATOM_I2C_RECORD *i2c_record;
  421. ATOM_HPD_INT_RECORD *hpd_record;
  422. ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
  423. while (record->ucRecordSize > 0 &&
  424. record->ucRecordType > 0 &&
  425. record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
  426. switch (record->ucRecordType) {
  427. case ATOM_I2C_RECORD_TYPE:
  428. i2c_record =
  429. (ATOM_I2C_RECORD *)
  430. record;
  431. i2c_config =
  432. (ATOM_I2C_ID_CONFIG_ACCESS *)
  433. &i2c_record->sucI2cId;
  434. ddc_bus = amdgpu_atombios_lookup_i2c_gpio(adev,
  435. i2c_config->
  436. ucAccess);
  437. break;
  438. case ATOM_HPD_INT_RECORD_TYPE:
  439. hpd_record =
  440. (ATOM_HPD_INT_RECORD *)
  441. record;
  442. gpio = amdgpu_atombios_lookup_gpio(adev,
  443. hpd_record->ucHPDIntGPIOID);
  444. hpd = amdgpu_atombios_get_hpd_info_from_gpio(adev, &gpio);
  445. hpd.plugged_state = hpd_record->ucPlugged_PinState;
  446. break;
  447. }
  448. record =
  449. (ATOM_COMMON_RECORD_HEADER
  450. *) ((char *)record
  451. +
  452. record->
  453. ucRecordSize);
  454. }
  455. break;
  456. }
  457. }
  458. }
  459. /* needed for aux chan transactions */
  460. ddc_bus.hpd = hpd.hpd;
  461. conn_id = le16_to_cpu(path->usConnObjectId);
  462. amdgpu_display_add_connector(adev,
  463. conn_id,
  464. le16_to_cpu(path->usDeviceTag),
  465. connector_type, &ddc_bus,
  466. connector_object_id,
  467. &hpd,
  468. &router);
  469. }
  470. }
  471. amdgpu_link_encoder_connector(adev->ddev);
  472. return true;
  473. }
  474. union firmware_info {
  475. ATOM_FIRMWARE_INFO info;
  476. ATOM_FIRMWARE_INFO_V1_2 info_12;
  477. ATOM_FIRMWARE_INFO_V1_3 info_13;
  478. ATOM_FIRMWARE_INFO_V1_4 info_14;
  479. ATOM_FIRMWARE_INFO_V2_1 info_21;
  480. ATOM_FIRMWARE_INFO_V2_2 info_22;
  481. };
  482. int amdgpu_atombios_get_clock_info(struct amdgpu_device *adev)
  483. {
  484. struct amdgpu_mode_info *mode_info = &adev->mode_info;
  485. int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
  486. uint8_t frev, crev;
  487. uint16_t data_offset;
  488. int ret = -EINVAL;
  489. if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
  490. &frev, &crev, &data_offset)) {
  491. int i;
  492. struct amdgpu_pll *ppll = &adev->clock.ppll[0];
  493. struct amdgpu_pll *spll = &adev->clock.spll;
  494. struct amdgpu_pll *mpll = &adev->clock.mpll;
  495. union firmware_info *firmware_info =
  496. (union firmware_info *)(mode_info->atom_context->bios +
  497. data_offset);
  498. /* pixel clocks */
  499. ppll->reference_freq =
  500. le16_to_cpu(firmware_info->info.usReferenceClock);
  501. ppll->reference_div = 0;
  502. ppll->pll_out_min =
  503. le32_to_cpu(firmware_info->info_12.ulMinPixelClockPLL_Output);
  504. ppll->pll_out_max =
  505. le32_to_cpu(firmware_info->info.ulMaxPixelClockPLL_Output);
  506. ppll->lcd_pll_out_min =
  507. le16_to_cpu(firmware_info->info_14.usLcdMinPixelClockPLL_Output) * 100;
  508. if (ppll->lcd_pll_out_min == 0)
  509. ppll->lcd_pll_out_min = ppll->pll_out_min;
  510. ppll->lcd_pll_out_max =
  511. le16_to_cpu(firmware_info->info_14.usLcdMaxPixelClockPLL_Output) * 100;
  512. if (ppll->lcd_pll_out_max == 0)
  513. ppll->lcd_pll_out_max = ppll->pll_out_max;
  514. if (ppll->pll_out_min == 0)
  515. ppll->pll_out_min = 64800;
  516. ppll->pll_in_min =
  517. le16_to_cpu(firmware_info->info.usMinPixelClockPLL_Input);
  518. ppll->pll_in_max =
  519. le16_to_cpu(firmware_info->info.usMaxPixelClockPLL_Input);
  520. ppll->min_post_div = 2;
  521. ppll->max_post_div = 0x7f;
  522. ppll->min_frac_feedback_div = 0;
  523. ppll->max_frac_feedback_div = 9;
  524. ppll->min_ref_div = 2;
  525. ppll->max_ref_div = 0x3ff;
  526. ppll->min_feedback_div = 4;
  527. ppll->max_feedback_div = 0xfff;
  528. ppll->best_vco = 0;
  529. for (i = 1; i < AMDGPU_MAX_PPLL; i++)
  530. adev->clock.ppll[i] = *ppll;
  531. /* system clock */
  532. spll->reference_freq =
  533. le16_to_cpu(firmware_info->info_21.usCoreReferenceClock);
  534. spll->reference_div = 0;
  535. spll->pll_out_min =
  536. le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Output);
  537. spll->pll_out_max =
  538. le32_to_cpu(firmware_info->info.ulMaxEngineClockPLL_Output);
  539. /* ??? */
  540. if (spll->pll_out_min == 0)
  541. spll->pll_out_min = 64800;
  542. spll->pll_in_min =
  543. le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Input);
  544. spll->pll_in_max =
  545. le16_to_cpu(firmware_info->info.usMaxEngineClockPLL_Input);
  546. spll->min_post_div = 1;
  547. spll->max_post_div = 1;
  548. spll->min_ref_div = 2;
  549. spll->max_ref_div = 0xff;
  550. spll->min_feedback_div = 4;
  551. spll->max_feedback_div = 0xff;
  552. spll->best_vco = 0;
  553. /* memory clock */
  554. mpll->reference_freq =
  555. le16_to_cpu(firmware_info->info_21.usMemoryReferenceClock);
  556. mpll->reference_div = 0;
  557. mpll->pll_out_min =
  558. le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Output);
  559. mpll->pll_out_max =
  560. le32_to_cpu(firmware_info->info.ulMaxMemoryClockPLL_Output);
  561. /* ??? */
  562. if (mpll->pll_out_min == 0)
  563. mpll->pll_out_min = 64800;
  564. mpll->pll_in_min =
  565. le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Input);
  566. mpll->pll_in_max =
  567. le16_to_cpu(firmware_info->info.usMaxMemoryClockPLL_Input);
  568. adev->clock.default_sclk =
  569. le32_to_cpu(firmware_info->info.ulDefaultEngineClock);
  570. adev->clock.default_mclk =
  571. le32_to_cpu(firmware_info->info.ulDefaultMemoryClock);
  572. mpll->min_post_div = 1;
  573. mpll->max_post_div = 1;
  574. mpll->min_ref_div = 2;
  575. mpll->max_ref_div = 0xff;
  576. mpll->min_feedback_div = 4;
  577. mpll->max_feedback_div = 0xff;
  578. mpll->best_vco = 0;
  579. /* disp clock */
  580. adev->clock.default_dispclk =
  581. le32_to_cpu(firmware_info->info_21.ulDefaultDispEngineClkFreq);
  582. /* set a reasonable default for DP */
  583. if (adev->clock.default_dispclk < 53900) {
  584. DRM_INFO("Changing default dispclk from %dMhz to 600Mhz\n",
  585. adev->clock.default_dispclk / 100);
  586. adev->clock.default_dispclk = 60000;
  587. }
  588. adev->clock.dp_extclk =
  589. le16_to_cpu(firmware_info->info_21.usUniphyDPModeExtClkFreq);
  590. adev->clock.current_dispclk = adev->clock.default_dispclk;
  591. adev->clock.max_pixel_clock = le16_to_cpu(firmware_info->info.usMaxPixelClock);
  592. if (adev->clock.max_pixel_clock == 0)
  593. adev->clock.max_pixel_clock = 40000;
  594. /* not technically a clock, but... */
  595. adev->mode_info.firmware_flags =
  596. le16_to_cpu(firmware_info->info.usFirmwareCapability.susAccess);
  597. ret = 0;
  598. }
  599. adev->pm.current_sclk = adev->clock.default_sclk;
  600. adev->pm.current_mclk = adev->clock.default_mclk;
  601. return ret;
  602. }
  603. union gfx_info {
  604. ATOM_GFX_INFO_V2_1 info;
  605. };
  606. int amdgpu_atombios_get_gfx_info(struct amdgpu_device *adev)
  607. {
  608. struct amdgpu_mode_info *mode_info = &adev->mode_info;
  609. int index = GetIndexIntoMasterTable(DATA, GFX_Info);
  610. uint8_t frev, crev;
  611. uint16_t data_offset;
  612. int ret = -EINVAL;
  613. if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
  614. &frev, &crev, &data_offset)) {
  615. union gfx_info *gfx_info = (union gfx_info *)
  616. (mode_info->atom_context->bios + data_offset);
  617. adev->gfx.config.max_shader_engines = gfx_info->info.max_shader_engines;
  618. adev->gfx.config.max_tile_pipes = gfx_info->info.max_tile_pipes;
  619. adev->gfx.config.max_cu_per_sh = gfx_info->info.max_cu_per_sh;
  620. adev->gfx.config.max_sh_per_se = gfx_info->info.max_sh_per_se;
  621. adev->gfx.config.max_backends_per_se = gfx_info->info.max_backends_per_se;
  622. adev->gfx.config.max_texture_channel_caches =
  623. gfx_info->info.max_texture_channel_caches;
  624. ret = 0;
  625. }
  626. return ret;
  627. }
  628. union igp_info {
  629. struct _ATOM_INTEGRATED_SYSTEM_INFO info;
  630. struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
  631. struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
  632. struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_7 info_7;
  633. struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_8 info_8;
  634. struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_9 info_9;
  635. };
  636. static void amdgpu_atombios_get_igp_ss_overrides(struct amdgpu_device *adev,
  637. struct amdgpu_atom_ss *ss,
  638. int id)
  639. {
  640. struct amdgpu_mode_info *mode_info = &adev->mode_info;
  641. int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
  642. u16 data_offset, size;
  643. union igp_info *igp_info;
  644. u8 frev, crev;
  645. u16 percentage = 0, rate = 0;
  646. /* get any igp specific overrides */
  647. if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
  648. &frev, &crev, &data_offset)) {
  649. igp_info = (union igp_info *)
  650. (mode_info->atom_context->bios + data_offset);
  651. switch (crev) {
  652. case 6:
  653. switch (id) {
  654. case ASIC_INTERNAL_SS_ON_TMDS:
  655. percentage = le16_to_cpu(igp_info->info_6.usDVISSPercentage);
  656. rate = le16_to_cpu(igp_info->info_6.usDVISSpreadRateIn10Hz);
  657. break;
  658. case ASIC_INTERNAL_SS_ON_HDMI:
  659. percentage = le16_to_cpu(igp_info->info_6.usHDMISSPercentage);
  660. rate = le16_to_cpu(igp_info->info_6.usHDMISSpreadRateIn10Hz);
  661. break;
  662. case ASIC_INTERNAL_SS_ON_LVDS:
  663. percentage = le16_to_cpu(igp_info->info_6.usLvdsSSPercentage);
  664. rate = le16_to_cpu(igp_info->info_6.usLvdsSSpreadRateIn10Hz);
  665. break;
  666. }
  667. break;
  668. case 7:
  669. switch (id) {
  670. case ASIC_INTERNAL_SS_ON_TMDS:
  671. percentage = le16_to_cpu(igp_info->info_7.usDVISSPercentage);
  672. rate = le16_to_cpu(igp_info->info_7.usDVISSpreadRateIn10Hz);
  673. break;
  674. case ASIC_INTERNAL_SS_ON_HDMI:
  675. percentage = le16_to_cpu(igp_info->info_7.usHDMISSPercentage);
  676. rate = le16_to_cpu(igp_info->info_7.usHDMISSpreadRateIn10Hz);
  677. break;
  678. case ASIC_INTERNAL_SS_ON_LVDS:
  679. percentage = le16_to_cpu(igp_info->info_7.usLvdsSSPercentage);
  680. rate = le16_to_cpu(igp_info->info_7.usLvdsSSpreadRateIn10Hz);
  681. break;
  682. }
  683. break;
  684. case 8:
  685. switch (id) {
  686. case ASIC_INTERNAL_SS_ON_TMDS:
  687. percentage = le16_to_cpu(igp_info->info_8.usDVISSPercentage);
  688. rate = le16_to_cpu(igp_info->info_8.usDVISSpreadRateIn10Hz);
  689. break;
  690. case ASIC_INTERNAL_SS_ON_HDMI:
  691. percentage = le16_to_cpu(igp_info->info_8.usHDMISSPercentage);
  692. rate = le16_to_cpu(igp_info->info_8.usHDMISSpreadRateIn10Hz);
  693. break;
  694. case ASIC_INTERNAL_SS_ON_LVDS:
  695. percentage = le16_to_cpu(igp_info->info_8.usLvdsSSPercentage);
  696. rate = le16_to_cpu(igp_info->info_8.usLvdsSSpreadRateIn10Hz);
  697. break;
  698. }
  699. break;
  700. case 9:
  701. switch (id) {
  702. case ASIC_INTERNAL_SS_ON_TMDS:
  703. percentage = le16_to_cpu(igp_info->info_9.usDVISSPercentage);
  704. rate = le16_to_cpu(igp_info->info_9.usDVISSpreadRateIn10Hz);
  705. break;
  706. case ASIC_INTERNAL_SS_ON_HDMI:
  707. percentage = le16_to_cpu(igp_info->info_9.usHDMISSPercentage);
  708. rate = le16_to_cpu(igp_info->info_9.usHDMISSpreadRateIn10Hz);
  709. break;
  710. case ASIC_INTERNAL_SS_ON_LVDS:
  711. percentage = le16_to_cpu(igp_info->info_9.usLvdsSSPercentage);
  712. rate = le16_to_cpu(igp_info->info_9.usLvdsSSpreadRateIn10Hz);
  713. break;
  714. }
  715. break;
  716. default:
  717. DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
  718. break;
  719. }
  720. if (percentage)
  721. ss->percentage = percentage;
  722. if (rate)
  723. ss->rate = rate;
  724. }
  725. }
  726. union asic_ss_info {
  727. struct _ATOM_ASIC_INTERNAL_SS_INFO info;
  728. struct _ATOM_ASIC_INTERNAL_SS_INFO_V2 info_2;
  729. struct _ATOM_ASIC_INTERNAL_SS_INFO_V3 info_3;
  730. };
  731. union asic_ss_assignment {
  732. struct _ATOM_ASIC_SS_ASSIGNMENT v1;
  733. struct _ATOM_ASIC_SS_ASSIGNMENT_V2 v2;
  734. struct _ATOM_ASIC_SS_ASSIGNMENT_V3 v3;
  735. };
  736. bool amdgpu_atombios_get_asic_ss_info(struct amdgpu_device *adev,
  737. struct amdgpu_atom_ss *ss,
  738. int id, u32 clock)
  739. {
  740. struct amdgpu_mode_info *mode_info = &adev->mode_info;
  741. int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
  742. uint16_t data_offset, size;
  743. union asic_ss_info *ss_info;
  744. union asic_ss_assignment *ss_assign;
  745. uint8_t frev, crev;
  746. int i, num_indices;
  747. if (id == ASIC_INTERNAL_MEMORY_SS) {
  748. if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_MEMORY_CLOCK_SS_SUPPORT))
  749. return false;
  750. }
  751. if (id == ASIC_INTERNAL_ENGINE_SS) {
  752. if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_ENGINE_CLOCK_SS_SUPPORT))
  753. return false;
  754. }
  755. memset(ss, 0, sizeof(struct amdgpu_atom_ss));
  756. if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
  757. &frev, &crev, &data_offset)) {
  758. ss_info =
  759. (union asic_ss_info *)(mode_info->atom_context->bios + data_offset);
  760. switch (frev) {
  761. case 1:
  762. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  763. sizeof(ATOM_ASIC_SS_ASSIGNMENT);
  764. ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info.asSpreadSpectrum[0]);
  765. for (i = 0; i < num_indices; i++) {
  766. if ((ss_assign->v1.ucClockIndication == id) &&
  767. (clock <= le32_to_cpu(ss_assign->v1.ulTargetClockRange))) {
  768. ss->percentage =
  769. le16_to_cpu(ss_assign->v1.usSpreadSpectrumPercentage);
  770. ss->type = ss_assign->v1.ucSpreadSpectrumMode;
  771. ss->rate = le16_to_cpu(ss_assign->v1.usSpreadRateInKhz);
  772. ss->percentage_divider = 100;
  773. return true;
  774. }
  775. ss_assign = (union asic_ss_assignment *)
  776. ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT));
  777. }
  778. break;
  779. case 2:
  780. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  781. sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2);
  782. ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_2.asSpreadSpectrum[0]);
  783. for (i = 0; i < num_indices; i++) {
  784. if ((ss_assign->v2.ucClockIndication == id) &&
  785. (clock <= le32_to_cpu(ss_assign->v2.ulTargetClockRange))) {
  786. ss->percentage =
  787. le16_to_cpu(ss_assign->v2.usSpreadSpectrumPercentage);
  788. ss->type = ss_assign->v2.ucSpreadSpectrumMode;
  789. ss->rate = le16_to_cpu(ss_assign->v2.usSpreadRateIn10Hz);
  790. ss->percentage_divider = 100;
  791. if ((crev == 2) &&
  792. ((id == ASIC_INTERNAL_ENGINE_SS) ||
  793. (id == ASIC_INTERNAL_MEMORY_SS)))
  794. ss->rate /= 100;
  795. return true;
  796. }
  797. ss_assign = (union asic_ss_assignment *)
  798. ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2));
  799. }
  800. break;
  801. case 3:
  802. num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
  803. sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3);
  804. ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_3.asSpreadSpectrum[0]);
  805. for (i = 0; i < num_indices; i++) {
  806. if ((ss_assign->v3.ucClockIndication == id) &&
  807. (clock <= le32_to_cpu(ss_assign->v3.ulTargetClockRange))) {
  808. ss->percentage =
  809. le16_to_cpu(ss_assign->v3.usSpreadSpectrumPercentage);
  810. ss->type = ss_assign->v3.ucSpreadSpectrumMode;
  811. ss->rate = le16_to_cpu(ss_assign->v3.usSpreadRateIn10Hz);
  812. if (ss_assign->v3.ucSpreadSpectrumMode &
  813. SS_MODE_V3_PERCENTAGE_DIV_BY_1000_MASK)
  814. ss->percentage_divider = 1000;
  815. else
  816. ss->percentage_divider = 100;
  817. if ((id == ASIC_INTERNAL_ENGINE_SS) ||
  818. (id == ASIC_INTERNAL_MEMORY_SS))
  819. ss->rate /= 100;
  820. if (adev->flags & AMD_IS_APU)
  821. amdgpu_atombios_get_igp_ss_overrides(adev, ss, id);
  822. return true;
  823. }
  824. ss_assign = (union asic_ss_assignment *)
  825. ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3));
  826. }
  827. break;
  828. default:
  829. DRM_ERROR("Unsupported ASIC_InternalSS_Info table: %d %d\n", frev, crev);
  830. break;
  831. }
  832. }
  833. return false;
  834. }
  835. union get_clock_dividers {
  836. struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS v1;
  837. struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V2 v2;
  838. struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V3 v3;
  839. struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V4 v4;
  840. struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V5 v5;
  841. struct _COMPUTE_GPU_CLOCK_INPUT_PARAMETERS_V1_6 v6_in;
  842. struct _COMPUTE_GPU_CLOCK_OUTPUT_PARAMETERS_V1_6 v6_out;
  843. };
  844. int amdgpu_atombios_get_clock_dividers(struct amdgpu_device *adev,
  845. u8 clock_type,
  846. u32 clock,
  847. bool strobe_mode,
  848. struct atom_clock_dividers *dividers)
  849. {
  850. union get_clock_dividers args;
  851. int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryEnginePLL);
  852. u8 frev, crev;
  853. memset(&args, 0, sizeof(args));
  854. memset(dividers, 0, sizeof(struct atom_clock_dividers));
  855. if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
  856. return -EINVAL;
  857. switch (crev) {
  858. case 4:
  859. /* fusion */
  860. args.v4.ulClock = cpu_to_le32(clock); /* 10 khz */
  861. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  862. dividers->post_divider = dividers->post_div = args.v4.ucPostDiv;
  863. dividers->real_clock = le32_to_cpu(args.v4.ulClock);
  864. break;
  865. case 6:
  866. /* CI */
  867. /* COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK, COMPUTE_GPUCLK_INPUT_FLAG_SCLK */
  868. args.v6_in.ulClock.ulComputeClockFlag = clock_type;
  869. args.v6_in.ulClock.ulClockFreq = cpu_to_le32(clock); /* 10 khz */
  870. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  871. dividers->whole_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDiv);
  872. dividers->frac_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDivFrac);
  873. dividers->ref_div = args.v6_out.ucPllRefDiv;
  874. dividers->post_div = args.v6_out.ucPllPostDiv;
  875. dividers->flags = args.v6_out.ucPllCntlFlag;
  876. dividers->real_clock = le32_to_cpu(args.v6_out.ulClock.ulClock);
  877. dividers->post_divider = args.v6_out.ulClock.ucPostDiv;
  878. break;
  879. default:
  880. return -EINVAL;
  881. }
  882. return 0;
  883. }
  884. int amdgpu_atombios_get_memory_pll_dividers(struct amdgpu_device *adev,
  885. u32 clock,
  886. bool strobe_mode,
  887. struct atom_mpll_param *mpll_param)
  888. {
  889. COMPUTE_MEMORY_CLOCK_PARAM_PARAMETERS_V2_1 args;
  890. int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryClockParam);
  891. u8 frev, crev;
  892. memset(&args, 0, sizeof(args));
  893. memset(mpll_param, 0, sizeof(struct atom_mpll_param));
  894. if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
  895. return -EINVAL;
  896. switch (frev) {
  897. case 2:
  898. switch (crev) {
  899. case 1:
  900. /* SI */
  901. args.ulClock = cpu_to_le32(clock); /* 10 khz */
  902. args.ucInputFlag = 0;
  903. if (strobe_mode)
  904. args.ucInputFlag |= MPLL_INPUT_FLAG_STROBE_MODE_EN;
  905. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  906. mpll_param->clkfrac = le16_to_cpu(args.ulFbDiv.usFbDivFrac);
  907. mpll_param->clkf = le16_to_cpu(args.ulFbDiv.usFbDiv);
  908. mpll_param->post_div = args.ucPostDiv;
  909. mpll_param->dll_speed = args.ucDllSpeed;
  910. mpll_param->bwcntl = args.ucBWCntl;
  911. mpll_param->vco_mode =
  912. (args.ucPllCntlFlag & MPLL_CNTL_FLAG_VCO_MODE_MASK);
  913. mpll_param->yclk_sel =
  914. (args.ucPllCntlFlag & MPLL_CNTL_FLAG_BYPASS_DQ_PLL) ? 1 : 0;
  915. mpll_param->qdr =
  916. (args.ucPllCntlFlag & MPLL_CNTL_FLAG_QDR_ENABLE) ? 1 : 0;
  917. mpll_param->half_rate =
  918. (args.ucPllCntlFlag & MPLL_CNTL_FLAG_AD_HALF_RATE) ? 1 : 0;
  919. break;
  920. default:
  921. return -EINVAL;
  922. }
  923. break;
  924. default:
  925. return -EINVAL;
  926. }
  927. return 0;
  928. }
  929. uint32_t amdgpu_atombios_get_engine_clock(struct amdgpu_device *adev)
  930. {
  931. GET_ENGINE_CLOCK_PS_ALLOCATION args;
  932. int index = GetIndexIntoMasterTable(COMMAND, GetEngineClock);
  933. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  934. return le32_to_cpu(args.ulReturnEngineClock);
  935. }
  936. uint32_t amdgpu_atombios_get_memory_clock(struct amdgpu_device *adev)
  937. {
  938. GET_MEMORY_CLOCK_PS_ALLOCATION args;
  939. int index = GetIndexIntoMasterTable(COMMAND, GetMemoryClock);
  940. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  941. return le32_to_cpu(args.ulReturnMemoryClock);
  942. }
  943. void amdgpu_atombios_set_engine_clock(struct amdgpu_device *adev,
  944. uint32_t eng_clock)
  945. {
  946. SET_ENGINE_CLOCK_PS_ALLOCATION args;
  947. int index = GetIndexIntoMasterTable(COMMAND, SetEngineClock);
  948. args.ulTargetEngineClock = cpu_to_le32(eng_clock); /* 10 khz */
  949. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  950. }
  951. void amdgpu_atombios_set_memory_clock(struct amdgpu_device *adev,
  952. uint32_t mem_clock)
  953. {
  954. SET_MEMORY_CLOCK_PS_ALLOCATION args;
  955. int index = GetIndexIntoMasterTable(COMMAND, SetMemoryClock);
  956. if (adev->flags & AMD_IS_APU)
  957. return;
  958. args.ulTargetMemoryClock = cpu_to_le32(mem_clock); /* 10 khz */
  959. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  960. }
  961. void amdgpu_atombios_set_engine_dram_timings(struct amdgpu_device *adev,
  962. u32 eng_clock, u32 mem_clock)
  963. {
  964. SET_ENGINE_CLOCK_PS_ALLOCATION args;
  965. int index = GetIndexIntoMasterTable(COMMAND, DynamicMemorySettings);
  966. u32 tmp;
  967. memset(&args, 0, sizeof(args));
  968. tmp = eng_clock & SET_CLOCK_FREQ_MASK;
  969. tmp |= (COMPUTE_ENGINE_PLL_PARAM << 24);
  970. args.ulTargetEngineClock = cpu_to_le32(tmp);
  971. if (mem_clock)
  972. args.sReserved.ulClock = cpu_to_le32(mem_clock & SET_CLOCK_FREQ_MASK);
  973. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  974. }
  975. union set_voltage {
  976. struct _SET_VOLTAGE_PS_ALLOCATION alloc;
  977. struct _SET_VOLTAGE_PARAMETERS v1;
  978. struct _SET_VOLTAGE_PARAMETERS_V2 v2;
  979. struct _SET_VOLTAGE_PARAMETERS_V1_3 v3;
  980. };
  981. void amdgpu_atombios_set_voltage(struct amdgpu_device *adev,
  982. u16 voltage_level,
  983. u8 voltage_type)
  984. {
  985. union set_voltage args;
  986. int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
  987. u8 frev, crev, volt_index = voltage_level;
  988. if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
  989. return;
  990. /* 0xff01 is a flag rather then an actual voltage */
  991. if (voltage_level == 0xff01)
  992. return;
  993. switch (crev) {
  994. case 1:
  995. args.v1.ucVoltageType = voltage_type;
  996. args.v1.ucVoltageMode = SET_ASIC_VOLTAGE_MODE_ALL_SOURCE;
  997. args.v1.ucVoltageIndex = volt_index;
  998. break;
  999. case 2:
  1000. args.v2.ucVoltageType = voltage_type;
  1001. args.v2.ucVoltageMode = SET_ASIC_VOLTAGE_MODE_SET_VOLTAGE;
  1002. args.v2.usVoltageLevel = cpu_to_le16(voltage_level);
  1003. break;
  1004. case 3:
  1005. args.v3.ucVoltageType = voltage_type;
  1006. args.v3.ucVoltageMode = ATOM_SET_VOLTAGE;
  1007. args.v3.usVoltageLevel = cpu_to_le16(voltage_level);
  1008. break;
  1009. default:
  1010. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1011. return;
  1012. }
  1013. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  1014. }
  1015. int amdgpu_atombios_get_leakage_id_from_vbios(struct amdgpu_device *adev,
  1016. u16 *leakage_id)
  1017. {
  1018. union set_voltage args;
  1019. int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
  1020. u8 frev, crev;
  1021. if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
  1022. return -EINVAL;
  1023. switch (crev) {
  1024. case 3:
  1025. case 4:
  1026. args.v3.ucVoltageType = 0;
  1027. args.v3.ucVoltageMode = ATOM_GET_LEAKAGE_ID;
  1028. args.v3.usVoltageLevel = 0;
  1029. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  1030. *leakage_id = le16_to_cpu(args.v3.usVoltageLevel);
  1031. break;
  1032. default:
  1033. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1034. return -EINVAL;
  1035. }
  1036. return 0;
  1037. }
  1038. int amdgpu_atombios_get_leakage_vddc_based_on_leakage_params(struct amdgpu_device *adev,
  1039. u16 *vddc, u16 *vddci,
  1040. u16 virtual_voltage_id,
  1041. u16 vbios_voltage_id)
  1042. {
  1043. int index = GetIndexIntoMasterTable(DATA, ASIC_ProfilingInfo);
  1044. u8 frev, crev;
  1045. u16 data_offset, size;
  1046. int i, j;
  1047. ATOM_ASIC_PROFILING_INFO_V2_1 *profile;
  1048. u16 *leakage_bin, *vddc_id_buf, *vddc_buf, *vddci_id_buf, *vddci_buf;
  1049. *vddc = 0;
  1050. *vddci = 0;
  1051. if (!amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
  1052. &frev, &crev, &data_offset))
  1053. return -EINVAL;
  1054. profile = (ATOM_ASIC_PROFILING_INFO_V2_1 *)
  1055. (adev->mode_info.atom_context->bios + data_offset);
  1056. switch (frev) {
  1057. case 1:
  1058. return -EINVAL;
  1059. case 2:
  1060. switch (crev) {
  1061. case 1:
  1062. if (size < sizeof(ATOM_ASIC_PROFILING_INFO_V2_1))
  1063. return -EINVAL;
  1064. leakage_bin = (u16 *)
  1065. (adev->mode_info.atom_context->bios + data_offset +
  1066. le16_to_cpu(profile->usLeakageBinArrayOffset));
  1067. vddc_id_buf = (u16 *)
  1068. (adev->mode_info.atom_context->bios + data_offset +
  1069. le16_to_cpu(profile->usElbVDDC_IdArrayOffset));
  1070. vddc_buf = (u16 *)
  1071. (adev->mode_info.atom_context->bios + data_offset +
  1072. le16_to_cpu(profile->usElbVDDC_LevelArrayOffset));
  1073. vddci_id_buf = (u16 *)
  1074. (adev->mode_info.atom_context->bios + data_offset +
  1075. le16_to_cpu(profile->usElbVDDCI_IdArrayOffset));
  1076. vddci_buf = (u16 *)
  1077. (adev->mode_info.atom_context->bios + data_offset +
  1078. le16_to_cpu(profile->usElbVDDCI_LevelArrayOffset));
  1079. if (profile->ucElbVDDC_Num > 0) {
  1080. for (i = 0; i < profile->ucElbVDDC_Num; i++) {
  1081. if (vddc_id_buf[i] == virtual_voltage_id) {
  1082. for (j = 0; j < profile->ucLeakageBinNum; j++) {
  1083. if (vbios_voltage_id <= leakage_bin[j]) {
  1084. *vddc = vddc_buf[j * profile->ucElbVDDC_Num + i];
  1085. break;
  1086. }
  1087. }
  1088. break;
  1089. }
  1090. }
  1091. }
  1092. if (profile->ucElbVDDCI_Num > 0) {
  1093. for (i = 0; i < profile->ucElbVDDCI_Num; i++) {
  1094. if (vddci_id_buf[i] == virtual_voltage_id) {
  1095. for (j = 0; j < profile->ucLeakageBinNum; j++) {
  1096. if (vbios_voltage_id <= leakage_bin[j]) {
  1097. *vddci = vddci_buf[j * profile->ucElbVDDCI_Num + i];
  1098. break;
  1099. }
  1100. }
  1101. break;
  1102. }
  1103. }
  1104. }
  1105. break;
  1106. default:
  1107. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1108. return -EINVAL;
  1109. }
  1110. break;
  1111. default:
  1112. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1113. return -EINVAL;
  1114. }
  1115. return 0;
  1116. }
  1117. union get_voltage_info {
  1118. struct _GET_VOLTAGE_INFO_INPUT_PARAMETER_V1_2 in;
  1119. struct _GET_EVV_VOLTAGE_INFO_OUTPUT_PARAMETER_V1_2 evv_out;
  1120. };
  1121. int amdgpu_atombios_get_voltage_evv(struct amdgpu_device *adev,
  1122. u16 virtual_voltage_id,
  1123. u16 *voltage)
  1124. {
  1125. int index = GetIndexIntoMasterTable(COMMAND, GetVoltageInfo);
  1126. u32 entry_id;
  1127. u32 count = adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count;
  1128. union get_voltage_info args;
  1129. for (entry_id = 0; entry_id < count; entry_id++) {
  1130. if (adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[entry_id].v ==
  1131. virtual_voltage_id)
  1132. break;
  1133. }
  1134. if (entry_id >= count)
  1135. return -EINVAL;
  1136. args.in.ucVoltageType = VOLTAGE_TYPE_VDDC;
  1137. args.in.ucVoltageMode = ATOM_GET_VOLTAGE_EVV_VOLTAGE;
  1138. args.in.usVoltageLevel = cpu_to_le16(virtual_voltage_id);
  1139. args.in.ulSCLKFreq =
  1140. cpu_to_le32(adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[entry_id].clk);
  1141. amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
  1142. *voltage = le16_to_cpu(args.evv_out.usVoltageLevel);
  1143. return 0;
  1144. }
  1145. union voltage_object_info {
  1146. struct _ATOM_VOLTAGE_OBJECT_INFO v1;
  1147. struct _ATOM_VOLTAGE_OBJECT_INFO_V2 v2;
  1148. struct _ATOM_VOLTAGE_OBJECT_INFO_V3_1 v3;
  1149. };
  1150. union voltage_object {
  1151. struct _ATOM_VOLTAGE_OBJECT v1;
  1152. struct _ATOM_VOLTAGE_OBJECT_V2 v2;
  1153. union _ATOM_VOLTAGE_OBJECT_V3 v3;
  1154. };
  1155. static ATOM_VOLTAGE_OBJECT_V3 *amdgpu_atombios_lookup_voltage_object_v3(ATOM_VOLTAGE_OBJECT_INFO_V3_1 *v3,
  1156. u8 voltage_type, u8 voltage_mode)
  1157. {
  1158. u32 size = le16_to_cpu(v3->sHeader.usStructureSize);
  1159. u32 offset = offsetof(ATOM_VOLTAGE_OBJECT_INFO_V3_1, asVoltageObj[0]);
  1160. u8 *start = (u8*)v3;
  1161. while (offset < size) {
  1162. ATOM_VOLTAGE_OBJECT_V3 *vo = (ATOM_VOLTAGE_OBJECT_V3 *)(start + offset);
  1163. if ((vo->asGpioVoltageObj.sHeader.ucVoltageType == voltage_type) &&
  1164. (vo->asGpioVoltageObj.sHeader.ucVoltageMode == voltage_mode))
  1165. return vo;
  1166. offset += le16_to_cpu(vo->asGpioVoltageObj.sHeader.usSize);
  1167. }
  1168. return NULL;
  1169. }
  1170. bool
  1171. amdgpu_atombios_is_voltage_gpio(struct amdgpu_device *adev,
  1172. u8 voltage_type, u8 voltage_mode)
  1173. {
  1174. int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
  1175. u8 frev, crev;
  1176. u16 data_offset, size;
  1177. union voltage_object_info *voltage_info;
  1178. if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
  1179. &frev, &crev, &data_offset)) {
  1180. voltage_info = (union voltage_object_info *)
  1181. (adev->mode_info.atom_context->bios + data_offset);
  1182. switch (frev) {
  1183. case 3:
  1184. switch (crev) {
  1185. case 1:
  1186. if (amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
  1187. voltage_type, voltage_mode))
  1188. return true;
  1189. break;
  1190. default:
  1191. DRM_ERROR("unknown voltage object table\n");
  1192. return false;
  1193. }
  1194. break;
  1195. default:
  1196. DRM_ERROR("unknown voltage object table\n");
  1197. return false;
  1198. }
  1199. }
  1200. return false;
  1201. }
  1202. int amdgpu_atombios_get_voltage_table(struct amdgpu_device *adev,
  1203. u8 voltage_type, u8 voltage_mode,
  1204. struct atom_voltage_table *voltage_table)
  1205. {
  1206. int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
  1207. u8 frev, crev;
  1208. u16 data_offset, size;
  1209. int i;
  1210. union voltage_object_info *voltage_info;
  1211. union voltage_object *voltage_object = NULL;
  1212. if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
  1213. &frev, &crev, &data_offset)) {
  1214. voltage_info = (union voltage_object_info *)
  1215. (adev->mode_info.atom_context->bios + data_offset);
  1216. switch (frev) {
  1217. case 3:
  1218. switch (crev) {
  1219. case 1:
  1220. voltage_object = (union voltage_object *)
  1221. amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
  1222. voltage_type, voltage_mode);
  1223. if (voltage_object) {
  1224. ATOM_GPIO_VOLTAGE_OBJECT_V3 *gpio =
  1225. &voltage_object->v3.asGpioVoltageObj;
  1226. VOLTAGE_LUT_ENTRY_V2 *lut;
  1227. if (gpio->ucGpioEntryNum > MAX_VOLTAGE_ENTRIES)
  1228. return -EINVAL;
  1229. lut = &gpio->asVolGpioLut[0];
  1230. for (i = 0; i < gpio->ucGpioEntryNum; i++) {
  1231. voltage_table->entries[i].value =
  1232. le16_to_cpu(lut->usVoltageValue);
  1233. voltage_table->entries[i].smio_low =
  1234. le32_to_cpu(lut->ulVoltageId);
  1235. lut = (VOLTAGE_LUT_ENTRY_V2 *)
  1236. ((u8 *)lut + sizeof(VOLTAGE_LUT_ENTRY_V2));
  1237. }
  1238. voltage_table->mask_low = le32_to_cpu(gpio->ulGpioMaskVal);
  1239. voltage_table->count = gpio->ucGpioEntryNum;
  1240. voltage_table->phase_delay = gpio->ucPhaseDelay;
  1241. return 0;
  1242. }
  1243. break;
  1244. default:
  1245. DRM_ERROR("unknown voltage object table\n");
  1246. return -EINVAL;
  1247. }
  1248. break;
  1249. default:
  1250. DRM_ERROR("unknown voltage object table\n");
  1251. return -EINVAL;
  1252. }
  1253. }
  1254. return -EINVAL;
  1255. }
  1256. union vram_info {
  1257. struct _ATOM_VRAM_INFO_V3 v1_3;
  1258. struct _ATOM_VRAM_INFO_V4 v1_4;
  1259. struct _ATOM_VRAM_INFO_HEADER_V2_1 v2_1;
  1260. };
  1261. #define MEM_ID_MASK 0xff000000
  1262. #define MEM_ID_SHIFT 24
  1263. #define CLOCK_RANGE_MASK 0x00ffffff
  1264. #define CLOCK_RANGE_SHIFT 0
  1265. #define LOW_NIBBLE_MASK 0xf
  1266. #define DATA_EQU_PREV 0
  1267. #define DATA_FROM_TABLE 4
  1268. int amdgpu_atombios_init_mc_reg_table(struct amdgpu_device *adev,
  1269. u8 module_index,
  1270. struct atom_mc_reg_table *reg_table)
  1271. {
  1272. int index = GetIndexIntoMasterTable(DATA, VRAM_Info);
  1273. u8 frev, crev, num_entries, t_mem_id, num_ranges = 0;
  1274. u32 i = 0, j;
  1275. u16 data_offset, size;
  1276. union vram_info *vram_info;
  1277. memset(reg_table, 0, sizeof(struct atom_mc_reg_table));
  1278. if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
  1279. &frev, &crev, &data_offset)) {
  1280. vram_info = (union vram_info *)
  1281. (adev->mode_info.atom_context->bios + data_offset);
  1282. switch (frev) {
  1283. case 1:
  1284. DRM_ERROR("old table version %d, %d\n", frev, crev);
  1285. return -EINVAL;
  1286. case 2:
  1287. switch (crev) {
  1288. case 1:
  1289. if (module_index < vram_info->v2_1.ucNumOfVRAMModule) {
  1290. ATOM_INIT_REG_BLOCK *reg_block =
  1291. (ATOM_INIT_REG_BLOCK *)
  1292. ((u8 *)vram_info + le16_to_cpu(vram_info->v2_1.usMemClkPatchTblOffset));
  1293. ATOM_MEMORY_SETTING_DATA_BLOCK *reg_data =
  1294. (ATOM_MEMORY_SETTING_DATA_BLOCK *)
  1295. ((u8 *)reg_block + (2 * sizeof(u16)) +
  1296. le16_to_cpu(reg_block->usRegIndexTblSize));
  1297. ATOM_INIT_REG_INDEX_FORMAT *format = &reg_block->asRegIndexBuf[0];
  1298. num_entries = (u8)((le16_to_cpu(reg_block->usRegIndexTblSize)) /
  1299. sizeof(ATOM_INIT_REG_INDEX_FORMAT)) - 1;
  1300. if (num_entries > VBIOS_MC_REGISTER_ARRAY_SIZE)
  1301. return -EINVAL;
  1302. while (i < num_entries) {
  1303. if (format->ucPreRegDataLength & ACCESS_PLACEHOLDER)
  1304. break;
  1305. reg_table->mc_reg_address[i].s1 =
  1306. (u16)(le16_to_cpu(format->usRegIndex));
  1307. reg_table->mc_reg_address[i].pre_reg_data =
  1308. (u8)(format->ucPreRegDataLength);
  1309. i++;
  1310. format = (ATOM_INIT_REG_INDEX_FORMAT *)
  1311. ((u8 *)format + sizeof(ATOM_INIT_REG_INDEX_FORMAT));
  1312. }
  1313. reg_table->last = i;
  1314. while ((le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK) &&
  1315. (num_ranges < VBIOS_MAX_AC_TIMING_ENTRIES)) {
  1316. t_mem_id = (u8)((le32_to_cpu(*(u32 *)reg_data) & MEM_ID_MASK)
  1317. >> MEM_ID_SHIFT);
  1318. if (module_index == t_mem_id) {
  1319. reg_table->mc_reg_table_entry[num_ranges].mclk_max =
  1320. (u32)((le32_to_cpu(*(u32 *)reg_data) & CLOCK_RANGE_MASK)
  1321. >> CLOCK_RANGE_SHIFT);
  1322. for (i = 0, j = 1; i < reg_table->last; i++) {
  1323. if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_FROM_TABLE) {
  1324. reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
  1325. (u32)le32_to_cpu(*((u32 *)reg_data + j));
  1326. j++;
  1327. } else if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_EQU_PREV) {
  1328. reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
  1329. reg_table->mc_reg_table_entry[num_ranges].mc_data[i - 1];
  1330. }
  1331. }
  1332. num_ranges++;
  1333. }
  1334. reg_data = (ATOM_MEMORY_SETTING_DATA_BLOCK *)
  1335. ((u8 *)reg_data + le16_to_cpu(reg_block->usRegDataBlkSize));
  1336. }
  1337. if (le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK)
  1338. return -EINVAL;
  1339. reg_table->num_entries = num_ranges;
  1340. } else
  1341. return -EINVAL;
  1342. break;
  1343. default:
  1344. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1345. return -EINVAL;
  1346. }
  1347. break;
  1348. default:
  1349. DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
  1350. return -EINVAL;
  1351. }
  1352. return 0;
  1353. }
  1354. return -EINVAL;
  1355. }
  1356. bool amdgpu_atombios_has_gpu_virtualization_table(struct amdgpu_device *adev)
  1357. {
  1358. int index = GetIndexIntoMasterTable(DATA, GPUVirtualizationInfo);
  1359. u8 frev, crev;
  1360. u16 data_offset, size;
  1361. if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
  1362. &frev, &crev, &data_offset))
  1363. return true;
  1364. return false;
  1365. }
  1366. void amdgpu_atombios_scratch_regs_lock(struct amdgpu_device *adev, bool lock)
  1367. {
  1368. uint32_t bios_6_scratch;
  1369. bios_6_scratch = RREG32(mmBIOS_SCRATCH_6);
  1370. if (lock) {
  1371. bios_6_scratch |= ATOM_S6_CRITICAL_STATE;
  1372. bios_6_scratch &= ~ATOM_S6_ACC_MODE;
  1373. } else {
  1374. bios_6_scratch &= ~ATOM_S6_CRITICAL_STATE;
  1375. bios_6_scratch |= ATOM_S6_ACC_MODE;
  1376. }
  1377. WREG32(mmBIOS_SCRATCH_6, bios_6_scratch);
  1378. }
  1379. void amdgpu_atombios_scratch_regs_init(struct amdgpu_device *adev)
  1380. {
  1381. uint32_t bios_2_scratch, bios_6_scratch;
  1382. bios_2_scratch = RREG32(mmBIOS_SCRATCH_2);
  1383. bios_6_scratch = RREG32(mmBIOS_SCRATCH_6);
  1384. /* let the bios control the backlight */
  1385. bios_2_scratch &= ~ATOM_S2_VRI_BRIGHT_ENABLE;
  1386. /* tell the bios not to handle mode switching */
  1387. bios_6_scratch |= ATOM_S6_ACC_BLOCK_DISPLAY_SWITCH;
  1388. /* clear the vbios dpms state */
  1389. bios_2_scratch &= ~ATOM_S2_DEVICE_DPMS_STATE;
  1390. WREG32(mmBIOS_SCRATCH_2, bios_2_scratch);
  1391. WREG32(mmBIOS_SCRATCH_6, bios_6_scratch);
  1392. }
  1393. void amdgpu_atombios_scratch_regs_save(struct amdgpu_device *adev)
  1394. {
  1395. int i;
  1396. for (i = 0; i < AMDGPU_BIOS_NUM_SCRATCH; i++)
  1397. adev->bios_scratch[i] = RREG32(mmBIOS_SCRATCH_0 + i);
  1398. }
  1399. void amdgpu_atombios_scratch_regs_restore(struct amdgpu_device *adev)
  1400. {
  1401. int i;
  1402. for (i = 0; i < AMDGPU_BIOS_NUM_SCRATCH; i++)
  1403. WREG32(mmBIOS_SCRATCH_0 + i, adev->bios_scratch[i]);
  1404. }
  1405. /* Atom needs data in little endian format
  1406. * so swap as appropriate when copying data to
  1407. * or from atom. Note that atom operates on
  1408. * dw units.
  1409. */
  1410. void amdgpu_atombios_copy_swap(u8 *dst, u8 *src, u8 num_bytes, bool to_le)
  1411. {
  1412. #ifdef __BIG_ENDIAN
  1413. u8 src_tmp[20], dst_tmp[20]; /* used for byteswapping */
  1414. u32 *dst32, *src32;
  1415. int i;
  1416. memcpy(src_tmp, src, num_bytes);
  1417. src32 = (u32 *)src_tmp;
  1418. dst32 = (u32 *)dst_tmp;
  1419. if (to_le) {
  1420. for (i = 0; i < ((num_bytes + 3) / 4); i++)
  1421. dst32[i] = cpu_to_le32(src32[i]);
  1422. memcpy(dst, dst_tmp, num_bytes);
  1423. } else {
  1424. u8 dws = num_bytes & ~3;
  1425. for (i = 0; i < ((num_bytes + 3) / 4); i++)
  1426. dst32[i] = le32_to_cpu(src32[i]);
  1427. memcpy(dst, dst_tmp, dws);
  1428. if (num_bytes % 4) {
  1429. for (i = 0; i < (num_bytes % 4); i++)
  1430. dst[dws+i] = dst_tmp[dws+i];
  1431. }
  1432. }
  1433. #else
  1434. memcpy(dst, src, num_bytes);
  1435. #endif
  1436. }