via_dma.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742
  1. /* via_dma.c -- DMA support for the VIA Unichrome/Pro
  2. *
  3. * Copyright 2003 Tungsten Graphics, Inc., Cedar Park, Texas.
  4. * All Rights Reserved.
  5. *
  6. * Copyright 2004 Digeo, Inc., Palo Alto, CA, U.S.A.
  7. * All Rights Reserved.
  8. *
  9. * Copyright 2004 The Unichrome project.
  10. * All Rights Reserved.
  11. *
  12. * Permission is hereby granted, free of charge, to any person obtaining a
  13. * copy of this software and associated documentation files (the "Software"),
  14. * to deal in the Software without restriction, including without limitation
  15. * the rights to use, copy, modify, merge, publish, distribute, sub license,
  16. * and/or sell copies of the Software, and to permit persons to whom the
  17. * Software is furnished to do so, subject to the following conditions:
  18. *
  19. * The above copyright notice and this permission notice (including the
  20. * next paragraph) shall be included in all copies or substantial portions
  21. * of the Software.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  24. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  25. * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  26. * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
  27. * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  28. * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
  29. * USE OR OTHER DEALINGS IN THE SOFTWARE.
  30. *
  31. * Authors:
  32. * Tungsten Graphics,
  33. * Erdi Chen,
  34. * Thomas Hellstrom.
  35. */
  36. #include "drmP.h"
  37. #include "drm.h"
  38. #include "via_drm.h"
  39. #include "via_drv.h"
  40. #include "via_3d_reg.h"
  41. #define CMDBUF_ALIGNMENT_SIZE (0x100)
  42. #define CMDBUF_ALIGNMENT_MASK (0x0ff)
  43. /* defines for VIA 3D registers */
  44. #define VIA_REG_STATUS 0x400
  45. #define VIA_REG_TRANSET 0x43C
  46. #define VIA_REG_TRANSPACE 0x440
  47. /* VIA_REG_STATUS(0x400): Engine Status */
  48. #define VIA_CMD_RGTR_BUSY 0x00000080 /* Command Regulator is busy */
  49. #define VIA_2D_ENG_BUSY 0x00000001 /* 2D Engine is busy */
  50. #define VIA_3D_ENG_BUSY 0x00000002 /* 3D Engine is busy */
  51. #define VIA_VR_QUEUE_BUSY 0x00020000 /* Virtual Queue is busy */
  52. #define SetReg2DAGP(nReg, nData) { \
  53. *((uint32_t *)(vb)) = ((nReg) >> 2) | HALCYON_HEADER1; \
  54. *((uint32_t *)(vb) + 1) = (nData); \
  55. vb = ((uint32_t *)vb) + 2; \
  56. dev_priv->dma_low += 8; \
  57. }
  58. #define via_flush_write_combine() DRM_MEMORYBARRIER()
  59. #define VIA_OUT_RING_QW(w1, w2) do { \
  60. *vb++ = (w1); \
  61. *vb++ = (w2); \
  62. dev_priv->dma_low += 8; \
  63. } while (0)
  64. static void via_cmdbuf_start(drm_via_private_t *dev_priv);
  65. static void via_cmdbuf_pause(drm_via_private_t *dev_priv);
  66. static void via_cmdbuf_reset(drm_via_private_t *dev_priv);
  67. static void via_cmdbuf_rewind(drm_via_private_t *dev_priv);
  68. static int via_wait_idle(drm_via_private_t *dev_priv);
  69. static void via_pad_cache(drm_via_private_t *dev_priv, int qwords);
  70. /*
  71. * Free space in command buffer.
  72. */
  73. static uint32_t via_cmdbuf_space(drm_via_private_t *dev_priv)
  74. {
  75. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  76. uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
  77. return ((hw_addr <= dev_priv->dma_low) ?
  78. (dev_priv->dma_high + hw_addr - dev_priv->dma_low) :
  79. (hw_addr - dev_priv->dma_low));
  80. }
  81. /*
  82. * How much does the command regulator lag behind?
  83. */
  84. static uint32_t via_cmdbuf_lag(drm_via_private_t *dev_priv)
  85. {
  86. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  87. uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
  88. return ((hw_addr <= dev_priv->dma_low) ?
  89. (dev_priv->dma_low - hw_addr) :
  90. (dev_priv->dma_wrap + dev_priv->dma_low - hw_addr));
  91. }
  92. /*
  93. * Check that the given size fits in the buffer, otherwise wait.
  94. */
  95. static inline int
  96. via_cmdbuf_wait(drm_via_private_t *dev_priv, unsigned int size)
  97. {
  98. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  99. uint32_t cur_addr, hw_addr, next_addr;
  100. volatile uint32_t *hw_addr_ptr;
  101. uint32_t count;
  102. hw_addr_ptr = dev_priv->hw_addr_ptr;
  103. cur_addr = dev_priv->dma_low;
  104. next_addr = cur_addr + size + 512 * 1024;
  105. count = 1000000;
  106. do {
  107. hw_addr = *hw_addr_ptr - agp_base;
  108. if (count-- == 0) {
  109. DRM_ERROR
  110. ("via_cmdbuf_wait timed out hw %x cur_addr %x next_addr %x\n",
  111. hw_addr, cur_addr, next_addr);
  112. return -1;
  113. }
  114. if ((cur_addr < hw_addr) && (next_addr >= hw_addr))
  115. msleep(1);
  116. } while ((cur_addr < hw_addr) && (next_addr >= hw_addr));
  117. return 0;
  118. }
  119. /*
  120. * Checks whether buffer head has reach the end. Rewind the ring buffer
  121. * when necessary.
  122. *
  123. * Returns virtual pointer to ring buffer.
  124. */
  125. static inline uint32_t *via_check_dma(drm_via_private_t * dev_priv,
  126. unsigned int size)
  127. {
  128. if ((dev_priv->dma_low + size + 4 * CMDBUF_ALIGNMENT_SIZE) >
  129. dev_priv->dma_high) {
  130. via_cmdbuf_rewind(dev_priv);
  131. }
  132. if (via_cmdbuf_wait(dev_priv, size) != 0)
  133. return NULL;
  134. return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
  135. }
  136. int via_dma_cleanup(struct drm_device *dev)
  137. {
  138. if (dev->dev_private) {
  139. drm_via_private_t *dev_priv =
  140. (drm_via_private_t *) dev->dev_private;
  141. if (dev_priv->ring.virtual_start) {
  142. via_cmdbuf_reset(dev_priv);
  143. drm_core_ioremapfree(&dev_priv->ring.map, dev);
  144. dev_priv->ring.virtual_start = NULL;
  145. }
  146. }
  147. return 0;
  148. }
  149. static int via_initialize(struct drm_device *dev,
  150. drm_via_private_t *dev_priv,
  151. drm_via_dma_init_t *init)
  152. {
  153. if (!dev_priv || !dev_priv->mmio) {
  154. DRM_ERROR("via_dma_init called before via_map_init\n");
  155. return -EFAULT;
  156. }
  157. if (dev_priv->ring.virtual_start != NULL) {
  158. DRM_ERROR("called again without calling cleanup\n");
  159. return -EFAULT;
  160. }
  161. if (!dev->agp || !dev->agp->base) {
  162. DRM_ERROR("called with no agp memory available\n");
  163. return -EFAULT;
  164. }
  165. if (dev_priv->chipset == VIA_DX9_0) {
  166. DRM_ERROR("AGP DMA is not supported on this chip\n");
  167. return -EINVAL;
  168. }
  169. dev_priv->ring.map.offset = dev->agp->base + init->offset;
  170. dev_priv->ring.map.size = init->size;
  171. dev_priv->ring.map.type = 0;
  172. dev_priv->ring.map.flags = 0;
  173. dev_priv->ring.map.mtrr = 0;
  174. drm_core_ioremap(&dev_priv->ring.map, dev);
  175. if (dev_priv->ring.map.handle == NULL) {
  176. via_dma_cleanup(dev);
  177. DRM_ERROR("can not ioremap virtual address for"
  178. " ring buffer\n");
  179. return -ENOMEM;
  180. }
  181. dev_priv->ring.virtual_start = dev_priv->ring.map.handle;
  182. dev_priv->dma_ptr = dev_priv->ring.virtual_start;
  183. dev_priv->dma_low = 0;
  184. dev_priv->dma_high = init->size;
  185. dev_priv->dma_wrap = init->size;
  186. dev_priv->dma_offset = init->offset;
  187. dev_priv->last_pause_ptr = NULL;
  188. dev_priv->hw_addr_ptr =
  189. (volatile uint32_t *)((char *)dev_priv->mmio->handle +
  190. init->reg_pause_addr);
  191. via_cmdbuf_start(dev_priv);
  192. return 0;
  193. }
  194. static int via_dma_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
  195. {
  196. drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
  197. drm_via_dma_init_t *init = data;
  198. int retcode = 0;
  199. switch (init->func) {
  200. case VIA_INIT_DMA:
  201. if (!DRM_SUSER(DRM_CURPROC))
  202. retcode = -EPERM;
  203. else
  204. retcode = via_initialize(dev, dev_priv, init);
  205. break;
  206. case VIA_CLEANUP_DMA:
  207. if (!DRM_SUSER(DRM_CURPROC))
  208. retcode = -EPERM;
  209. else
  210. retcode = via_dma_cleanup(dev);
  211. break;
  212. case VIA_DMA_INITIALIZED:
  213. retcode = (dev_priv->ring.virtual_start != NULL) ?
  214. 0 : -EFAULT;
  215. break;
  216. default:
  217. retcode = -EINVAL;
  218. break;
  219. }
  220. return retcode;
  221. }
  222. static int via_dispatch_cmdbuffer(struct drm_device *dev, drm_via_cmdbuffer_t *cmd)
  223. {
  224. drm_via_private_t *dev_priv;
  225. uint32_t *vb;
  226. int ret;
  227. dev_priv = (drm_via_private_t *) dev->dev_private;
  228. if (dev_priv->ring.virtual_start == NULL) {
  229. DRM_ERROR("called without initializing AGP ring buffer.\n");
  230. return -EFAULT;
  231. }
  232. if (cmd->size > VIA_PCI_BUF_SIZE)
  233. return -ENOMEM;
  234. if (DRM_COPY_FROM_USER(dev_priv->pci_buf, cmd->buf, cmd->size))
  235. return -EFAULT;
  236. /*
  237. * Running this function on AGP memory is dead slow. Therefore
  238. * we run it on a temporary cacheable system memory buffer and
  239. * copy it to AGP memory when ready.
  240. */
  241. if ((ret =
  242. via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
  243. cmd->size, dev, 1))) {
  244. return ret;
  245. }
  246. vb = via_check_dma(dev_priv, (cmd->size < 0x100) ? 0x102 : cmd->size);
  247. if (vb == NULL)
  248. return -EAGAIN;
  249. memcpy(vb, dev_priv->pci_buf, cmd->size);
  250. dev_priv->dma_low += cmd->size;
  251. /*
  252. * Small submissions somehow stalls the CPU. (AGP cache effects?)
  253. * pad to greater size.
  254. */
  255. if (cmd->size < 0x100)
  256. via_pad_cache(dev_priv, (0x100 - cmd->size) >> 3);
  257. via_cmdbuf_pause(dev_priv);
  258. return 0;
  259. }
  260. int via_driver_dma_quiescent(struct drm_device *dev)
  261. {
  262. drm_via_private_t *dev_priv = dev->dev_private;
  263. if (!via_wait_idle(dev_priv))
  264. return -EBUSY;
  265. return 0;
  266. }
  267. static int via_flush_ioctl(struct drm_device *dev, void *data, struct drm_file *file_priv)
  268. {
  269. LOCK_TEST_WITH_RETURN(dev, file_priv);
  270. return via_driver_dma_quiescent(dev);
  271. }
  272. static int via_cmdbuffer(struct drm_device *dev, void *data, struct drm_file *file_priv)
  273. {
  274. drm_via_cmdbuffer_t *cmdbuf = data;
  275. int ret;
  276. LOCK_TEST_WITH_RETURN(dev, file_priv);
  277. DRM_DEBUG("buf %p size %lu\n", cmdbuf->buf, cmdbuf->size);
  278. ret = via_dispatch_cmdbuffer(dev, cmdbuf);
  279. return ret;
  280. }
  281. static int via_dispatch_pci_cmdbuffer(struct drm_device *dev,
  282. drm_via_cmdbuffer_t *cmd)
  283. {
  284. drm_via_private_t *dev_priv = dev->dev_private;
  285. int ret;
  286. if (cmd->size > VIA_PCI_BUF_SIZE)
  287. return -ENOMEM;
  288. if (DRM_COPY_FROM_USER(dev_priv->pci_buf, cmd->buf, cmd->size))
  289. return -EFAULT;
  290. if ((ret =
  291. via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
  292. cmd->size, dev, 0))) {
  293. return ret;
  294. }
  295. ret =
  296. via_parse_command_stream(dev, (const uint32_t *)dev_priv->pci_buf,
  297. cmd->size);
  298. return ret;
  299. }
  300. static int via_pci_cmdbuffer(struct drm_device *dev, void *data, struct drm_file *file_priv)
  301. {
  302. drm_via_cmdbuffer_t *cmdbuf = data;
  303. int ret;
  304. LOCK_TEST_WITH_RETURN(dev, file_priv);
  305. DRM_DEBUG("buf %p size %lu\n", cmdbuf->buf, cmdbuf->size);
  306. ret = via_dispatch_pci_cmdbuffer(dev, cmdbuf);
  307. return ret;
  308. }
  309. static inline uint32_t *via_align_buffer(drm_via_private_t *dev_priv,
  310. uint32_t * vb, int qw_count)
  311. {
  312. for (; qw_count > 0; --qw_count)
  313. VIA_OUT_RING_QW(HC_DUMMY, HC_DUMMY);
  314. return vb;
  315. }
  316. /*
  317. * This function is used internally by ring buffer management code.
  318. *
  319. * Returns virtual pointer to ring buffer.
  320. */
  321. static inline uint32_t *via_get_dma(drm_via_private_t *dev_priv)
  322. {
  323. return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
  324. }
  325. /*
  326. * Hooks a segment of data into the tail of the ring-buffer by
  327. * modifying the pause address stored in the buffer itself. If
  328. * the regulator has already paused, restart it.
  329. */
  330. static int via_hook_segment(drm_via_private_t *dev_priv,
  331. uint32_t pause_addr_hi, uint32_t pause_addr_lo,
  332. int no_pci_fire)
  333. {
  334. int paused, count;
  335. volatile uint32_t *paused_at = dev_priv->last_pause_ptr;
  336. uint32_t reader, ptr;
  337. uint32_t diff;
  338. paused = 0;
  339. via_flush_write_combine();
  340. (void) *(volatile uint32_t *)(via_get_dma(dev_priv) - 1);
  341. *paused_at = pause_addr_lo;
  342. via_flush_write_combine();
  343. (void) *paused_at;
  344. reader = *(dev_priv->hw_addr_ptr);
  345. ptr = ((volatile char *)paused_at - dev_priv->dma_ptr) +
  346. dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr + 4;
  347. dev_priv->last_pause_ptr = via_get_dma(dev_priv) - 1;
  348. /*
  349. * If there is a possibility that the command reader will
  350. * miss the new pause address and pause on the old one,
  351. * In that case we need to program the new start address
  352. * using PCI.
  353. */
  354. diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
  355. count = 10000000;
  356. while (diff == 0 && count--) {
  357. paused = (VIA_READ(0x41c) & 0x80000000);
  358. if (paused)
  359. break;
  360. reader = *(dev_priv->hw_addr_ptr);
  361. diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
  362. }
  363. paused = VIA_READ(0x41c) & 0x80000000;
  364. if (paused && !no_pci_fire) {
  365. reader = *(dev_priv->hw_addr_ptr);
  366. diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
  367. diff &= (dev_priv->dma_high - 1);
  368. if (diff != 0 && diff < (dev_priv->dma_high >> 1)) {
  369. DRM_ERROR("Paused at incorrect address. "
  370. "0x%08x, 0x%08x 0x%08x\n",
  371. ptr, reader, dev_priv->dma_diff);
  372. } else if (diff == 0) {
  373. /*
  374. * There is a concern that these writes may stall the PCI bus
  375. * if the GPU is not idle. However, idling the GPU first
  376. * doesn't make a difference.
  377. */
  378. VIA_WRITE(VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
  379. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_hi);
  380. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_lo);
  381. VIA_READ(VIA_REG_TRANSPACE);
  382. }
  383. }
  384. return paused;
  385. }
  386. static int via_wait_idle(drm_via_private_t *dev_priv)
  387. {
  388. int count = 10000000;
  389. while (!(VIA_READ(VIA_REG_STATUS) & VIA_VR_QUEUE_BUSY) && --count)
  390. ;
  391. while (count && (VIA_READ(VIA_REG_STATUS) &
  392. (VIA_CMD_RGTR_BUSY | VIA_2D_ENG_BUSY |
  393. VIA_3D_ENG_BUSY)))
  394. --count;
  395. return count;
  396. }
  397. static uint32_t *via_align_cmd(drm_via_private_t *dev_priv, uint32_t cmd_type,
  398. uint32_t addr, uint32_t *cmd_addr_hi,
  399. uint32_t *cmd_addr_lo, int skip_wait)
  400. {
  401. uint32_t agp_base;
  402. uint32_t cmd_addr, addr_lo, addr_hi;
  403. uint32_t *vb;
  404. uint32_t qw_pad_count;
  405. if (!skip_wait)
  406. via_cmdbuf_wait(dev_priv, 2 * CMDBUF_ALIGNMENT_SIZE);
  407. vb = via_get_dma(dev_priv);
  408. VIA_OUT_RING_QW(HC_HEADER2 | ((VIA_REG_TRANSET >> 2) << 12) |
  409. (VIA_REG_TRANSPACE >> 2), HC_ParaType_PreCR << 16);
  410. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  411. qw_pad_count = (CMDBUF_ALIGNMENT_SIZE >> 3) -
  412. ((dev_priv->dma_low & CMDBUF_ALIGNMENT_MASK) >> 3);
  413. cmd_addr = (addr) ? addr :
  414. agp_base + dev_priv->dma_low - 8 + (qw_pad_count << 3);
  415. addr_lo = ((HC_SubA_HAGPBpL << 24) | (cmd_type & HC_HAGPBpID_MASK) |
  416. (cmd_addr & HC_HAGPBpL_MASK));
  417. addr_hi = ((HC_SubA_HAGPBpH << 24) | (cmd_addr >> 24));
  418. vb = via_align_buffer(dev_priv, vb, qw_pad_count - 1);
  419. VIA_OUT_RING_QW(*cmd_addr_hi = addr_hi, *cmd_addr_lo = addr_lo);
  420. return vb;
  421. }
  422. static void via_cmdbuf_start(drm_via_private_t *dev_priv)
  423. {
  424. uint32_t pause_addr_lo, pause_addr_hi;
  425. uint32_t start_addr, start_addr_lo;
  426. uint32_t end_addr, end_addr_lo;
  427. uint32_t command;
  428. uint32_t agp_base;
  429. uint32_t ptr;
  430. uint32_t reader;
  431. int count;
  432. dev_priv->dma_low = 0;
  433. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  434. start_addr = agp_base;
  435. end_addr = agp_base + dev_priv->dma_high;
  436. start_addr_lo = ((HC_SubA_HAGPBstL << 24) | (start_addr & 0xFFFFFF));
  437. end_addr_lo = ((HC_SubA_HAGPBendL << 24) | (end_addr & 0xFFFFFF));
  438. command = ((HC_SubA_HAGPCMNT << 24) | (start_addr >> 24) |
  439. ((end_addr & 0xff000000) >> 16));
  440. dev_priv->last_pause_ptr =
  441. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0,
  442. &pause_addr_hi, &pause_addr_lo, 1) - 1;
  443. via_flush_write_combine();
  444. (void) *(volatile uint32_t *)dev_priv->last_pause_ptr;
  445. VIA_WRITE(VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
  446. VIA_WRITE(VIA_REG_TRANSPACE, command);
  447. VIA_WRITE(VIA_REG_TRANSPACE, start_addr_lo);
  448. VIA_WRITE(VIA_REG_TRANSPACE, end_addr_lo);
  449. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_hi);
  450. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_lo);
  451. DRM_WRITEMEMORYBARRIER();
  452. VIA_WRITE(VIA_REG_TRANSPACE, command | HC_HAGPCMNT_MASK);
  453. VIA_READ(VIA_REG_TRANSPACE);
  454. dev_priv->dma_diff = 0;
  455. count = 10000000;
  456. while (!(VIA_READ(0x41c) & 0x80000000) && count--);
  457. reader = *(dev_priv->hw_addr_ptr);
  458. ptr = ((volatile char *)dev_priv->last_pause_ptr - dev_priv->dma_ptr) +
  459. dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr + 4;
  460. /*
  461. * This is the difference between where we tell the
  462. * command reader to pause and where it actually pauses.
  463. * This differs between hw implementation so we need to
  464. * detect it.
  465. */
  466. dev_priv->dma_diff = ptr - reader;
  467. }
  468. static void via_pad_cache(drm_via_private_t *dev_priv, int qwords)
  469. {
  470. uint32_t *vb;
  471. via_cmdbuf_wait(dev_priv, qwords + 2);
  472. vb = via_get_dma(dev_priv);
  473. VIA_OUT_RING_QW(HC_HEADER2, HC_ParaType_NotTex << 16);
  474. via_align_buffer(dev_priv, vb, qwords);
  475. }
  476. static inline void via_dummy_bitblt(drm_via_private_t *dev_priv)
  477. {
  478. uint32_t *vb = via_get_dma(dev_priv);
  479. SetReg2DAGP(0x0C, (0 | (0 << 16)));
  480. SetReg2DAGP(0x10, 0 | (0 << 16));
  481. SetReg2DAGP(0x0, 0x1 | 0x2000 | 0xAA000000);
  482. }
  483. static void via_cmdbuf_jump(drm_via_private_t *dev_priv)
  484. {
  485. uint32_t agp_base;
  486. uint32_t pause_addr_lo, pause_addr_hi;
  487. uint32_t jump_addr_lo, jump_addr_hi;
  488. volatile uint32_t *last_pause_ptr;
  489. uint32_t dma_low_save1, dma_low_save2;
  490. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  491. via_align_cmd(dev_priv, HC_HAGPBpID_JUMP, 0, &jump_addr_hi,
  492. &jump_addr_lo, 0);
  493. dev_priv->dma_wrap = dev_priv->dma_low;
  494. /*
  495. * Wrap command buffer to the beginning.
  496. */
  497. dev_priv->dma_low = 0;
  498. if (via_cmdbuf_wait(dev_priv, CMDBUF_ALIGNMENT_SIZE) != 0)
  499. DRM_ERROR("via_cmdbuf_jump failed\n");
  500. via_dummy_bitblt(dev_priv);
  501. via_dummy_bitblt(dev_priv);
  502. last_pause_ptr =
  503. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  504. &pause_addr_lo, 0) - 1;
  505. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  506. &pause_addr_lo, 0);
  507. *last_pause_ptr = pause_addr_lo;
  508. dma_low_save1 = dev_priv->dma_low;
  509. /*
  510. * Now, set a trap that will pause the regulator if it tries to rerun the old
  511. * command buffer. (Which may happen if via_hook_segment detecs a command regulator pause
  512. * and reissues the jump command over PCI, while the regulator has already taken the jump
  513. * and actually paused at the current buffer end).
  514. * There appears to be no other way to detect this condition, since the hw_addr_pointer
  515. * does not seem to get updated immediately when a jump occurs.
  516. */
  517. last_pause_ptr =
  518. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  519. &pause_addr_lo, 0) - 1;
  520. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  521. &pause_addr_lo, 0);
  522. *last_pause_ptr = pause_addr_lo;
  523. dma_low_save2 = dev_priv->dma_low;
  524. dev_priv->dma_low = dma_low_save1;
  525. via_hook_segment(dev_priv, jump_addr_hi, jump_addr_lo, 0);
  526. dev_priv->dma_low = dma_low_save2;
  527. via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
  528. }
  529. static void via_cmdbuf_rewind(drm_via_private_t *dev_priv)
  530. {
  531. via_cmdbuf_jump(dev_priv);
  532. }
  533. static void via_cmdbuf_flush(drm_via_private_t *dev_priv, uint32_t cmd_type)
  534. {
  535. uint32_t pause_addr_lo, pause_addr_hi;
  536. via_align_cmd(dev_priv, cmd_type, 0, &pause_addr_hi, &pause_addr_lo, 0);
  537. via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
  538. }
  539. static void via_cmdbuf_pause(drm_via_private_t *dev_priv)
  540. {
  541. via_cmdbuf_flush(dev_priv, HC_HAGPBpID_PAUSE);
  542. }
  543. static void via_cmdbuf_reset(drm_via_private_t *dev_priv)
  544. {
  545. via_cmdbuf_flush(dev_priv, HC_HAGPBpID_STOP);
  546. via_wait_idle(dev_priv);
  547. }
  548. /*
  549. * User interface to the space and lag functions.
  550. */
  551. static int via_cmdbuf_size(struct drm_device *dev, void *data, struct drm_file *file_priv)
  552. {
  553. drm_via_cmdbuf_size_t *d_siz = data;
  554. int ret = 0;
  555. uint32_t tmp_size, count;
  556. drm_via_private_t *dev_priv;
  557. DRM_DEBUG("\n");
  558. LOCK_TEST_WITH_RETURN(dev, file_priv);
  559. dev_priv = (drm_via_private_t *) dev->dev_private;
  560. if (dev_priv->ring.virtual_start == NULL) {
  561. DRM_ERROR("called without initializing AGP ring buffer.\n");
  562. return -EFAULT;
  563. }
  564. count = 1000000;
  565. tmp_size = d_siz->size;
  566. switch (d_siz->func) {
  567. case VIA_CMDBUF_SPACE:
  568. while (((tmp_size = via_cmdbuf_space(dev_priv)) < d_siz->size)
  569. && --count) {
  570. if (!d_siz->wait)
  571. break;
  572. }
  573. if (!count) {
  574. DRM_ERROR("VIA_CMDBUF_SPACE timed out.\n");
  575. ret = -EAGAIN;
  576. }
  577. break;
  578. case VIA_CMDBUF_LAG:
  579. while (((tmp_size = via_cmdbuf_lag(dev_priv)) > d_siz->size)
  580. && --count) {
  581. if (!d_siz->wait)
  582. break;
  583. }
  584. if (!count) {
  585. DRM_ERROR("VIA_CMDBUF_LAG timed out.\n");
  586. ret = -EAGAIN;
  587. }
  588. break;
  589. default:
  590. ret = -EFAULT;
  591. }
  592. d_siz->size = tmp_size;
  593. return ret;
  594. }
  595. struct drm_ioctl_desc via_ioctls[] = {
  596. DRM_IOCTL_DEF_DRV(VIA_ALLOCMEM, via_mem_alloc, DRM_AUTH),
  597. DRM_IOCTL_DEF_DRV(VIA_FREEMEM, via_mem_free, DRM_AUTH),
  598. DRM_IOCTL_DEF_DRV(VIA_AGP_INIT, via_agp_init, DRM_AUTH|DRM_MASTER),
  599. DRM_IOCTL_DEF_DRV(VIA_FB_INIT, via_fb_init, DRM_AUTH|DRM_MASTER),
  600. DRM_IOCTL_DEF_DRV(VIA_MAP_INIT, via_map_init, DRM_AUTH|DRM_MASTER),
  601. DRM_IOCTL_DEF_DRV(VIA_DEC_FUTEX, via_decoder_futex, DRM_AUTH),
  602. DRM_IOCTL_DEF_DRV(VIA_DMA_INIT, via_dma_init, DRM_AUTH),
  603. DRM_IOCTL_DEF_DRV(VIA_CMDBUFFER, via_cmdbuffer, DRM_AUTH),
  604. DRM_IOCTL_DEF_DRV(VIA_FLUSH, via_flush_ioctl, DRM_AUTH),
  605. DRM_IOCTL_DEF_DRV(VIA_PCICMD, via_pci_cmdbuffer, DRM_AUTH),
  606. DRM_IOCTL_DEF_DRV(VIA_CMDBUF_SIZE, via_cmdbuf_size, DRM_AUTH),
  607. DRM_IOCTL_DEF_DRV(VIA_WAIT_IRQ, via_wait_irq, DRM_AUTH),
  608. DRM_IOCTL_DEF_DRV(VIA_DMA_BLIT, via_dma_blit, DRM_AUTH),
  609. DRM_IOCTL_DEF_DRV(VIA_BLIT_SYNC, via_dma_blit_sync, DRM_AUTH)
  610. };
  611. int via_max_ioctl = DRM_ARRAY_SIZE(via_ioctls);