rv515.c 35 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103
  1. /*
  2. * Copyright 2008 Advanced Micro Devices, Inc.
  3. * Copyright 2008 Red Hat Inc.
  4. * Copyright 2009 Jerome Glisse.
  5. *
  6. * Permission is hereby granted, free of charge, to any person obtaining a
  7. * copy of this software and associated documentation files (the "Software"),
  8. * to deal in the Software without restriction, including without limitation
  9. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  10. * and/or sell copies of the Software, and to permit persons to whom the
  11. * Software is furnished to do so, subject to the following conditions:
  12. *
  13. * The above copyright notice and this permission notice shall be included in
  14. * all copies or substantial portions of the Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  20. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  21. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  22. * OTHER DEALINGS IN THE SOFTWARE.
  23. *
  24. * Authors: Dave Airlie
  25. * Alex Deucher
  26. * Jerome Glisse
  27. */
  28. #include <linux/seq_file.h>
  29. #include <linux/slab.h>
  30. #include "drmP.h"
  31. #include "rv515d.h"
  32. #include "radeon.h"
  33. #include "radeon_asic.h"
  34. #include "atom.h"
  35. #include "rv515_reg_safe.h"
  36. /* This files gather functions specifics to: rv515 */
  37. int rv515_debugfs_pipes_info_init(struct radeon_device *rdev);
  38. int rv515_debugfs_ga_info_init(struct radeon_device *rdev);
  39. void rv515_gpu_init(struct radeon_device *rdev);
  40. int rv515_mc_wait_for_idle(struct radeon_device *rdev);
  41. void rv515_debugfs(struct radeon_device *rdev)
  42. {
  43. if (r100_debugfs_rbbm_init(rdev)) {
  44. DRM_ERROR("Failed to register debugfs file for RBBM !\n");
  45. }
  46. if (rv515_debugfs_pipes_info_init(rdev)) {
  47. DRM_ERROR("Failed to register debugfs file for pipes !\n");
  48. }
  49. if (rv515_debugfs_ga_info_init(rdev)) {
  50. DRM_ERROR("Failed to register debugfs file for pipes !\n");
  51. }
  52. }
  53. void rv515_ring_start(struct radeon_device *rdev)
  54. {
  55. int r;
  56. r = radeon_ring_lock(rdev, 64);
  57. if (r) {
  58. return;
  59. }
  60. radeon_ring_write(rdev, PACKET0(ISYNC_CNTL, 0));
  61. radeon_ring_write(rdev,
  62. ISYNC_ANY2D_IDLE3D |
  63. ISYNC_ANY3D_IDLE2D |
  64. ISYNC_WAIT_IDLEGUI |
  65. ISYNC_CPSCRATCH_IDLEGUI);
  66. radeon_ring_write(rdev, PACKET0(WAIT_UNTIL, 0));
  67. radeon_ring_write(rdev, WAIT_2D_IDLECLEAN | WAIT_3D_IDLECLEAN);
  68. radeon_ring_write(rdev, PACKET0(0x170C, 0));
  69. radeon_ring_write(rdev, 1 << 31);
  70. radeon_ring_write(rdev, PACKET0(GB_SELECT, 0));
  71. radeon_ring_write(rdev, 0);
  72. radeon_ring_write(rdev, PACKET0(GB_ENABLE, 0));
  73. radeon_ring_write(rdev, 0);
  74. radeon_ring_write(rdev, PACKET0(0x42C8, 0));
  75. radeon_ring_write(rdev, (1 << rdev->num_gb_pipes) - 1);
  76. radeon_ring_write(rdev, PACKET0(VAP_INDEX_OFFSET, 0));
  77. radeon_ring_write(rdev, 0);
  78. radeon_ring_write(rdev, PACKET0(RB3D_DSTCACHE_CTLSTAT, 0));
  79. radeon_ring_write(rdev, RB3D_DC_FLUSH | RB3D_DC_FREE);
  80. radeon_ring_write(rdev, PACKET0(ZB_ZCACHE_CTLSTAT, 0));
  81. radeon_ring_write(rdev, ZC_FLUSH | ZC_FREE);
  82. radeon_ring_write(rdev, PACKET0(WAIT_UNTIL, 0));
  83. radeon_ring_write(rdev, WAIT_2D_IDLECLEAN | WAIT_3D_IDLECLEAN);
  84. radeon_ring_write(rdev, PACKET0(GB_AA_CONFIG, 0));
  85. radeon_ring_write(rdev, 0);
  86. radeon_ring_write(rdev, PACKET0(RB3D_DSTCACHE_CTLSTAT, 0));
  87. radeon_ring_write(rdev, RB3D_DC_FLUSH | RB3D_DC_FREE);
  88. radeon_ring_write(rdev, PACKET0(ZB_ZCACHE_CTLSTAT, 0));
  89. radeon_ring_write(rdev, ZC_FLUSH | ZC_FREE);
  90. radeon_ring_write(rdev, PACKET0(GB_MSPOS0, 0));
  91. radeon_ring_write(rdev,
  92. ((6 << MS_X0_SHIFT) |
  93. (6 << MS_Y0_SHIFT) |
  94. (6 << MS_X1_SHIFT) |
  95. (6 << MS_Y1_SHIFT) |
  96. (6 << MS_X2_SHIFT) |
  97. (6 << MS_Y2_SHIFT) |
  98. (6 << MSBD0_Y_SHIFT) |
  99. (6 << MSBD0_X_SHIFT)));
  100. radeon_ring_write(rdev, PACKET0(GB_MSPOS1, 0));
  101. radeon_ring_write(rdev,
  102. ((6 << MS_X3_SHIFT) |
  103. (6 << MS_Y3_SHIFT) |
  104. (6 << MS_X4_SHIFT) |
  105. (6 << MS_Y4_SHIFT) |
  106. (6 << MS_X5_SHIFT) |
  107. (6 << MS_Y5_SHIFT) |
  108. (6 << MSBD1_SHIFT)));
  109. radeon_ring_write(rdev, PACKET0(GA_ENHANCE, 0));
  110. radeon_ring_write(rdev, GA_DEADLOCK_CNTL | GA_FASTSYNC_CNTL);
  111. radeon_ring_write(rdev, PACKET0(GA_POLY_MODE, 0));
  112. radeon_ring_write(rdev, FRONT_PTYPE_TRIANGE | BACK_PTYPE_TRIANGE);
  113. radeon_ring_write(rdev, PACKET0(GA_ROUND_MODE, 0));
  114. radeon_ring_write(rdev, GEOMETRY_ROUND_NEAREST | COLOR_ROUND_NEAREST);
  115. radeon_ring_write(rdev, PACKET0(0x20C8, 0));
  116. radeon_ring_write(rdev, 0);
  117. radeon_ring_unlock_commit(rdev);
  118. }
  119. int rv515_mc_wait_for_idle(struct radeon_device *rdev)
  120. {
  121. unsigned i;
  122. uint32_t tmp;
  123. for (i = 0; i < rdev->usec_timeout; i++) {
  124. /* read MC_STATUS */
  125. tmp = RREG32_MC(MC_STATUS);
  126. if (tmp & MC_STATUS_IDLE) {
  127. return 0;
  128. }
  129. DRM_UDELAY(1);
  130. }
  131. return -1;
  132. }
  133. void rv515_vga_render_disable(struct radeon_device *rdev)
  134. {
  135. WREG32(R_000300_VGA_RENDER_CONTROL,
  136. RREG32(R_000300_VGA_RENDER_CONTROL) & C_000300_VGA_VSTATUS_CNTL);
  137. }
  138. void rv515_gpu_init(struct radeon_device *rdev)
  139. {
  140. unsigned pipe_select_current, gb_pipe_select, tmp;
  141. if (r100_gui_wait_for_idle(rdev)) {
  142. printk(KERN_WARNING "Failed to wait GUI idle while "
  143. "reseting GPU. Bad things might happen.\n");
  144. }
  145. rv515_vga_render_disable(rdev);
  146. r420_pipes_init(rdev);
  147. gb_pipe_select = RREG32(0x402C);
  148. tmp = RREG32(0x170C);
  149. pipe_select_current = (tmp >> 2) & 3;
  150. tmp = (1 << pipe_select_current) |
  151. (((gb_pipe_select >> 8) & 0xF) << 4);
  152. WREG32_PLL(0x000D, tmp);
  153. if (r100_gui_wait_for_idle(rdev)) {
  154. printk(KERN_WARNING "Failed to wait GUI idle while "
  155. "reseting GPU. Bad things might happen.\n");
  156. }
  157. if (rv515_mc_wait_for_idle(rdev)) {
  158. printk(KERN_WARNING "Failed to wait MC idle while "
  159. "programming pipes. Bad things might happen.\n");
  160. }
  161. }
  162. static void rv515_vram_get_type(struct radeon_device *rdev)
  163. {
  164. uint32_t tmp;
  165. rdev->mc.vram_width = 128;
  166. rdev->mc.vram_is_ddr = true;
  167. tmp = RREG32_MC(RV515_MC_CNTL) & MEM_NUM_CHANNELS_MASK;
  168. switch (tmp) {
  169. case 0:
  170. rdev->mc.vram_width = 64;
  171. break;
  172. case 1:
  173. rdev->mc.vram_width = 128;
  174. break;
  175. default:
  176. rdev->mc.vram_width = 128;
  177. break;
  178. }
  179. }
  180. void rv515_mc_init(struct radeon_device *rdev)
  181. {
  182. rv515_vram_get_type(rdev);
  183. r100_vram_init_sizes(rdev);
  184. radeon_vram_location(rdev, &rdev->mc, 0);
  185. if (!(rdev->flags & RADEON_IS_AGP))
  186. radeon_gtt_location(rdev, &rdev->mc);
  187. radeon_update_bandwidth_info(rdev);
  188. }
  189. uint32_t rv515_mc_rreg(struct radeon_device *rdev, uint32_t reg)
  190. {
  191. uint32_t r;
  192. WREG32(MC_IND_INDEX, 0x7f0000 | (reg & 0xffff));
  193. r = RREG32(MC_IND_DATA);
  194. WREG32(MC_IND_INDEX, 0);
  195. return r;
  196. }
  197. void rv515_mc_wreg(struct radeon_device *rdev, uint32_t reg, uint32_t v)
  198. {
  199. WREG32(MC_IND_INDEX, 0xff0000 | ((reg) & 0xffff));
  200. WREG32(MC_IND_DATA, (v));
  201. WREG32(MC_IND_INDEX, 0);
  202. }
  203. #if defined(CONFIG_DEBUG_FS)
  204. static int rv515_debugfs_pipes_info(struct seq_file *m, void *data)
  205. {
  206. struct drm_info_node *node = (struct drm_info_node *) m->private;
  207. struct drm_device *dev = node->minor->dev;
  208. struct radeon_device *rdev = dev->dev_private;
  209. uint32_t tmp;
  210. tmp = RREG32(GB_PIPE_SELECT);
  211. seq_printf(m, "GB_PIPE_SELECT 0x%08x\n", tmp);
  212. tmp = RREG32(SU_REG_DEST);
  213. seq_printf(m, "SU_REG_DEST 0x%08x\n", tmp);
  214. tmp = RREG32(GB_TILE_CONFIG);
  215. seq_printf(m, "GB_TILE_CONFIG 0x%08x\n", tmp);
  216. tmp = RREG32(DST_PIPE_CONFIG);
  217. seq_printf(m, "DST_PIPE_CONFIG 0x%08x\n", tmp);
  218. return 0;
  219. }
  220. static int rv515_debugfs_ga_info(struct seq_file *m, void *data)
  221. {
  222. struct drm_info_node *node = (struct drm_info_node *) m->private;
  223. struct drm_device *dev = node->minor->dev;
  224. struct radeon_device *rdev = dev->dev_private;
  225. uint32_t tmp;
  226. tmp = RREG32(0x2140);
  227. seq_printf(m, "VAP_CNTL_STATUS 0x%08x\n", tmp);
  228. radeon_asic_reset(rdev);
  229. tmp = RREG32(0x425C);
  230. seq_printf(m, "GA_IDLE 0x%08x\n", tmp);
  231. return 0;
  232. }
  233. static struct drm_info_list rv515_pipes_info_list[] = {
  234. {"rv515_pipes_info", rv515_debugfs_pipes_info, 0, NULL},
  235. };
  236. static struct drm_info_list rv515_ga_info_list[] = {
  237. {"rv515_ga_info", rv515_debugfs_ga_info, 0, NULL},
  238. };
  239. #endif
  240. int rv515_debugfs_pipes_info_init(struct radeon_device *rdev)
  241. {
  242. #if defined(CONFIG_DEBUG_FS)
  243. return radeon_debugfs_add_files(rdev, rv515_pipes_info_list, 1);
  244. #else
  245. return 0;
  246. #endif
  247. }
  248. int rv515_debugfs_ga_info_init(struct radeon_device *rdev)
  249. {
  250. #if defined(CONFIG_DEBUG_FS)
  251. return radeon_debugfs_add_files(rdev, rv515_ga_info_list, 1);
  252. #else
  253. return 0;
  254. #endif
  255. }
  256. void rv515_mc_stop(struct radeon_device *rdev, struct rv515_mc_save *save)
  257. {
  258. save->d1vga_control = RREG32(R_000330_D1VGA_CONTROL);
  259. save->d2vga_control = RREG32(R_000338_D2VGA_CONTROL);
  260. save->vga_render_control = RREG32(R_000300_VGA_RENDER_CONTROL);
  261. save->vga_hdp_control = RREG32(R_000328_VGA_HDP_CONTROL);
  262. save->d1crtc_control = RREG32(R_006080_D1CRTC_CONTROL);
  263. save->d2crtc_control = RREG32(R_006880_D2CRTC_CONTROL);
  264. /* Stop all video */
  265. WREG32(R_0068E8_D2CRTC_UPDATE_LOCK, 0);
  266. WREG32(R_000300_VGA_RENDER_CONTROL, 0);
  267. WREG32(R_0060E8_D1CRTC_UPDATE_LOCK, 1);
  268. WREG32(R_0068E8_D2CRTC_UPDATE_LOCK, 1);
  269. WREG32(R_006080_D1CRTC_CONTROL, 0);
  270. WREG32(R_006880_D2CRTC_CONTROL, 0);
  271. WREG32(R_0060E8_D1CRTC_UPDATE_LOCK, 0);
  272. WREG32(R_0068E8_D2CRTC_UPDATE_LOCK, 0);
  273. WREG32(R_000330_D1VGA_CONTROL, 0);
  274. WREG32(R_000338_D2VGA_CONTROL, 0);
  275. }
  276. void rv515_mc_resume(struct radeon_device *rdev, struct rv515_mc_save *save)
  277. {
  278. WREG32(R_006110_D1GRPH_PRIMARY_SURFACE_ADDRESS, rdev->mc.vram_start);
  279. WREG32(R_006118_D1GRPH_SECONDARY_SURFACE_ADDRESS, rdev->mc.vram_start);
  280. WREG32(R_006910_D2GRPH_PRIMARY_SURFACE_ADDRESS, rdev->mc.vram_start);
  281. WREG32(R_006918_D2GRPH_SECONDARY_SURFACE_ADDRESS, rdev->mc.vram_start);
  282. WREG32(R_000310_VGA_MEMORY_BASE_ADDRESS, rdev->mc.vram_start);
  283. /* Unlock host access */
  284. WREG32(R_000328_VGA_HDP_CONTROL, save->vga_hdp_control);
  285. mdelay(1);
  286. /* Restore video state */
  287. WREG32(R_000330_D1VGA_CONTROL, save->d1vga_control);
  288. WREG32(R_000338_D2VGA_CONTROL, save->d2vga_control);
  289. WREG32(R_0060E8_D1CRTC_UPDATE_LOCK, 1);
  290. WREG32(R_0068E8_D2CRTC_UPDATE_LOCK, 1);
  291. WREG32(R_006080_D1CRTC_CONTROL, save->d1crtc_control);
  292. WREG32(R_006880_D2CRTC_CONTROL, save->d2crtc_control);
  293. WREG32(R_0060E8_D1CRTC_UPDATE_LOCK, 0);
  294. WREG32(R_0068E8_D2CRTC_UPDATE_LOCK, 0);
  295. WREG32(R_000300_VGA_RENDER_CONTROL, save->vga_render_control);
  296. }
  297. void rv515_mc_program(struct radeon_device *rdev)
  298. {
  299. struct rv515_mc_save save;
  300. /* Stops all mc clients */
  301. rv515_mc_stop(rdev, &save);
  302. /* Wait for mc idle */
  303. if (rv515_mc_wait_for_idle(rdev))
  304. dev_warn(rdev->dev, "Wait MC idle timeout before updating MC.\n");
  305. /* Write VRAM size in case we are limiting it */
  306. WREG32(R_0000F8_CONFIG_MEMSIZE, rdev->mc.real_vram_size);
  307. /* Program MC, should be a 32bits limited address space */
  308. WREG32_MC(R_000001_MC_FB_LOCATION,
  309. S_000001_MC_FB_START(rdev->mc.vram_start >> 16) |
  310. S_000001_MC_FB_TOP(rdev->mc.vram_end >> 16));
  311. WREG32(R_000134_HDP_FB_LOCATION,
  312. S_000134_HDP_FB_START(rdev->mc.vram_start >> 16));
  313. if (rdev->flags & RADEON_IS_AGP) {
  314. WREG32_MC(R_000002_MC_AGP_LOCATION,
  315. S_000002_MC_AGP_START(rdev->mc.gtt_start >> 16) |
  316. S_000002_MC_AGP_TOP(rdev->mc.gtt_end >> 16));
  317. WREG32_MC(R_000003_MC_AGP_BASE, lower_32_bits(rdev->mc.agp_base));
  318. WREG32_MC(R_000004_MC_AGP_BASE_2,
  319. S_000004_AGP_BASE_ADDR_2(upper_32_bits(rdev->mc.agp_base)));
  320. } else {
  321. WREG32_MC(R_000002_MC_AGP_LOCATION, 0xFFFFFFFF);
  322. WREG32_MC(R_000003_MC_AGP_BASE, 0);
  323. WREG32_MC(R_000004_MC_AGP_BASE_2, 0);
  324. }
  325. rv515_mc_resume(rdev, &save);
  326. }
  327. void rv515_clock_startup(struct radeon_device *rdev)
  328. {
  329. if (radeon_dynclks != -1 && radeon_dynclks)
  330. radeon_atom_set_clock_gating(rdev, 1);
  331. /* We need to force on some of the block */
  332. WREG32_PLL(R_00000F_CP_DYN_CNTL,
  333. RREG32_PLL(R_00000F_CP_DYN_CNTL) | S_00000F_CP_FORCEON(1));
  334. WREG32_PLL(R_000011_E2_DYN_CNTL,
  335. RREG32_PLL(R_000011_E2_DYN_CNTL) | S_000011_E2_FORCEON(1));
  336. WREG32_PLL(R_000013_IDCT_DYN_CNTL,
  337. RREG32_PLL(R_000013_IDCT_DYN_CNTL) | S_000013_IDCT_FORCEON(1));
  338. }
  339. static int rv515_startup(struct radeon_device *rdev)
  340. {
  341. int r;
  342. rv515_mc_program(rdev);
  343. /* Resume clock */
  344. rv515_clock_startup(rdev);
  345. /* Initialize GPU configuration (# pipes, ...) */
  346. rv515_gpu_init(rdev);
  347. /* Initialize GART (initialize after TTM so we can allocate
  348. * memory through TTM but finalize after TTM) */
  349. if (rdev->flags & RADEON_IS_PCIE) {
  350. r = rv370_pcie_gart_enable(rdev);
  351. if (r)
  352. return r;
  353. }
  354. /* Enable IRQ */
  355. rs600_irq_set(rdev);
  356. rdev->config.r300.hdp_cntl = RREG32(RADEON_HOST_PATH_CNTL);
  357. /* 1M ring buffer */
  358. r = r100_cp_init(rdev, 1024 * 1024);
  359. if (r) {
  360. dev_err(rdev->dev, "failled initializing CP (%d).\n", r);
  361. return r;
  362. }
  363. r = r100_wb_init(rdev);
  364. if (r)
  365. dev_err(rdev->dev, "failled initializing WB (%d).\n", r);
  366. r = r100_ib_init(rdev);
  367. if (r) {
  368. dev_err(rdev->dev, "failled initializing IB (%d).\n", r);
  369. return r;
  370. }
  371. return 0;
  372. }
  373. int rv515_resume(struct radeon_device *rdev)
  374. {
  375. /* Make sur GART are not working */
  376. if (rdev->flags & RADEON_IS_PCIE)
  377. rv370_pcie_gart_disable(rdev);
  378. /* Resume clock before doing reset */
  379. rv515_clock_startup(rdev);
  380. /* Reset gpu before posting otherwise ATOM will enter infinite loop */
  381. if (radeon_asic_reset(rdev)) {
  382. dev_warn(rdev->dev, "GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
  383. RREG32(R_000E40_RBBM_STATUS),
  384. RREG32(R_0007C0_CP_STAT));
  385. }
  386. /* post */
  387. atom_asic_init(rdev->mode_info.atom_context);
  388. /* Resume clock after posting */
  389. rv515_clock_startup(rdev);
  390. /* Initialize surface registers */
  391. radeon_surface_init(rdev);
  392. return rv515_startup(rdev);
  393. }
  394. int rv515_suspend(struct radeon_device *rdev)
  395. {
  396. r100_cp_disable(rdev);
  397. r100_wb_disable(rdev);
  398. rs600_irq_disable(rdev);
  399. if (rdev->flags & RADEON_IS_PCIE)
  400. rv370_pcie_gart_disable(rdev);
  401. return 0;
  402. }
  403. void rv515_set_safe_registers(struct radeon_device *rdev)
  404. {
  405. rdev->config.r300.reg_safe_bm = rv515_reg_safe_bm;
  406. rdev->config.r300.reg_safe_bm_size = ARRAY_SIZE(rv515_reg_safe_bm);
  407. }
  408. void rv515_fini(struct radeon_device *rdev)
  409. {
  410. r100_cp_fini(rdev);
  411. r100_wb_fini(rdev);
  412. r100_ib_fini(rdev);
  413. radeon_gem_fini(rdev);
  414. rv370_pcie_gart_fini(rdev);
  415. radeon_agp_fini(rdev);
  416. radeon_irq_kms_fini(rdev);
  417. radeon_fence_driver_fini(rdev);
  418. radeon_bo_fini(rdev);
  419. radeon_atombios_fini(rdev);
  420. kfree(rdev->bios);
  421. rdev->bios = NULL;
  422. }
  423. int rv515_init(struct radeon_device *rdev)
  424. {
  425. int r;
  426. /* Initialize scratch registers */
  427. radeon_scratch_init(rdev);
  428. /* Initialize surface registers */
  429. radeon_surface_init(rdev);
  430. /* TODO: disable VGA need to use VGA request */
  431. /* BIOS*/
  432. if (!radeon_get_bios(rdev)) {
  433. if (ASIC_IS_AVIVO(rdev))
  434. return -EINVAL;
  435. }
  436. if (rdev->is_atom_bios) {
  437. r = radeon_atombios_init(rdev);
  438. if (r)
  439. return r;
  440. } else {
  441. dev_err(rdev->dev, "Expecting atombios for RV515 GPU\n");
  442. return -EINVAL;
  443. }
  444. /* Reset gpu before posting otherwise ATOM will enter infinite loop */
  445. if (radeon_asic_reset(rdev)) {
  446. dev_warn(rdev->dev,
  447. "GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
  448. RREG32(R_000E40_RBBM_STATUS),
  449. RREG32(R_0007C0_CP_STAT));
  450. }
  451. /* check if cards are posted or not */
  452. if (radeon_boot_test_post_card(rdev) == false)
  453. return -EINVAL;
  454. /* Initialize clocks */
  455. radeon_get_clock_info(rdev->ddev);
  456. /* initialize AGP */
  457. if (rdev->flags & RADEON_IS_AGP) {
  458. r = radeon_agp_init(rdev);
  459. if (r) {
  460. radeon_agp_disable(rdev);
  461. }
  462. }
  463. /* initialize memory controller */
  464. rv515_mc_init(rdev);
  465. rv515_debugfs(rdev);
  466. /* Fence driver */
  467. r = radeon_fence_driver_init(rdev);
  468. if (r)
  469. return r;
  470. r = radeon_irq_kms_init(rdev);
  471. if (r)
  472. return r;
  473. /* Memory manager */
  474. r = radeon_bo_init(rdev);
  475. if (r)
  476. return r;
  477. r = rv370_pcie_gart_init(rdev);
  478. if (r)
  479. return r;
  480. rv515_set_safe_registers(rdev);
  481. rdev->accel_working = true;
  482. r = rv515_startup(rdev);
  483. if (r) {
  484. /* Somethings want wront with the accel init stop accel */
  485. dev_err(rdev->dev, "Disabling GPU acceleration\n");
  486. r100_cp_fini(rdev);
  487. r100_wb_fini(rdev);
  488. r100_ib_fini(rdev);
  489. radeon_irq_kms_fini(rdev);
  490. rv370_pcie_gart_fini(rdev);
  491. radeon_agp_fini(rdev);
  492. rdev->accel_working = false;
  493. }
  494. return 0;
  495. }
  496. void atom_rv515_force_tv_scaler(struct radeon_device *rdev, struct radeon_crtc *crtc)
  497. {
  498. int index_reg = 0x6578 + crtc->crtc_offset;
  499. int data_reg = 0x657c + crtc->crtc_offset;
  500. WREG32(0x659C + crtc->crtc_offset, 0x0);
  501. WREG32(0x6594 + crtc->crtc_offset, 0x705);
  502. WREG32(0x65A4 + crtc->crtc_offset, 0x10001);
  503. WREG32(0x65D8 + crtc->crtc_offset, 0x0);
  504. WREG32(0x65B0 + crtc->crtc_offset, 0x0);
  505. WREG32(0x65C0 + crtc->crtc_offset, 0x0);
  506. WREG32(0x65D4 + crtc->crtc_offset, 0x0);
  507. WREG32(index_reg, 0x0);
  508. WREG32(data_reg, 0x841880A8);
  509. WREG32(index_reg, 0x1);
  510. WREG32(data_reg, 0x84208680);
  511. WREG32(index_reg, 0x2);
  512. WREG32(data_reg, 0xBFF880B0);
  513. WREG32(index_reg, 0x100);
  514. WREG32(data_reg, 0x83D88088);
  515. WREG32(index_reg, 0x101);
  516. WREG32(data_reg, 0x84608680);
  517. WREG32(index_reg, 0x102);
  518. WREG32(data_reg, 0xBFF080D0);
  519. WREG32(index_reg, 0x200);
  520. WREG32(data_reg, 0x83988068);
  521. WREG32(index_reg, 0x201);
  522. WREG32(data_reg, 0x84A08680);
  523. WREG32(index_reg, 0x202);
  524. WREG32(data_reg, 0xBFF080F8);
  525. WREG32(index_reg, 0x300);
  526. WREG32(data_reg, 0x83588058);
  527. WREG32(index_reg, 0x301);
  528. WREG32(data_reg, 0x84E08660);
  529. WREG32(index_reg, 0x302);
  530. WREG32(data_reg, 0xBFF88120);
  531. WREG32(index_reg, 0x400);
  532. WREG32(data_reg, 0x83188040);
  533. WREG32(index_reg, 0x401);
  534. WREG32(data_reg, 0x85008660);
  535. WREG32(index_reg, 0x402);
  536. WREG32(data_reg, 0xBFF88150);
  537. WREG32(index_reg, 0x500);
  538. WREG32(data_reg, 0x82D88030);
  539. WREG32(index_reg, 0x501);
  540. WREG32(data_reg, 0x85408640);
  541. WREG32(index_reg, 0x502);
  542. WREG32(data_reg, 0xBFF88180);
  543. WREG32(index_reg, 0x600);
  544. WREG32(data_reg, 0x82A08018);
  545. WREG32(index_reg, 0x601);
  546. WREG32(data_reg, 0x85808620);
  547. WREG32(index_reg, 0x602);
  548. WREG32(data_reg, 0xBFF081B8);
  549. WREG32(index_reg, 0x700);
  550. WREG32(data_reg, 0x82608010);
  551. WREG32(index_reg, 0x701);
  552. WREG32(data_reg, 0x85A08600);
  553. WREG32(index_reg, 0x702);
  554. WREG32(data_reg, 0x800081F0);
  555. WREG32(index_reg, 0x800);
  556. WREG32(data_reg, 0x8228BFF8);
  557. WREG32(index_reg, 0x801);
  558. WREG32(data_reg, 0x85E085E0);
  559. WREG32(index_reg, 0x802);
  560. WREG32(data_reg, 0xBFF88228);
  561. WREG32(index_reg, 0x10000);
  562. WREG32(data_reg, 0x82A8BF00);
  563. WREG32(index_reg, 0x10001);
  564. WREG32(data_reg, 0x82A08CC0);
  565. WREG32(index_reg, 0x10002);
  566. WREG32(data_reg, 0x8008BEF8);
  567. WREG32(index_reg, 0x10100);
  568. WREG32(data_reg, 0x81F0BF28);
  569. WREG32(index_reg, 0x10101);
  570. WREG32(data_reg, 0x83608CA0);
  571. WREG32(index_reg, 0x10102);
  572. WREG32(data_reg, 0x8018BED0);
  573. WREG32(index_reg, 0x10200);
  574. WREG32(data_reg, 0x8148BF38);
  575. WREG32(index_reg, 0x10201);
  576. WREG32(data_reg, 0x84408C80);
  577. WREG32(index_reg, 0x10202);
  578. WREG32(data_reg, 0x8008BEB8);
  579. WREG32(index_reg, 0x10300);
  580. WREG32(data_reg, 0x80B0BF78);
  581. WREG32(index_reg, 0x10301);
  582. WREG32(data_reg, 0x85008C20);
  583. WREG32(index_reg, 0x10302);
  584. WREG32(data_reg, 0x8020BEA0);
  585. WREG32(index_reg, 0x10400);
  586. WREG32(data_reg, 0x8028BF90);
  587. WREG32(index_reg, 0x10401);
  588. WREG32(data_reg, 0x85E08BC0);
  589. WREG32(index_reg, 0x10402);
  590. WREG32(data_reg, 0x8018BE90);
  591. WREG32(index_reg, 0x10500);
  592. WREG32(data_reg, 0xBFB8BFB0);
  593. WREG32(index_reg, 0x10501);
  594. WREG32(data_reg, 0x86C08B40);
  595. WREG32(index_reg, 0x10502);
  596. WREG32(data_reg, 0x8010BE90);
  597. WREG32(index_reg, 0x10600);
  598. WREG32(data_reg, 0xBF58BFC8);
  599. WREG32(index_reg, 0x10601);
  600. WREG32(data_reg, 0x87A08AA0);
  601. WREG32(index_reg, 0x10602);
  602. WREG32(data_reg, 0x8010BE98);
  603. WREG32(index_reg, 0x10700);
  604. WREG32(data_reg, 0xBF10BFF0);
  605. WREG32(index_reg, 0x10701);
  606. WREG32(data_reg, 0x886089E0);
  607. WREG32(index_reg, 0x10702);
  608. WREG32(data_reg, 0x8018BEB0);
  609. WREG32(index_reg, 0x10800);
  610. WREG32(data_reg, 0xBED8BFE8);
  611. WREG32(index_reg, 0x10801);
  612. WREG32(data_reg, 0x89408940);
  613. WREG32(index_reg, 0x10802);
  614. WREG32(data_reg, 0xBFE8BED8);
  615. WREG32(index_reg, 0x20000);
  616. WREG32(data_reg, 0x80008000);
  617. WREG32(index_reg, 0x20001);
  618. WREG32(data_reg, 0x90008000);
  619. WREG32(index_reg, 0x20002);
  620. WREG32(data_reg, 0x80008000);
  621. WREG32(index_reg, 0x20003);
  622. WREG32(data_reg, 0x80008000);
  623. WREG32(index_reg, 0x20100);
  624. WREG32(data_reg, 0x80108000);
  625. WREG32(index_reg, 0x20101);
  626. WREG32(data_reg, 0x8FE0BF70);
  627. WREG32(index_reg, 0x20102);
  628. WREG32(data_reg, 0xBFE880C0);
  629. WREG32(index_reg, 0x20103);
  630. WREG32(data_reg, 0x80008000);
  631. WREG32(index_reg, 0x20200);
  632. WREG32(data_reg, 0x8018BFF8);
  633. WREG32(index_reg, 0x20201);
  634. WREG32(data_reg, 0x8F80BF08);
  635. WREG32(index_reg, 0x20202);
  636. WREG32(data_reg, 0xBFD081A0);
  637. WREG32(index_reg, 0x20203);
  638. WREG32(data_reg, 0xBFF88000);
  639. WREG32(index_reg, 0x20300);
  640. WREG32(data_reg, 0x80188000);
  641. WREG32(index_reg, 0x20301);
  642. WREG32(data_reg, 0x8EE0BEC0);
  643. WREG32(index_reg, 0x20302);
  644. WREG32(data_reg, 0xBFB082A0);
  645. WREG32(index_reg, 0x20303);
  646. WREG32(data_reg, 0x80008000);
  647. WREG32(index_reg, 0x20400);
  648. WREG32(data_reg, 0x80188000);
  649. WREG32(index_reg, 0x20401);
  650. WREG32(data_reg, 0x8E00BEA0);
  651. WREG32(index_reg, 0x20402);
  652. WREG32(data_reg, 0xBF8883C0);
  653. WREG32(index_reg, 0x20403);
  654. WREG32(data_reg, 0x80008000);
  655. WREG32(index_reg, 0x20500);
  656. WREG32(data_reg, 0x80188000);
  657. WREG32(index_reg, 0x20501);
  658. WREG32(data_reg, 0x8D00BE90);
  659. WREG32(index_reg, 0x20502);
  660. WREG32(data_reg, 0xBF588500);
  661. WREG32(index_reg, 0x20503);
  662. WREG32(data_reg, 0x80008008);
  663. WREG32(index_reg, 0x20600);
  664. WREG32(data_reg, 0x80188000);
  665. WREG32(index_reg, 0x20601);
  666. WREG32(data_reg, 0x8BC0BE98);
  667. WREG32(index_reg, 0x20602);
  668. WREG32(data_reg, 0xBF308660);
  669. WREG32(index_reg, 0x20603);
  670. WREG32(data_reg, 0x80008008);
  671. WREG32(index_reg, 0x20700);
  672. WREG32(data_reg, 0x80108000);
  673. WREG32(index_reg, 0x20701);
  674. WREG32(data_reg, 0x8A80BEB0);
  675. WREG32(index_reg, 0x20702);
  676. WREG32(data_reg, 0xBF0087C0);
  677. WREG32(index_reg, 0x20703);
  678. WREG32(data_reg, 0x80008008);
  679. WREG32(index_reg, 0x20800);
  680. WREG32(data_reg, 0x80108000);
  681. WREG32(index_reg, 0x20801);
  682. WREG32(data_reg, 0x8920BED0);
  683. WREG32(index_reg, 0x20802);
  684. WREG32(data_reg, 0xBED08920);
  685. WREG32(index_reg, 0x20803);
  686. WREG32(data_reg, 0x80008010);
  687. WREG32(index_reg, 0x30000);
  688. WREG32(data_reg, 0x90008000);
  689. WREG32(index_reg, 0x30001);
  690. WREG32(data_reg, 0x80008000);
  691. WREG32(index_reg, 0x30100);
  692. WREG32(data_reg, 0x8FE0BF90);
  693. WREG32(index_reg, 0x30101);
  694. WREG32(data_reg, 0xBFF880A0);
  695. WREG32(index_reg, 0x30200);
  696. WREG32(data_reg, 0x8F60BF40);
  697. WREG32(index_reg, 0x30201);
  698. WREG32(data_reg, 0xBFE88180);
  699. WREG32(index_reg, 0x30300);
  700. WREG32(data_reg, 0x8EC0BF00);
  701. WREG32(index_reg, 0x30301);
  702. WREG32(data_reg, 0xBFC88280);
  703. WREG32(index_reg, 0x30400);
  704. WREG32(data_reg, 0x8DE0BEE0);
  705. WREG32(index_reg, 0x30401);
  706. WREG32(data_reg, 0xBFA083A0);
  707. WREG32(index_reg, 0x30500);
  708. WREG32(data_reg, 0x8CE0BED0);
  709. WREG32(index_reg, 0x30501);
  710. WREG32(data_reg, 0xBF7884E0);
  711. WREG32(index_reg, 0x30600);
  712. WREG32(data_reg, 0x8BA0BED8);
  713. WREG32(index_reg, 0x30601);
  714. WREG32(data_reg, 0xBF508640);
  715. WREG32(index_reg, 0x30700);
  716. WREG32(data_reg, 0x8A60BEE8);
  717. WREG32(index_reg, 0x30701);
  718. WREG32(data_reg, 0xBF2087A0);
  719. WREG32(index_reg, 0x30800);
  720. WREG32(data_reg, 0x8900BF00);
  721. WREG32(index_reg, 0x30801);
  722. WREG32(data_reg, 0xBF008900);
  723. }
  724. struct rv515_watermark {
  725. u32 lb_request_fifo_depth;
  726. fixed20_12 num_line_pair;
  727. fixed20_12 estimated_width;
  728. fixed20_12 worst_case_latency;
  729. fixed20_12 consumption_rate;
  730. fixed20_12 active_time;
  731. fixed20_12 dbpp;
  732. fixed20_12 priority_mark_max;
  733. fixed20_12 priority_mark;
  734. fixed20_12 sclk;
  735. };
  736. void rv515_crtc_bandwidth_compute(struct radeon_device *rdev,
  737. struct radeon_crtc *crtc,
  738. struct rv515_watermark *wm)
  739. {
  740. struct drm_display_mode *mode = &crtc->base.mode;
  741. fixed20_12 a, b, c;
  742. fixed20_12 pclk, request_fifo_depth, tolerable_latency, estimated_width;
  743. fixed20_12 consumption_time, line_time, chunk_time, read_delay_latency;
  744. if (!crtc->base.enabled) {
  745. /* FIXME: wouldn't it better to set priority mark to maximum */
  746. wm->lb_request_fifo_depth = 4;
  747. return;
  748. }
  749. if (crtc->vsc.full > dfixed_const(2))
  750. wm->num_line_pair.full = dfixed_const(2);
  751. else
  752. wm->num_line_pair.full = dfixed_const(1);
  753. b.full = dfixed_const(mode->crtc_hdisplay);
  754. c.full = dfixed_const(256);
  755. a.full = dfixed_div(b, c);
  756. request_fifo_depth.full = dfixed_mul(a, wm->num_line_pair);
  757. request_fifo_depth.full = dfixed_ceil(request_fifo_depth);
  758. if (a.full < dfixed_const(4)) {
  759. wm->lb_request_fifo_depth = 4;
  760. } else {
  761. wm->lb_request_fifo_depth = dfixed_trunc(request_fifo_depth);
  762. }
  763. /* Determine consumption rate
  764. * pclk = pixel clock period(ns) = 1000 / (mode.clock / 1000)
  765. * vtaps = number of vertical taps,
  766. * vsc = vertical scaling ratio, defined as source/destination
  767. * hsc = horizontal scaling ration, defined as source/destination
  768. */
  769. a.full = dfixed_const(mode->clock);
  770. b.full = dfixed_const(1000);
  771. a.full = dfixed_div(a, b);
  772. pclk.full = dfixed_div(b, a);
  773. if (crtc->rmx_type != RMX_OFF) {
  774. b.full = dfixed_const(2);
  775. if (crtc->vsc.full > b.full)
  776. b.full = crtc->vsc.full;
  777. b.full = dfixed_mul(b, crtc->hsc);
  778. c.full = dfixed_const(2);
  779. b.full = dfixed_div(b, c);
  780. consumption_time.full = dfixed_div(pclk, b);
  781. } else {
  782. consumption_time.full = pclk.full;
  783. }
  784. a.full = dfixed_const(1);
  785. wm->consumption_rate.full = dfixed_div(a, consumption_time);
  786. /* Determine line time
  787. * LineTime = total time for one line of displayhtotal
  788. * LineTime = total number of horizontal pixels
  789. * pclk = pixel clock period(ns)
  790. */
  791. a.full = dfixed_const(crtc->base.mode.crtc_htotal);
  792. line_time.full = dfixed_mul(a, pclk);
  793. /* Determine active time
  794. * ActiveTime = time of active region of display within one line,
  795. * hactive = total number of horizontal active pixels
  796. * htotal = total number of horizontal pixels
  797. */
  798. a.full = dfixed_const(crtc->base.mode.crtc_htotal);
  799. b.full = dfixed_const(crtc->base.mode.crtc_hdisplay);
  800. wm->active_time.full = dfixed_mul(line_time, b);
  801. wm->active_time.full = dfixed_div(wm->active_time, a);
  802. /* Determine chunk time
  803. * ChunkTime = the time it takes the DCP to send one chunk of data
  804. * to the LB which consists of pipeline delay and inter chunk gap
  805. * sclk = system clock(Mhz)
  806. */
  807. a.full = dfixed_const(600 * 1000);
  808. chunk_time.full = dfixed_div(a, rdev->pm.sclk);
  809. read_delay_latency.full = dfixed_const(1000);
  810. /* Determine the worst case latency
  811. * NumLinePair = Number of line pairs to request(1=2 lines, 2=4 lines)
  812. * WorstCaseLatency = worst case time from urgent to when the MC starts
  813. * to return data
  814. * READ_DELAY_IDLE_MAX = constant of 1us
  815. * ChunkTime = time it takes the DCP to send one chunk of data to the LB
  816. * which consists of pipeline delay and inter chunk gap
  817. */
  818. if (dfixed_trunc(wm->num_line_pair) > 1) {
  819. a.full = dfixed_const(3);
  820. wm->worst_case_latency.full = dfixed_mul(a, chunk_time);
  821. wm->worst_case_latency.full += read_delay_latency.full;
  822. } else {
  823. wm->worst_case_latency.full = chunk_time.full + read_delay_latency.full;
  824. }
  825. /* Determine the tolerable latency
  826. * TolerableLatency = Any given request has only 1 line time
  827. * for the data to be returned
  828. * LBRequestFifoDepth = Number of chunk requests the LB can
  829. * put into the request FIFO for a display
  830. * LineTime = total time for one line of display
  831. * ChunkTime = the time it takes the DCP to send one chunk
  832. * of data to the LB which consists of
  833. * pipeline delay and inter chunk gap
  834. */
  835. if ((2+wm->lb_request_fifo_depth) >= dfixed_trunc(request_fifo_depth)) {
  836. tolerable_latency.full = line_time.full;
  837. } else {
  838. tolerable_latency.full = dfixed_const(wm->lb_request_fifo_depth - 2);
  839. tolerable_latency.full = request_fifo_depth.full - tolerable_latency.full;
  840. tolerable_latency.full = dfixed_mul(tolerable_latency, chunk_time);
  841. tolerable_latency.full = line_time.full - tolerable_latency.full;
  842. }
  843. /* We assume worst case 32bits (4 bytes) */
  844. wm->dbpp.full = dfixed_const(2 * 16);
  845. /* Determine the maximum priority mark
  846. * width = viewport width in pixels
  847. */
  848. a.full = dfixed_const(16);
  849. wm->priority_mark_max.full = dfixed_const(crtc->base.mode.crtc_hdisplay);
  850. wm->priority_mark_max.full = dfixed_div(wm->priority_mark_max, a);
  851. wm->priority_mark_max.full = dfixed_ceil(wm->priority_mark_max);
  852. /* Determine estimated width */
  853. estimated_width.full = tolerable_latency.full - wm->worst_case_latency.full;
  854. estimated_width.full = dfixed_div(estimated_width, consumption_time);
  855. if (dfixed_trunc(estimated_width) > crtc->base.mode.crtc_hdisplay) {
  856. wm->priority_mark.full = wm->priority_mark_max.full;
  857. } else {
  858. a.full = dfixed_const(16);
  859. wm->priority_mark.full = dfixed_div(estimated_width, a);
  860. wm->priority_mark.full = dfixed_ceil(wm->priority_mark);
  861. wm->priority_mark.full = wm->priority_mark_max.full - wm->priority_mark.full;
  862. }
  863. }
  864. void rv515_bandwidth_avivo_update(struct radeon_device *rdev)
  865. {
  866. struct drm_display_mode *mode0 = NULL;
  867. struct drm_display_mode *mode1 = NULL;
  868. struct rv515_watermark wm0;
  869. struct rv515_watermark wm1;
  870. u32 tmp, d1mode_priority_a_cnt, d2mode_priority_a_cnt;
  871. fixed20_12 priority_mark02, priority_mark12, fill_rate;
  872. fixed20_12 a, b;
  873. if (rdev->mode_info.crtcs[0]->base.enabled)
  874. mode0 = &rdev->mode_info.crtcs[0]->base.mode;
  875. if (rdev->mode_info.crtcs[1]->base.enabled)
  876. mode1 = &rdev->mode_info.crtcs[1]->base.mode;
  877. rs690_line_buffer_adjust(rdev, mode0, mode1);
  878. rv515_crtc_bandwidth_compute(rdev, rdev->mode_info.crtcs[0], &wm0);
  879. rv515_crtc_bandwidth_compute(rdev, rdev->mode_info.crtcs[1], &wm1);
  880. tmp = wm0.lb_request_fifo_depth;
  881. tmp |= wm1.lb_request_fifo_depth << 16;
  882. WREG32(LB_MAX_REQ_OUTSTANDING, tmp);
  883. if (mode0 && mode1) {
  884. if (dfixed_trunc(wm0.dbpp) > 64)
  885. a.full = dfixed_div(wm0.dbpp, wm0.num_line_pair);
  886. else
  887. a.full = wm0.num_line_pair.full;
  888. if (dfixed_trunc(wm1.dbpp) > 64)
  889. b.full = dfixed_div(wm1.dbpp, wm1.num_line_pair);
  890. else
  891. b.full = wm1.num_line_pair.full;
  892. a.full += b.full;
  893. fill_rate.full = dfixed_div(wm0.sclk, a);
  894. if (wm0.consumption_rate.full > fill_rate.full) {
  895. b.full = wm0.consumption_rate.full - fill_rate.full;
  896. b.full = dfixed_mul(b, wm0.active_time);
  897. a.full = dfixed_const(16);
  898. b.full = dfixed_div(b, a);
  899. a.full = dfixed_mul(wm0.worst_case_latency,
  900. wm0.consumption_rate);
  901. priority_mark02.full = a.full + b.full;
  902. } else {
  903. a.full = dfixed_mul(wm0.worst_case_latency,
  904. wm0.consumption_rate);
  905. b.full = dfixed_const(16 * 1000);
  906. priority_mark02.full = dfixed_div(a, b);
  907. }
  908. if (wm1.consumption_rate.full > fill_rate.full) {
  909. b.full = wm1.consumption_rate.full - fill_rate.full;
  910. b.full = dfixed_mul(b, wm1.active_time);
  911. a.full = dfixed_const(16);
  912. b.full = dfixed_div(b, a);
  913. a.full = dfixed_mul(wm1.worst_case_latency,
  914. wm1.consumption_rate);
  915. priority_mark12.full = a.full + b.full;
  916. } else {
  917. a.full = dfixed_mul(wm1.worst_case_latency,
  918. wm1.consumption_rate);
  919. b.full = dfixed_const(16 * 1000);
  920. priority_mark12.full = dfixed_div(a, b);
  921. }
  922. if (wm0.priority_mark.full > priority_mark02.full)
  923. priority_mark02.full = wm0.priority_mark.full;
  924. if (dfixed_trunc(priority_mark02) < 0)
  925. priority_mark02.full = 0;
  926. if (wm0.priority_mark_max.full > priority_mark02.full)
  927. priority_mark02.full = wm0.priority_mark_max.full;
  928. if (wm1.priority_mark.full > priority_mark12.full)
  929. priority_mark12.full = wm1.priority_mark.full;
  930. if (dfixed_trunc(priority_mark12) < 0)
  931. priority_mark12.full = 0;
  932. if (wm1.priority_mark_max.full > priority_mark12.full)
  933. priority_mark12.full = wm1.priority_mark_max.full;
  934. d1mode_priority_a_cnt = dfixed_trunc(priority_mark02);
  935. d2mode_priority_a_cnt = dfixed_trunc(priority_mark12);
  936. if (rdev->disp_priority == 2) {
  937. d1mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  938. d2mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  939. }
  940. WREG32(D1MODE_PRIORITY_A_CNT, d1mode_priority_a_cnt);
  941. WREG32(D1MODE_PRIORITY_B_CNT, d1mode_priority_a_cnt);
  942. WREG32(D2MODE_PRIORITY_A_CNT, d2mode_priority_a_cnt);
  943. WREG32(D2MODE_PRIORITY_B_CNT, d2mode_priority_a_cnt);
  944. } else if (mode0) {
  945. if (dfixed_trunc(wm0.dbpp) > 64)
  946. a.full = dfixed_div(wm0.dbpp, wm0.num_line_pair);
  947. else
  948. a.full = wm0.num_line_pair.full;
  949. fill_rate.full = dfixed_div(wm0.sclk, a);
  950. if (wm0.consumption_rate.full > fill_rate.full) {
  951. b.full = wm0.consumption_rate.full - fill_rate.full;
  952. b.full = dfixed_mul(b, wm0.active_time);
  953. a.full = dfixed_const(16);
  954. b.full = dfixed_div(b, a);
  955. a.full = dfixed_mul(wm0.worst_case_latency,
  956. wm0.consumption_rate);
  957. priority_mark02.full = a.full + b.full;
  958. } else {
  959. a.full = dfixed_mul(wm0.worst_case_latency,
  960. wm0.consumption_rate);
  961. b.full = dfixed_const(16);
  962. priority_mark02.full = dfixed_div(a, b);
  963. }
  964. if (wm0.priority_mark.full > priority_mark02.full)
  965. priority_mark02.full = wm0.priority_mark.full;
  966. if (dfixed_trunc(priority_mark02) < 0)
  967. priority_mark02.full = 0;
  968. if (wm0.priority_mark_max.full > priority_mark02.full)
  969. priority_mark02.full = wm0.priority_mark_max.full;
  970. d1mode_priority_a_cnt = dfixed_trunc(priority_mark02);
  971. if (rdev->disp_priority == 2)
  972. d1mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  973. WREG32(D1MODE_PRIORITY_A_CNT, d1mode_priority_a_cnt);
  974. WREG32(D1MODE_PRIORITY_B_CNT, d1mode_priority_a_cnt);
  975. WREG32(D2MODE_PRIORITY_A_CNT, MODE_PRIORITY_OFF);
  976. WREG32(D2MODE_PRIORITY_B_CNT, MODE_PRIORITY_OFF);
  977. } else {
  978. if (dfixed_trunc(wm1.dbpp) > 64)
  979. a.full = dfixed_div(wm1.dbpp, wm1.num_line_pair);
  980. else
  981. a.full = wm1.num_line_pair.full;
  982. fill_rate.full = dfixed_div(wm1.sclk, a);
  983. if (wm1.consumption_rate.full > fill_rate.full) {
  984. b.full = wm1.consumption_rate.full - fill_rate.full;
  985. b.full = dfixed_mul(b, wm1.active_time);
  986. a.full = dfixed_const(16);
  987. b.full = dfixed_div(b, a);
  988. a.full = dfixed_mul(wm1.worst_case_latency,
  989. wm1.consumption_rate);
  990. priority_mark12.full = a.full + b.full;
  991. } else {
  992. a.full = dfixed_mul(wm1.worst_case_latency,
  993. wm1.consumption_rate);
  994. b.full = dfixed_const(16 * 1000);
  995. priority_mark12.full = dfixed_div(a, b);
  996. }
  997. if (wm1.priority_mark.full > priority_mark12.full)
  998. priority_mark12.full = wm1.priority_mark.full;
  999. if (dfixed_trunc(priority_mark12) < 0)
  1000. priority_mark12.full = 0;
  1001. if (wm1.priority_mark_max.full > priority_mark12.full)
  1002. priority_mark12.full = wm1.priority_mark_max.full;
  1003. d2mode_priority_a_cnt = dfixed_trunc(priority_mark12);
  1004. if (rdev->disp_priority == 2)
  1005. d2mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  1006. WREG32(D1MODE_PRIORITY_A_CNT, MODE_PRIORITY_OFF);
  1007. WREG32(D1MODE_PRIORITY_B_CNT, MODE_PRIORITY_OFF);
  1008. WREG32(D2MODE_PRIORITY_A_CNT, d2mode_priority_a_cnt);
  1009. WREG32(D2MODE_PRIORITY_B_CNT, d2mode_priority_a_cnt);
  1010. }
  1011. }
  1012. void rv515_bandwidth_update(struct radeon_device *rdev)
  1013. {
  1014. uint32_t tmp;
  1015. struct drm_display_mode *mode0 = NULL;
  1016. struct drm_display_mode *mode1 = NULL;
  1017. radeon_update_display_priority(rdev);
  1018. if (rdev->mode_info.crtcs[0]->base.enabled)
  1019. mode0 = &rdev->mode_info.crtcs[0]->base.mode;
  1020. if (rdev->mode_info.crtcs[1]->base.enabled)
  1021. mode1 = &rdev->mode_info.crtcs[1]->base.mode;
  1022. /*
  1023. * Set display0/1 priority up in the memory controller for
  1024. * modes if the user specifies HIGH for displaypriority
  1025. * option.
  1026. */
  1027. if ((rdev->disp_priority == 2) &&
  1028. (rdev->family == CHIP_RV515)) {
  1029. tmp = RREG32_MC(MC_MISC_LAT_TIMER);
  1030. tmp &= ~MC_DISP1R_INIT_LAT_MASK;
  1031. tmp &= ~MC_DISP0R_INIT_LAT_MASK;
  1032. if (mode1)
  1033. tmp |= (1 << MC_DISP1R_INIT_LAT_SHIFT);
  1034. if (mode0)
  1035. tmp |= (1 << MC_DISP0R_INIT_LAT_SHIFT);
  1036. WREG32_MC(MC_MISC_LAT_TIMER, tmp);
  1037. }
  1038. rv515_bandwidth_avivo_update(rdev);
  1039. }