rv515.c 35 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106
  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. radeon_pm_fini(rdev);
  411. r100_cp_fini(rdev);
  412. r100_wb_fini(rdev);
  413. r100_ib_fini(rdev);
  414. radeon_gem_fini(rdev);
  415. rv370_pcie_gart_fini(rdev);
  416. radeon_agp_fini(rdev);
  417. radeon_irq_kms_fini(rdev);
  418. radeon_fence_driver_fini(rdev);
  419. radeon_bo_fini(rdev);
  420. radeon_atombios_fini(rdev);
  421. kfree(rdev->bios);
  422. rdev->bios = NULL;
  423. }
  424. int rv515_init(struct radeon_device *rdev)
  425. {
  426. int r;
  427. /* Initialize scratch registers */
  428. radeon_scratch_init(rdev);
  429. /* Initialize surface registers */
  430. radeon_surface_init(rdev);
  431. /* TODO: disable VGA need to use VGA request */
  432. /* BIOS*/
  433. if (!radeon_get_bios(rdev)) {
  434. if (ASIC_IS_AVIVO(rdev))
  435. return -EINVAL;
  436. }
  437. if (rdev->is_atom_bios) {
  438. r = radeon_atombios_init(rdev);
  439. if (r)
  440. return r;
  441. } else {
  442. dev_err(rdev->dev, "Expecting atombios for RV515 GPU\n");
  443. return -EINVAL;
  444. }
  445. /* Reset gpu before posting otherwise ATOM will enter infinite loop */
  446. if (radeon_asic_reset(rdev)) {
  447. dev_warn(rdev->dev,
  448. "GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
  449. RREG32(R_000E40_RBBM_STATUS),
  450. RREG32(R_0007C0_CP_STAT));
  451. }
  452. /* check if cards are posted or not */
  453. if (radeon_boot_test_post_card(rdev) == false)
  454. return -EINVAL;
  455. /* Initialize clocks */
  456. radeon_get_clock_info(rdev->ddev);
  457. /* Initialize power management */
  458. radeon_pm_init(rdev);
  459. /* initialize AGP */
  460. if (rdev->flags & RADEON_IS_AGP) {
  461. r = radeon_agp_init(rdev);
  462. if (r) {
  463. radeon_agp_disable(rdev);
  464. }
  465. }
  466. /* initialize memory controller */
  467. rv515_mc_init(rdev);
  468. rv515_debugfs(rdev);
  469. /* Fence driver */
  470. r = radeon_fence_driver_init(rdev);
  471. if (r)
  472. return r;
  473. r = radeon_irq_kms_init(rdev);
  474. if (r)
  475. return r;
  476. /* Memory manager */
  477. r = radeon_bo_init(rdev);
  478. if (r)
  479. return r;
  480. r = rv370_pcie_gart_init(rdev);
  481. if (r)
  482. return r;
  483. rv515_set_safe_registers(rdev);
  484. rdev->accel_working = true;
  485. r = rv515_startup(rdev);
  486. if (r) {
  487. /* Somethings want wront with the accel init stop accel */
  488. dev_err(rdev->dev, "Disabling GPU acceleration\n");
  489. r100_cp_fini(rdev);
  490. r100_wb_fini(rdev);
  491. r100_ib_fini(rdev);
  492. radeon_irq_kms_fini(rdev);
  493. rv370_pcie_gart_fini(rdev);
  494. radeon_agp_fini(rdev);
  495. rdev->accel_working = false;
  496. }
  497. return 0;
  498. }
  499. void atom_rv515_force_tv_scaler(struct radeon_device *rdev, struct radeon_crtc *crtc)
  500. {
  501. int index_reg = 0x6578 + crtc->crtc_offset;
  502. int data_reg = 0x657c + crtc->crtc_offset;
  503. WREG32(0x659C + crtc->crtc_offset, 0x0);
  504. WREG32(0x6594 + crtc->crtc_offset, 0x705);
  505. WREG32(0x65A4 + crtc->crtc_offset, 0x10001);
  506. WREG32(0x65D8 + crtc->crtc_offset, 0x0);
  507. WREG32(0x65B0 + crtc->crtc_offset, 0x0);
  508. WREG32(0x65C0 + crtc->crtc_offset, 0x0);
  509. WREG32(0x65D4 + crtc->crtc_offset, 0x0);
  510. WREG32(index_reg, 0x0);
  511. WREG32(data_reg, 0x841880A8);
  512. WREG32(index_reg, 0x1);
  513. WREG32(data_reg, 0x84208680);
  514. WREG32(index_reg, 0x2);
  515. WREG32(data_reg, 0xBFF880B0);
  516. WREG32(index_reg, 0x100);
  517. WREG32(data_reg, 0x83D88088);
  518. WREG32(index_reg, 0x101);
  519. WREG32(data_reg, 0x84608680);
  520. WREG32(index_reg, 0x102);
  521. WREG32(data_reg, 0xBFF080D0);
  522. WREG32(index_reg, 0x200);
  523. WREG32(data_reg, 0x83988068);
  524. WREG32(index_reg, 0x201);
  525. WREG32(data_reg, 0x84A08680);
  526. WREG32(index_reg, 0x202);
  527. WREG32(data_reg, 0xBFF080F8);
  528. WREG32(index_reg, 0x300);
  529. WREG32(data_reg, 0x83588058);
  530. WREG32(index_reg, 0x301);
  531. WREG32(data_reg, 0x84E08660);
  532. WREG32(index_reg, 0x302);
  533. WREG32(data_reg, 0xBFF88120);
  534. WREG32(index_reg, 0x400);
  535. WREG32(data_reg, 0x83188040);
  536. WREG32(index_reg, 0x401);
  537. WREG32(data_reg, 0x85008660);
  538. WREG32(index_reg, 0x402);
  539. WREG32(data_reg, 0xBFF88150);
  540. WREG32(index_reg, 0x500);
  541. WREG32(data_reg, 0x82D88030);
  542. WREG32(index_reg, 0x501);
  543. WREG32(data_reg, 0x85408640);
  544. WREG32(index_reg, 0x502);
  545. WREG32(data_reg, 0xBFF88180);
  546. WREG32(index_reg, 0x600);
  547. WREG32(data_reg, 0x82A08018);
  548. WREG32(index_reg, 0x601);
  549. WREG32(data_reg, 0x85808620);
  550. WREG32(index_reg, 0x602);
  551. WREG32(data_reg, 0xBFF081B8);
  552. WREG32(index_reg, 0x700);
  553. WREG32(data_reg, 0x82608010);
  554. WREG32(index_reg, 0x701);
  555. WREG32(data_reg, 0x85A08600);
  556. WREG32(index_reg, 0x702);
  557. WREG32(data_reg, 0x800081F0);
  558. WREG32(index_reg, 0x800);
  559. WREG32(data_reg, 0x8228BFF8);
  560. WREG32(index_reg, 0x801);
  561. WREG32(data_reg, 0x85E085E0);
  562. WREG32(index_reg, 0x802);
  563. WREG32(data_reg, 0xBFF88228);
  564. WREG32(index_reg, 0x10000);
  565. WREG32(data_reg, 0x82A8BF00);
  566. WREG32(index_reg, 0x10001);
  567. WREG32(data_reg, 0x82A08CC0);
  568. WREG32(index_reg, 0x10002);
  569. WREG32(data_reg, 0x8008BEF8);
  570. WREG32(index_reg, 0x10100);
  571. WREG32(data_reg, 0x81F0BF28);
  572. WREG32(index_reg, 0x10101);
  573. WREG32(data_reg, 0x83608CA0);
  574. WREG32(index_reg, 0x10102);
  575. WREG32(data_reg, 0x8018BED0);
  576. WREG32(index_reg, 0x10200);
  577. WREG32(data_reg, 0x8148BF38);
  578. WREG32(index_reg, 0x10201);
  579. WREG32(data_reg, 0x84408C80);
  580. WREG32(index_reg, 0x10202);
  581. WREG32(data_reg, 0x8008BEB8);
  582. WREG32(index_reg, 0x10300);
  583. WREG32(data_reg, 0x80B0BF78);
  584. WREG32(index_reg, 0x10301);
  585. WREG32(data_reg, 0x85008C20);
  586. WREG32(index_reg, 0x10302);
  587. WREG32(data_reg, 0x8020BEA0);
  588. WREG32(index_reg, 0x10400);
  589. WREG32(data_reg, 0x8028BF90);
  590. WREG32(index_reg, 0x10401);
  591. WREG32(data_reg, 0x85E08BC0);
  592. WREG32(index_reg, 0x10402);
  593. WREG32(data_reg, 0x8018BE90);
  594. WREG32(index_reg, 0x10500);
  595. WREG32(data_reg, 0xBFB8BFB0);
  596. WREG32(index_reg, 0x10501);
  597. WREG32(data_reg, 0x86C08B40);
  598. WREG32(index_reg, 0x10502);
  599. WREG32(data_reg, 0x8010BE90);
  600. WREG32(index_reg, 0x10600);
  601. WREG32(data_reg, 0xBF58BFC8);
  602. WREG32(index_reg, 0x10601);
  603. WREG32(data_reg, 0x87A08AA0);
  604. WREG32(index_reg, 0x10602);
  605. WREG32(data_reg, 0x8010BE98);
  606. WREG32(index_reg, 0x10700);
  607. WREG32(data_reg, 0xBF10BFF0);
  608. WREG32(index_reg, 0x10701);
  609. WREG32(data_reg, 0x886089E0);
  610. WREG32(index_reg, 0x10702);
  611. WREG32(data_reg, 0x8018BEB0);
  612. WREG32(index_reg, 0x10800);
  613. WREG32(data_reg, 0xBED8BFE8);
  614. WREG32(index_reg, 0x10801);
  615. WREG32(data_reg, 0x89408940);
  616. WREG32(index_reg, 0x10802);
  617. WREG32(data_reg, 0xBFE8BED8);
  618. WREG32(index_reg, 0x20000);
  619. WREG32(data_reg, 0x80008000);
  620. WREG32(index_reg, 0x20001);
  621. WREG32(data_reg, 0x90008000);
  622. WREG32(index_reg, 0x20002);
  623. WREG32(data_reg, 0x80008000);
  624. WREG32(index_reg, 0x20003);
  625. WREG32(data_reg, 0x80008000);
  626. WREG32(index_reg, 0x20100);
  627. WREG32(data_reg, 0x80108000);
  628. WREG32(index_reg, 0x20101);
  629. WREG32(data_reg, 0x8FE0BF70);
  630. WREG32(index_reg, 0x20102);
  631. WREG32(data_reg, 0xBFE880C0);
  632. WREG32(index_reg, 0x20103);
  633. WREG32(data_reg, 0x80008000);
  634. WREG32(index_reg, 0x20200);
  635. WREG32(data_reg, 0x8018BFF8);
  636. WREG32(index_reg, 0x20201);
  637. WREG32(data_reg, 0x8F80BF08);
  638. WREG32(index_reg, 0x20202);
  639. WREG32(data_reg, 0xBFD081A0);
  640. WREG32(index_reg, 0x20203);
  641. WREG32(data_reg, 0xBFF88000);
  642. WREG32(index_reg, 0x20300);
  643. WREG32(data_reg, 0x80188000);
  644. WREG32(index_reg, 0x20301);
  645. WREG32(data_reg, 0x8EE0BEC0);
  646. WREG32(index_reg, 0x20302);
  647. WREG32(data_reg, 0xBFB082A0);
  648. WREG32(index_reg, 0x20303);
  649. WREG32(data_reg, 0x80008000);
  650. WREG32(index_reg, 0x20400);
  651. WREG32(data_reg, 0x80188000);
  652. WREG32(index_reg, 0x20401);
  653. WREG32(data_reg, 0x8E00BEA0);
  654. WREG32(index_reg, 0x20402);
  655. WREG32(data_reg, 0xBF8883C0);
  656. WREG32(index_reg, 0x20403);
  657. WREG32(data_reg, 0x80008000);
  658. WREG32(index_reg, 0x20500);
  659. WREG32(data_reg, 0x80188000);
  660. WREG32(index_reg, 0x20501);
  661. WREG32(data_reg, 0x8D00BE90);
  662. WREG32(index_reg, 0x20502);
  663. WREG32(data_reg, 0xBF588500);
  664. WREG32(index_reg, 0x20503);
  665. WREG32(data_reg, 0x80008008);
  666. WREG32(index_reg, 0x20600);
  667. WREG32(data_reg, 0x80188000);
  668. WREG32(index_reg, 0x20601);
  669. WREG32(data_reg, 0x8BC0BE98);
  670. WREG32(index_reg, 0x20602);
  671. WREG32(data_reg, 0xBF308660);
  672. WREG32(index_reg, 0x20603);
  673. WREG32(data_reg, 0x80008008);
  674. WREG32(index_reg, 0x20700);
  675. WREG32(data_reg, 0x80108000);
  676. WREG32(index_reg, 0x20701);
  677. WREG32(data_reg, 0x8A80BEB0);
  678. WREG32(index_reg, 0x20702);
  679. WREG32(data_reg, 0xBF0087C0);
  680. WREG32(index_reg, 0x20703);
  681. WREG32(data_reg, 0x80008008);
  682. WREG32(index_reg, 0x20800);
  683. WREG32(data_reg, 0x80108000);
  684. WREG32(index_reg, 0x20801);
  685. WREG32(data_reg, 0x8920BED0);
  686. WREG32(index_reg, 0x20802);
  687. WREG32(data_reg, 0xBED08920);
  688. WREG32(index_reg, 0x20803);
  689. WREG32(data_reg, 0x80008010);
  690. WREG32(index_reg, 0x30000);
  691. WREG32(data_reg, 0x90008000);
  692. WREG32(index_reg, 0x30001);
  693. WREG32(data_reg, 0x80008000);
  694. WREG32(index_reg, 0x30100);
  695. WREG32(data_reg, 0x8FE0BF90);
  696. WREG32(index_reg, 0x30101);
  697. WREG32(data_reg, 0xBFF880A0);
  698. WREG32(index_reg, 0x30200);
  699. WREG32(data_reg, 0x8F60BF40);
  700. WREG32(index_reg, 0x30201);
  701. WREG32(data_reg, 0xBFE88180);
  702. WREG32(index_reg, 0x30300);
  703. WREG32(data_reg, 0x8EC0BF00);
  704. WREG32(index_reg, 0x30301);
  705. WREG32(data_reg, 0xBFC88280);
  706. WREG32(index_reg, 0x30400);
  707. WREG32(data_reg, 0x8DE0BEE0);
  708. WREG32(index_reg, 0x30401);
  709. WREG32(data_reg, 0xBFA083A0);
  710. WREG32(index_reg, 0x30500);
  711. WREG32(data_reg, 0x8CE0BED0);
  712. WREG32(index_reg, 0x30501);
  713. WREG32(data_reg, 0xBF7884E0);
  714. WREG32(index_reg, 0x30600);
  715. WREG32(data_reg, 0x8BA0BED8);
  716. WREG32(index_reg, 0x30601);
  717. WREG32(data_reg, 0xBF508640);
  718. WREG32(index_reg, 0x30700);
  719. WREG32(data_reg, 0x8A60BEE8);
  720. WREG32(index_reg, 0x30701);
  721. WREG32(data_reg, 0xBF2087A0);
  722. WREG32(index_reg, 0x30800);
  723. WREG32(data_reg, 0x8900BF00);
  724. WREG32(index_reg, 0x30801);
  725. WREG32(data_reg, 0xBF008900);
  726. }
  727. struct rv515_watermark {
  728. u32 lb_request_fifo_depth;
  729. fixed20_12 num_line_pair;
  730. fixed20_12 estimated_width;
  731. fixed20_12 worst_case_latency;
  732. fixed20_12 consumption_rate;
  733. fixed20_12 active_time;
  734. fixed20_12 dbpp;
  735. fixed20_12 priority_mark_max;
  736. fixed20_12 priority_mark;
  737. fixed20_12 sclk;
  738. };
  739. void rv515_crtc_bandwidth_compute(struct radeon_device *rdev,
  740. struct radeon_crtc *crtc,
  741. struct rv515_watermark *wm)
  742. {
  743. struct drm_display_mode *mode = &crtc->base.mode;
  744. fixed20_12 a, b, c;
  745. fixed20_12 pclk, request_fifo_depth, tolerable_latency, estimated_width;
  746. fixed20_12 consumption_time, line_time, chunk_time, read_delay_latency;
  747. if (!crtc->base.enabled) {
  748. /* FIXME: wouldn't it better to set priority mark to maximum */
  749. wm->lb_request_fifo_depth = 4;
  750. return;
  751. }
  752. if (crtc->vsc.full > dfixed_const(2))
  753. wm->num_line_pair.full = dfixed_const(2);
  754. else
  755. wm->num_line_pair.full = dfixed_const(1);
  756. b.full = dfixed_const(mode->crtc_hdisplay);
  757. c.full = dfixed_const(256);
  758. a.full = dfixed_div(b, c);
  759. request_fifo_depth.full = dfixed_mul(a, wm->num_line_pair);
  760. request_fifo_depth.full = dfixed_ceil(request_fifo_depth);
  761. if (a.full < dfixed_const(4)) {
  762. wm->lb_request_fifo_depth = 4;
  763. } else {
  764. wm->lb_request_fifo_depth = dfixed_trunc(request_fifo_depth);
  765. }
  766. /* Determine consumption rate
  767. * pclk = pixel clock period(ns) = 1000 / (mode.clock / 1000)
  768. * vtaps = number of vertical taps,
  769. * vsc = vertical scaling ratio, defined as source/destination
  770. * hsc = horizontal scaling ration, defined as source/destination
  771. */
  772. a.full = dfixed_const(mode->clock);
  773. b.full = dfixed_const(1000);
  774. a.full = dfixed_div(a, b);
  775. pclk.full = dfixed_div(b, a);
  776. if (crtc->rmx_type != RMX_OFF) {
  777. b.full = dfixed_const(2);
  778. if (crtc->vsc.full > b.full)
  779. b.full = crtc->vsc.full;
  780. b.full = dfixed_mul(b, crtc->hsc);
  781. c.full = dfixed_const(2);
  782. b.full = dfixed_div(b, c);
  783. consumption_time.full = dfixed_div(pclk, b);
  784. } else {
  785. consumption_time.full = pclk.full;
  786. }
  787. a.full = dfixed_const(1);
  788. wm->consumption_rate.full = dfixed_div(a, consumption_time);
  789. /* Determine line time
  790. * LineTime = total time for one line of displayhtotal
  791. * LineTime = total number of horizontal pixels
  792. * pclk = pixel clock period(ns)
  793. */
  794. a.full = dfixed_const(crtc->base.mode.crtc_htotal);
  795. line_time.full = dfixed_mul(a, pclk);
  796. /* Determine active time
  797. * ActiveTime = time of active region of display within one line,
  798. * hactive = total number of horizontal active pixels
  799. * htotal = total number of horizontal pixels
  800. */
  801. a.full = dfixed_const(crtc->base.mode.crtc_htotal);
  802. b.full = dfixed_const(crtc->base.mode.crtc_hdisplay);
  803. wm->active_time.full = dfixed_mul(line_time, b);
  804. wm->active_time.full = dfixed_div(wm->active_time, a);
  805. /* Determine chunk time
  806. * ChunkTime = the time it takes the DCP to send one chunk of data
  807. * to the LB which consists of pipeline delay and inter chunk gap
  808. * sclk = system clock(Mhz)
  809. */
  810. a.full = dfixed_const(600 * 1000);
  811. chunk_time.full = dfixed_div(a, rdev->pm.sclk);
  812. read_delay_latency.full = dfixed_const(1000);
  813. /* Determine the worst case latency
  814. * NumLinePair = Number of line pairs to request(1=2 lines, 2=4 lines)
  815. * WorstCaseLatency = worst case time from urgent to when the MC starts
  816. * to return data
  817. * READ_DELAY_IDLE_MAX = constant of 1us
  818. * ChunkTime = time it takes the DCP to send one chunk of data to the LB
  819. * which consists of pipeline delay and inter chunk gap
  820. */
  821. if (dfixed_trunc(wm->num_line_pair) > 1) {
  822. a.full = dfixed_const(3);
  823. wm->worst_case_latency.full = dfixed_mul(a, chunk_time);
  824. wm->worst_case_latency.full += read_delay_latency.full;
  825. } else {
  826. wm->worst_case_latency.full = chunk_time.full + read_delay_latency.full;
  827. }
  828. /* Determine the tolerable latency
  829. * TolerableLatency = Any given request has only 1 line time
  830. * for the data to be returned
  831. * LBRequestFifoDepth = Number of chunk requests the LB can
  832. * put into the request FIFO for a display
  833. * LineTime = total time for one line of display
  834. * ChunkTime = the time it takes the DCP to send one chunk
  835. * of data to the LB which consists of
  836. * pipeline delay and inter chunk gap
  837. */
  838. if ((2+wm->lb_request_fifo_depth) >= dfixed_trunc(request_fifo_depth)) {
  839. tolerable_latency.full = line_time.full;
  840. } else {
  841. tolerable_latency.full = dfixed_const(wm->lb_request_fifo_depth - 2);
  842. tolerable_latency.full = request_fifo_depth.full - tolerable_latency.full;
  843. tolerable_latency.full = dfixed_mul(tolerable_latency, chunk_time);
  844. tolerable_latency.full = line_time.full - tolerable_latency.full;
  845. }
  846. /* We assume worst case 32bits (4 bytes) */
  847. wm->dbpp.full = dfixed_const(2 * 16);
  848. /* Determine the maximum priority mark
  849. * width = viewport width in pixels
  850. */
  851. a.full = dfixed_const(16);
  852. wm->priority_mark_max.full = dfixed_const(crtc->base.mode.crtc_hdisplay);
  853. wm->priority_mark_max.full = dfixed_div(wm->priority_mark_max, a);
  854. wm->priority_mark_max.full = dfixed_ceil(wm->priority_mark_max);
  855. /* Determine estimated width */
  856. estimated_width.full = tolerable_latency.full - wm->worst_case_latency.full;
  857. estimated_width.full = dfixed_div(estimated_width, consumption_time);
  858. if (dfixed_trunc(estimated_width) > crtc->base.mode.crtc_hdisplay) {
  859. wm->priority_mark.full = wm->priority_mark_max.full;
  860. } else {
  861. a.full = dfixed_const(16);
  862. wm->priority_mark.full = dfixed_div(estimated_width, a);
  863. wm->priority_mark.full = dfixed_ceil(wm->priority_mark);
  864. wm->priority_mark.full = wm->priority_mark_max.full - wm->priority_mark.full;
  865. }
  866. }
  867. void rv515_bandwidth_avivo_update(struct radeon_device *rdev)
  868. {
  869. struct drm_display_mode *mode0 = NULL;
  870. struct drm_display_mode *mode1 = NULL;
  871. struct rv515_watermark wm0;
  872. struct rv515_watermark wm1;
  873. u32 tmp, d1mode_priority_a_cnt, d2mode_priority_a_cnt;
  874. fixed20_12 priority_mark02, priority_mark12, fill_rate;
  875. fixed20_12 a, b;
  876. if (rdev->mode_info.crtcs[0]->base.enabled)
  877. mode0 = &rdev->mode_info.crtcs[0]->base.mode;
  878. if (rdev->mode_info.crtcs[1]->base.enabled)
  879. mode1 = &rdev->mode_info.crtcs[1]->base.mode;
  880. rs690_line_buffer_adjust(rdev, mode0, mode1);
  881. rv515_crtc_bandwidth_compute(rdev, rdev->mode_info.crtcs[0], &wm0);
  882. rv515_crtc_bandwidth_compute(rdev, rdev->mode_info.crtcs[1], &wm1);
  883. tmp = wm0.lb_request_fifo_depth;
  884. tmp |= wm1.lb_request_fifo_depth << 16;
  885. WREG32(LB_MAX_REQ_OUTSTANDING, tmp);
  886. if (mode0 && mode1) {
  887. if (dfixed_trunc(wm0.dbpp) > 64)
  888. a.full = dfixed_div(wm0.dbpp, wm0.num_line_pair);
  889. else
  890. a.full = wm0.num_line_pair.full;
  891. if (dfixed_trunc(wm1.dbpp) > 64)
  892. b.full = dfixed_div(wm1.dbpp, wm1.num_line_pair);
  893. else
  894. b.full = wm1.num_line_pair.full;
  895. a.full += b.full;
  896. fill_rate.full = dfixed_div(wm0.sclk, a);
  897. if (wm0.consumption_rate.full > fill_rate.full) {
  898. b.full = wm0.consumption_rate.full - fill_rate.full;
  899. b.full = dfixed_mul(b, wm0.active_time);
  900. a.full = dfixed_const(16);
  901. b.full = dfixed_div(b, a);
  902. a.full = dfixed_mul(wm0.worst_case_latency,
  903. wm0.consumption_rate);
  904. priority_mark02.full = a.full + b.full;
  905. } else {
  906. a.full = dfixed_mul(wm0.worst_case_latency,
  907. wm0.consumption_rate);
  908. b.full = dfixed_const(16 * 1000);
  909. priority_mark02.full = dfixed_div(a, b);
  910. }
  911. if (wm1.consumption_rate.full > fill_rate.full) {
  912. b.full = wm1.consumption_rate.full - fill_rate.full;
  913. b.full = dfixed_mul(b, wm1.active_time);
  914. a.full = dfixed_const(16);
  915. b.full = dfixed_div(b, a);
  916. a.full = dfixed_mul(wm1.worst_case_latency,
  917. wm1.consumption_rate);
  918. priority_mark12.full = a.full + b.full;
  919. } else {
  920. a.full = dfixed_mul(wm1.worst_case_latency,
  921. wm1.consumption_rate);
  922. b.full = dfixed_const(16 * 1000);
  923. priority_mark12.full = dfixed_div(a, b);
  924. }
  925. if (wm0.priority_mark.full > priority_mark02.full)
  926. priority_mark02.full = wm0.priority_mark.full;
  927. if (dfixed_trunc(priority_mark02) < 0)
  928. priority_mark02.full = 0;
  929. if (wm0.priority_mark_max.full > priority_mark02.full)
  930. priority_mark02.full = wm0.priority_mark_max.full;
  931. if (wm1.priority_mark.full > priority_mark12.full)
  932. priority_mark12.full = wm1.priority_mark.full;
  933. if (dfixed_trunc(priority_mark12) < 0)
  934. priority_mark12.full = 0;
  935. if (wm1.priority_mark_max.full > priority_mark12.full)
  936. priority_mark12.full = wm1.priority_mark_max.full;
  937. d1mode_priority_a_cnt = dfixed_trunc(priority_mark02);
  938. d2mode_priority_a_cnt = dfixed_trunc(priority_mark12);
  939. if (rdev->disp_priority == 2) {
  940. d1mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  941. d2mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  942. }
  943. WREG32(D1MODE_PRIORITY_A_CNT, d1mode_priority_a_cnt);
  944. WREG32(D1MODE_PRIORITY_B_CNT, d1mode_priority_a_cnt);
  945. WREG32(D2MODE_PRIORITY_A_CNT, d2mode_priority_a_cnt);
  946. WREG32(D2MODE_PRIORITY_B_CNT, d2mode_priority_a_cnt);
  947. } else if (mode0) {
  948. if (dfixed_trunc(wm0.dbpp) > 64)
  949. a.full = dfixed_div(wm0.dbpp, wm0.num_line_pair);
  950. else
  951. a.full = wm0.num_line_pair.full;
  952. fill_rate.full = dfixed_div(wm0.sclk, a);
  953. if (wm0.consumption_rate.full > fill_rate.full) {
  954. b.full = wm0.consumption_rate.full - fill_rate.full;
  955. b.full = dfixed_mul(b, wm0.active_time);
  956. a.full = dfixed_const(16);
  957. b.full = dfixed_div(b, a);
  958. a.full = dfixed_mul(wm0.worst_case_latency,
  959. wm0.consumption_rate);
  960. priority_mark02.full = a.full + b.full;
  961. } else {
  962. a.full = dfixed_mul(wm0.worst_case_latency,
  963. wm0.consumption_rate);
  964. b.full = dfixed_const(16);
  965. priority_mark02.full = dfixed_div(a, b);
  966. }
  967. if (wm0.priority_mark.full > priority_mark02.full)
  968. priority_mark02.full = wm0.priority_mark.full;
  969. if (dfixed_trunc(priority_mark02) < 0)
  970. priority_mark02.full = 0;
  971. if (wm0.priority_mark_max.full > priority_mark02.full)
  972. priority_mark02.full = wm0.priority_mark_max.full;
  973. d1mode_priority_a_cnt = dfixed_trunc(priority_mark02);
  974. if (rdev->disp_priority == 2)
  975. d1mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  976. WREG32(D1MODE_PRIORITY_A_CNT, d1mode_priority_a_cnt);
  977. WREG32(D1MODE_PRIORITY_B_CNT, d1mode_priority_a_cnt);
  978. WREG32(D2MODE_PRIORITY_A_CNT, MODE_PRIORITY_OFF);
  979. WREG32(D2MODE_PRIORITY_B_CNT, MODE_PRIORITY_OFF);
  980. } else {
  981. if (dfixed_trunc(wm1.dbpp) > 64)
  982. a.full = dfixed_div(wm1.dbpp, wm1.num_line_pair);
  983. else
  984. a.full = wm1.num_line_pair.full;
  985. fill_rate.full = dfixed_div(wm1.sclk, a);
  986. if (wm1.consumption_rate.full > fill_rate.full) {
  987. b.full = wm1.consumption_rate.full - fill_rate.full;
  988. b.full = dfixed_mul(b, wm1.active_time);
  989. a.full = dfixed_const(16);
  990. b.full = dfixed_div(b, a);
  991. a.full = dfixed_mul(wm1.worst_case_latency,
  992. wm1.consumption_rate);
  993. priority_mark12.full = a.full + b.full;
  994. } else {
  995. a.full = dfixed_mul(wm1.worst_case_latency,
  996. wm1.consumption_rate);
  997. b.full = dfixed_const(16 * 1000);
  998. priority_mark12.full = dfixed_div(a, b);
  999. }
  1000. if (wm1.priority_mark.full > priority_mark12.full)
  1001. priority_mark12.full = wm1.priority_mark.full;
  1002. if (dfixed_trunc(priority_mark12) < 0)
  1003. priority_mark12.full = 0;
  1004. if (wm1.priority_mark_max.full > priority_mark12.full)
  1005. priority_mark12.full = wm1.priority_mark_max.full;
  1006. d2mode_priority_a_cnt = dfixed_trunc(priority_mark12);
  1007. if (rdev->disp_priority == 2)
  1008. d2mode_priority_a_cnt |= MODE_PRIORITY_ALWAYS_ON;
  1009. WREG32(D1MODE_PRIORITY_A_CNT, MODE_PRIORITY_OFF);
  1010. WREG32(D1MODE_PRIORITY_B_CNT, MODE_PRIORITY_OFF);
  1011. WREG32(D2MODE_PRIORITY_A_CNT, d2mode_priority_a_cnt);
  1012. WREG32(D2MODE_PRIORITY_B_CNT, d2mode_priority_a_cnt);
  1013. }
  1014. }
  1015. void rv515_bandwidth_update(struct radeon_device *rdev)
  1016. {
  1017. uint32_t tmp;
  1018. struct drm_display_mode *mode0 = NULL;
  1019. struct drm_display_mode *mode1 = NULL;
  1020. radeon_update_display_priority(rdev);
  1021. if (rdev->mode_info.crtcs[0]->base.enabled)
  1022. mode0 = &rdev->mode_info.crtcs[0]->base.mode;
  1023. if (rdev->mode_info.crtcs[1]->base.enabled)
  1024. mode1 = &rdev->mode_info.crtcs[1]->base.mode;
  1025. /*
  1026. * Set display0/1 priority up in the memory controller for
  1027. * modes if the user specifies HIGH for displaypriority
  1028. * option.
  1029. */
  1030. if ((rdev->disp_priority == 2) &&
  1031. (rdev->family == CHIP_RV515)) {
  1032. tmp = RREG32_MC(MC_MISC_LAT_TIMER);
  1033. tmp &= ~MC_DISP1R_INIT_LAT_MASK;
  1034. tmp &= ~MC_DISP0R_INIT_LAT_MASK;
  1035. if (mode1)
  1036. tmp |= (1 << MC_DISP1R_INIT_LAT_SHIFT);
  1037. if (mode0)
  1038. tmp |= (1 << MC_DISP0R_INIT_LAT_SHIFT);
  1039. WREG32_MC(MC_MISC_LAT_TIMER, tmp);
  1040. }
  1041. rv515_bandwidth_avivo_update(rdev);
  1042. }