via_dma.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744
  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) \
  60. *vb++ = (w1); \
  61. *vb++ = (w2); \
  62. dev_priv->dma_low += 8;
  63. static void via_cmdbuf_start(drm_via_private_t * dev_priv);
  64. static void via_cmdbuf_pause(drm_via_private_t * dev_priv);
  65. static void via_cmdbuf_reset(drm_via_private_t * dev_priv);
  66. static void via_cmdbuf_rewind(drm_via_private_t * dev_priv);
  67. static int via_wait_idle(drm_via_private_t * dev_priv);
  68. static void via_pad_cache(drm_via_private_t * dev_priv, int qwords);
  69. /*
  70. * Free space in command buffer.
  71. */
  72. static uint32_t via_cmdbuf_space(drm_via_private_t * dev_priv)
  73. {
  74. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  75. uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
  76. return ((hw_addr <= dev_priv->dma_low) ?
  77. (dev_priv->dma_high + hw_addr - dev_priv->dma_low) :
  78. (hw_addr - dev_priv->dma_low));
  79. }
  80. /*
  81. * How much does the command regulator lag behind?
  82. */
  83. static uint32_t via_cmdbuf_lag(drm_via_private_t * dev_priv)
  84. {
  85. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  86. uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
  87. return ((hw_addr <= dev_priv->dma_low) ?
  88. (dev_priv->dma_low - hw_addr) :
  89. (dev_priv->dma_wrap + dev_priv->dma_low - hw_addr));
  90. }
  91. /*
  92. * Check that the given size fits in the buffer, otherwise wait.
  93. */
  94. static inline int
  95. via_cmdbuf_wait(drm_via_private_t * dev_priv, unsigned int size)
  96. {
  97. uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  98. uint32_t cur_addr, hw_addr, next_addr;
  99. volatile uint32_t *hw_addr_ptr;
  100. uint32_t count;
  101. hw_addr_ptr = dev_priv->hw_addr_ptr;
  102. cur_addr = dev_priv->dma_low;
  103. next_addr = cur_addr + size + 512 * 1024;
  104. count = 1000000;
  105. do {
  106. hw_addr = *hw_addr_ptr - agp_base;
  107. if (count-- == 0) {
  108. DRM_ERROR
  109. ("via_cmdbuf_wait timed out hw %x cur_addr %x next_addr %x\n",
  110. hw_addr, cur_addr, next_addr);
  111. return -1;
  112. }
  113. } while ((cur_addr < hw_addr) && (next_addr >= hw_addr));
  114. return 0;
  115. }
  116. /*
  117. * Checks whether buffer head has reach the end. Rewind the ring buffer
  118. * when necessary.
  119. *
  120. * Returns virtual pointer to ring buffer.
  121. */
  122. static inline uint32_t *via_check_dma(drm_via_private_t * dev_priv,
  123. unsigned int size)
  124. {
  125. if ((dev_priv->dma_low + size + 4 * CMDBUF_ALIGNMENT_SIZE) >
  126. dev_priv->dma_high) {
  127. via_cmdbuf_rewind(dev_priv);
  128. }
  129. if (via_cmdbuf_wait(dev_priv, size) != 0) {
  130. return NULL;
  131. }
  132. return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
  133. }
  134. int via_dma_cleanup(drm_device_t * dev)
  135. {
  136. if (dev->dev_private) {
  137. drm_via_private_t *dev_priv =
  138. (drm_via_private_t *) dev->dev_private;
  139. if (dev_priv->ring.virtual_start) {
  140. via_cmdbuf_reset(dev_priv);
  141. drm_core_ioremapfree(&dev_priv->ring.map, dev);
  142. dev_priv->ring.virtual_start = NULL;
  143. }
  144. }
  145. return 0;
  146. }
  147. static int via_initialize(drm_device_t * dev,
  148. drm_via_private_t * dev_priv,
  149. drm_via_dma_init_t * init)
  150. {
  151. if (!dev_priv || !dev_priv->mmio) {
  152. DRM_ERROR("via_dma_init called before via_map_init\n");
  153. return DRM_ERR(EFAULT);
  154. }
  155. if (dev_priv->ring.virtual_start != NULL) {
  156. DRM_ERROR("%s called again without calling cleanup\n",
  157. __FUNCTION__);
  158. return DRM_ERR(EFAULT);
  159. }
  160. if (!dev->agp || !dev->agp->base) {
  161. DRM_ERROR("%s called with no agp memory available\n",
  162. __FUNCTION__);
  163. return DRM_ERR(EFAULT);
  164. }
  165. dev_priv->ring.map.offset = dev->agp->base + init->offset;
  166. dev_priv->ring.map.size = init->size;
  167. dev_priv->ring.map.type = 0;
  168. dev_priv->ring.map.flags = 0;
  169. dev_priv->ring.map.mtrr = 0;
  170. drm_core_ioremap(&dev_priv->ring.map, dev);
  171. if (dev_priv->ring.map.handle == NULL) {
  172. via_dma_cleanup(dev);
  173. DRM_ERROR("can not ioremap virtual address for"
  174. " ring buffer\n");
  175. return DRM_ERR(ENOMEM);
  176. }
  177. dev_priv->ring.virtual_start = dev_priv->ring.map.handle;
  178. dev_priv->dma_ptr = dev_priv->ring.virtual_start;
  179. dev_priv->dma_low = 0;
  180. dev_priv->dma_high = init->size;
  181. dev_priv->dma_wrap = init->size;
  182. dev_priv->dma_offset = init->offset;
  183. dev_priv->last_pause_ptr = NULL;
  184. dev_priv->hw_addr_ptr =
  185. (volatile uint32_t *)((char *)dev_priv->mmio->handle +
  186. init->reg_pause_addr);
  187. via_cmdbuf_start(dev_priv);
  188. return 0;
  189. }
  190. static int via_dma_init(DRM_IOCTL_ARGS)
  191. {
  192. DRM_DEVICE;
  193. drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
  194. drm_via_dma_init_t init;
  195. int retcode = 0;
  196. DRM_COPY_FROM_USER_IOCTL(init, (drm_via_dma_init_t __user *) data,
  197. sizeof(init));
  198. switch (init.func) {
  199. case VIA_INIT_DMA:
  200. if (!DRM_SUSER(DRM_CURPROC))
  201. retcode = DRM_ERR(EPERM);
  202. else
  203. retcode = via_initialize(dev, dev_priv, &init);
  204. break;
  205. case VIA_CLEANUP_DMA:
  206. if (!DRM_SUSER(DRM_CURPROC))
  207. retcode = DRM_ERR(EPERM);
  208. else
  209. retcode = via_dma_cleanup(dev);
  210. break;
  211. case VIA_DMA_INITIALIZED:
  212. retcode = (dev_priv->ring.virtual_start != NULL) ?
  213. 0 : DRM_ERR(EFAULT);
  214. break;
  215. default:
  216. retcode = DRM_ERR(EINVAL);
  217. break;
  218. }
  219. return retcode;
  220. }
  221. static int via_dispatch_cmdbuffer(drm_device_t * dev, drm_via_cmdbuffer_t * cmd)
  222. {
  223. drm_via_private_t *dev_priv;
  224. uint32_t *vb;
  225. int ret;
  226. dev_priv = (drm_via_private_t *) dev->dev_private;
  227. if (dev_priv->ring.virtual_start == NULL) {
  228. DRM_ERROR("%s called without initializing AGP ring buffer.\n",
  229. __FUNCTION__);
  230. return DRM_ERR(EFAULT);
  231. }
  232. if (cmd->size > VIA_PCI_BUF_SIZE) {
  233. return DRM_ERR(ENOMEM);
  234. }
  235. if (DRM_COPY_FROM_USER(dev_priv->pci_buf, cmd->buf, cmd->size))
  236. return DRM_ERR(EFAULT);
  237. /*
  238. * Running this function on AGP memory is dead slow. Therefore
  239. * we run it on a temporary cacheable system memory buffer and
  240. * copy it to AGP memory when ready.
  241. */
  242. if ((ret =
  243. via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
  244. cmd->size, dev, 1))) {
  245. return ret;
  246. }
  247. vb = via_check_dma(dev_priv, (cmd->size < 0x100) ? 0x102 : cmd->size);
  248. if (vb == NULL) {
  249. return DRM_ERR(EAGAIN);
  250. }
  251. memcpy(vb, dev_priv->pci_buf, cmd->size);
  252. dev_priv->dma_low += cmd->size;
  253. /*
  254. * Small submissions somehow stalls the CPU. (AGP cache effects?)
  255. * pad to greater size.
  256. */
  257. if (cmd->size < 0x100)
  258. via_pad_cache(dev_priv, (0x100 - cmd->size) >> 3);
  259. via_cmdbuf_pause(dev_priv);
  260. return 0;
  261. }
  262. int via_driver_dma_quiescent(drm_device_t * dev)
  263. {
  264. drm_via_private_t *dev_priv = dev->dev_private;
  265. if (!via_wait_idle(dev_priv)) {
  266. return DRM_ERR(EBUSY);
  267. }
  268. return 0;
  269. }
  270. static int via_flush_ioctl(DRM_IOCTL_ARGS)
  271. {
  272. DRM_DEVICE;
  273. LOCK_TEST_WITH_RETURN(dev, filp);
  274. return via_driver_dma_quiescent(dev);
  275. }
  276. static int via_cmdbuffer(DRM_IOCTL_ARGS)
  277. {
  278. DRM_DEVICE;
  279. drm_via_cmdbuffer_t cmdbuf;
  280. int ret;
  281. LOCK_TEST_WITH_RETURN(dev, filp);
  282. DRM_COPY_FROM_USER_IOCTL(cmdbuf, (drm_via_cmdbuffer_t __user *) data,
  283. sizeof(cmdbuf));
  284. DRM_DEBUG("via cmdbuffer, buf %p size %lu\n", cmdbuf.buf, cmdbuf.size);
  285. ret = via_dispatch_cmdbuffer(dev, &cmdbuf);
  286. if (ret) {
  287. return ret;
  288. }
  289. return 0;
  290. }
  291. static int via_dispatch_pci_cmdbuffer(drm_device_t * dev,
  292. drm_via_cmdbuffer_t * cmd)
  293. {
  294. drm_via_private_t *dev_priv = dev->dev_private;
  295. int ret;
  296. if (cmd->size > VIA_PCI_BUF_SIZE) {
  297. return DRM_ERR(ENOMEM);
  298. }
  299. if (DRM_COPY_FROM_USER(dev_priv->pci_buf, cmd->buf, cmd->size))
  300. return DRM_ERR(EFAULT);
  301. if ((ret =
  302. via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
  303. cmd->size, dev, 0))) {
  304. return ret;
  305. }
  306. ret =
  307. via_parse_command_stream(dev, (const uint32_t *)dev_priv->pci_buf,
  308. cmd->size);
  309. return ret;
  310. }
  311. static int via_pci_cmdbuffer(DRM_IOCTL_ARGS)
  312. {
  313. DRM_DEVICE;
  314. drm_via_cmdbuffer_t cmdbuf;
  315. int ret;
  316. LOCK_TEST_WITH_RETURN(dev, filp);
  317. DRM_COPY_FROM_USER_IOCTL(cmdbuf, (drm_via_cmdbuffer_t __user *) data,
  318. sizeof(cmdbuf));
  319. DRM_DEBUG("via_pci_cmdbuffer, buf %p size %lu\n", cmdbuf.buf,
  320. cmdbuf.size);
  321. ret = via_dispatch_pci_cmdbuffer(dev, &cmdbuf);
  322. if (ret) {
  323. return ret;
  324. }
  325. return 0;
  326. }
  327. static inline uint32_t *via_align_buffer(drm_via_private_t * dev_priv,
  328. uint32_t * vb, int qw_count)
  329. {
  330. for (; qw_count > 0; --qw_count) {
  331. VIA_OUT_RING_QW(HC_DUMMY, HC_DUMMY);
  332. }
  333. return vb;
  334. }
  335. /*
  336. * This function is used internally by ring buffer mangement code.
  337. *
  338. * Returns virtual pointer to ring buffer.
  339. */
  340. static inline uint32_t *via_get_dma(drm_via_private_t * dev_priv)
  341. {
  342. return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
  343. }
  344. /*
  345. * Hooks a segment of data into the tail of the ring-buffer by
  346. * modifying the pause address stored in the buffer itself. If
  347. * the regulator has already paused, restart it.
  348. */
  349. static int via_hook_segment(drm_via_private_t * dev_priv,
  350. uint32_t pause_addr_hi, uint32_t pause_addr_lo,
  351. int no_pci_fire)
  352. {
  353. int paused, count;
  354. volatile uint32_t *paused_at = dev_priv->last_pause_ptr;
  355. via_flush_write_combine();
  356. while (!*(via_get_dma(dev_priv) - 1)) ;
  357. *dev_priv->last_pause_ptr = pause_addr_lo;
  358. via_flush_write_combine();
  359. /*
  360. * The below statement is inserted to really force the flush.
  361. * Not sure it is needed.
  362. */
  363. while (!*dev_priv->last_pause_ptr) ;
  364. dev_priv->last_pause_ptr = via_get_dma(dev_priv) - 1;
  365. while (!*dev_priv->last_pause_ptr) ;
  366. paused = 0;
  367. count = 20;
  368. while (!(paused = (VIA_READ(0x41c) & 0x80000000)) && count--) ;
  369. if ((count <= 8) && (count >= 0)) {
  370. uint32_t rgtr, ptr;
  371. rgtr = *(dev_priv->hw_addr_ptr);
  372. ptr = ((volatile char *)dev_priv->last_pause_ptr -
  373. dev_priv->dma_ptr) + dev_priv->dma_offset +
  374. (uint32_t) dev_priv->agpAddr + 4 - CMDBUF_ALIGNMENT_SIZE;
  375. if (rgtr <= ptr) {
  376. DRM_ERROR
  377. ("Command regulator\npaused at count %d, address %x, "
  378. "while current pause address is %x.\n"
  379. "Please mail this message to "
  380. "<unichrome-devel@lists.sourceforge.net>\n", count,
  381. rgtr, ptr);
  382. }
  383. }
  384. if (paused && !no_pci_fire) {
  385. uint32_t rgtr, ptr;
  386. uint32_t ptr_low;
  387. count = 1000000;
  388. while ((VIA_READ(VIA_REG_STATUS) & VIA_CMD_RGTR_BUSY)
  389. && count--) ;
  390. rgtr = *(dev_priv->hw_addr_ptr);
  391. ptr = ((volatile char *)paused_at - dev_priv->dma_ptr) +
  392. dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr + 4;
  393. ptr_low = (ptr > 3 * CMDBUF_ALIGNMENT_SIZE) ?
  394. ptr - 3 * CMDBUF_ALIGNMENT_SIZE : 0;
  395. if (rgtr <= ptr && rgtr >= ptr_low) {
  396. VIA_WRITE(VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
  397. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_hi);
  398. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_lo);
  399. }
  400. }
  401. return paused;
  402. }
  403. static int via_wait_idle(drm_via_private_t * dev_priv)
  404. {
  405. int count = 10000000;
  406. while (count-- && (VIA_READ(VIA_REG_STATUS) &
  407. (VIA_CMD_RGTR_BUSY | VIA_2D_ENG_BUSY |
  408. VIA_3D_ENG_BUSY))) ;
  409. return count;
  410. }
  411. static uint32_t *via_align_cmd(drm_via_private_t * dev_priv, uint32_t cmd_type,
  412. uint32_t addr, uint32_t * cmd_addr_hi,
  413. uint32_t * cmd_addr_lo, int skip_wait)
  414. {
  415. uint32_t agp_base;
  416. uint32_t cmd_addr, addr_lo, addr_hi;
  417. uint32_t *vb;
  418. uint32_t qw_pad_count;
  419. if (!skip_wait)
  420. via_cmdbuf_wait(dev_priv, 2 * CMDBUF_ALIGNMENT_SIZE);
  421. vb = via_get_dma(dev_priv);
  422. VIA_OUT_RING_QW(HC_HEADER2 | ((VIA_REG_TRANSET >> 2) << 12) |
  423. (VIA_REG_TRANSPACE >> 2), HC_ParaType_PreCR << 16);
  424. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  425. qw_pad_count = (CMDBUF_ALIGNMENT_SIZE >> 3) -
  426. ((dev_priv->dma_low & CMDBUF_ALIGNMENT_MASK) >> 3);
  427. cmd_addr = (addr) ? addr :
  428. agp_base + dev_priv->dma_low - 8 + (qw_pad_count << 3);
  429. addr_lo = ((HC_SubA_HAGPBpL << 24) | (cmd_type & HC_HAGPBpID_MASK) |
  430. (cmd_addr & HC_HAGPBpL_MASK));
  431. addr_hi = ((HC_SubA_HAGPBpH << 24) | (cmd_addr >> 24));
  432. vb = via_align_buffer(dev_priv, vb, qw_pad_count - 1);
  433. VIA_OUT_RING_QW(*cmd_addr_hi = addr_hi, *cmd_addr_lo = addr_lo);
  434. return vb;
  435. }
  436. static void via_cmdbuf_start(drm_via_private_t * dev_priv)
  437. {
  438. uint32_t pause_addr_lo, pause_addr_hi;
  439. uint32_t start_addr, start_addr_lo;
  440. uint32_t end_addr, end_addr_lo;
  441. uint32_t command;
  442. uint32_t agp_base;
  443. dev_priv->dma_low = 0;
  444. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  445. start_addr = agp_base;
  446. end_addr = agp_base + dev_priv->dma_high;
  447. start_addr_lo = ((HC_SubA_HAGPBstL << 24) | (start_addr & 0xFFFFFF));
  448. end_addr_lo = ((HC_SubA_HAGPBendL << 24) | (end_addr & 0xFFFFFF));
  449. command = ((HC_SubA_HAGPCMNT << 24) | (start_addr >> 24) |
  450. ((end_addr & 0xff000000) >> 16));
  451. dev_priv->last_pause_ptr =
  452. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0,
  453. &pause_addr_hi, &pause_addr_lo, 1) - 1;
  454. via_flush_write_combine();
  455. while (!*dev_priv->last_pause_ptr) ;
  456. VIA_WRITE(VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
  457. VIA_WRITE(VIA_REG_TRANSPACE, command);
  458. VIA_WRITE(VIA_REG_TRANSPACE, start_addr_lo);
  459. VIA_WRITE(VIA_REG_TRANSPACE, end_addr_lo);
  460. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_hi);
  461. VIA_WRITE(VIA_REG_TRANSPACE, pause_addr_lo);
  462. VIA_WRITE(VIA_REG_TRANSPACE, command | HC_HAGPCMNT_MASK);
  463. }
  464. static void via_pad_cache(drm_via_private_t * dev_priv, int qwords)
  465. {
  466. uint32_t *vb;
  467. via_cmdbuf_wait(dev_priv, qwords + 2);
  468. vb = via_get_dma(dev_priv);
  469. VIA_OUT_RING_QW(HC_HEADER2, HC_ParaType_NotTex << 16);
  470. via_align_buffer(dev_priv, vb, qwords);
  471. }
  472. static inline void via_dummy_bitblt(drm_via_private_t * dev_priv)
  473. {
  474. uint32_t *vb = via_get_dma(dev_priv);
  475. SetReg2DAGP(0x0C, (0 | (0 << 16)));
  476. SetReg2DAGP(0x10, 0 | (0 << 16));
  477. SetReg2DAGP(0x0, 0x1 | 0x2000 | 0xAA000000);
  478. }
  479. static void via_cmdbuf_jump(drm_via_private_t * dev_priv)
  480. {
  481. uint32_t agp_base;
  482. uint32_t pause_addr_lo, pause_addr_hi;
  483. uint32_t jump_addr_lo, jump_addr_hi;
  484. volatile uint32_t *last_pause_ptr;
  485. uint32_t dma_low_save1, dma_low_save2;
  486. agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
  487. via_align_cmd(dev_priv, HC_HAGPBpID_JUMP, 0, &jump_addr_hi,
  488. &jump_addr_lo, 0);
  489. dev_priv->dma_wrap = dev_priv->dma_low;
  490. /*
  491. * Wrap command buffer to the beginning.
  492. */
  493. dev_priv->dma_low = 0;
  494. if (via_cmdbuf_wait(dev_priv, CMDBUF_ALIGNMENT_SIZE) != 0) {
  495. DRM_ERROR("via_cmdbuf_jump failed\n");
  496. }
  497. via_dummy_bitblt(dev_priv);
  498. via_dummy_bitblt(dev_priv);
  499. last_pause_ptr =
  500. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  501. &pause_addr_lo, 0) - 1;
  502. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  503. &pause_addr_lo, 0);
  504. *last_pause_ptr = pause_addr_lo;
  505. dma_low_save1 = dev_priv->dma_low;
  506. /*
  507. * Now, set a trap that will pause the regulator if it tries to rerun the old
  508. * command buffer. (Which may happen if via_hook_segment detecs a command regulator pause
  509. * and reissues the jump command over PCI, while the regulator has already taken the jump
  510. * and actually paused at the current buffer end).
  511. * There appears to be no other way to detect this condition, since the hw_addr_pointer
  512. * does not seem to get updated immediately when a jump occurs.
  513. */
  514. last_pause_ptr =
  515. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  516. &pause_addr_lo, 0) - 1;
  517. via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
  518. &pause_addr_lo, 0);
  519. *last_pause_ptr = pause_addr_lo;
  520. dma_low_save2 = dev_priv->dma_low;
  521. dev_priv->dma_low = dma_low_save1;
  522. via_hook_segment(dev_priv, jump_addr_hi, jump_addr_lo, 0);
  523. dev_priv->dma_low = dma_low_save2;
  524. via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
  525. }
  526. static void via_cmdbuf_rewind(drm_via_private_t * dev_priv)
  527. {
  528. via_cmdbuf_jump(dev_priv);
  529. }
  530. static void via_cmdbuf_flush(drm_via_private_t * dev_priv, uint32_t cmd_type)
  531. {
  532. uint32_t pause_addr_lo, pause_addr_hi;
  533. via_align_cmd(dev_priv, cmd_type, 0, &pause_addr_hi, &pause_addr_lo, 0);
  534. via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
  535. }
  536. static void via_cmdbuf_pause(drm_via_private_t * dev_priv)
  537. {
  538. via_cmdbuf_flush(dev_priv, HC_HAGPBpID_PAUSE);
  539. }
  540. static void via_cmdbuf_reset(drm_via_private_t * dev_priv)
  541. {
  542. via_cmdbuf_flush(dev_priv, HC_HAGPBpID_STOP);
  543. via_wait_idle(dev_priv);
  544. }
  545. /*
  546. * User interface to the space and lag functions.
  547. */
  548. static int via_cmdbuf_size(DRM_IOCTL_ARGS)
  549. {
  550. DRM_DEVICE;
  551. drm_via_cmdbuf_size_t d_siz;
  552. int ret = 0;
  553. uint32_t tmp_size, count;
  554. drm_via_private_t *dev_priv;
  555. DRM_DEBUG("via cmdbuf_size\n");
  556. LOCK_TEST_WITH_RETURN(dev, filp);
  557. dev_priv = (drm_via_private_t *) dev->dev_private;
  558. if (dev_priv->ring.virtual_start == NULL) {
  559. DRM_ERROR("%s called without initializing AGP ring buffer.\n",
  560. __FUNCTION__);
  561. return DRM_ERR(EFAULT);
  562. }
  563. DRM_COPY_FROM_USER_IOCTL(d_siz, (drm_via_cmdbuf_size_t __user *) data,
  564. sizeof(d_siz));
  565. count = 1000000;
  566. tmp_size = d_siz.size;
  567. switch (d_siz.func) {
  568. case VIA_CMDBUF_SPACE:
  569. while (((tmp_size = via_cmdbuf_space(dev_priv)) < d_siz.size)
  570. && count--) {
  571. if (!d_siz.wait) {
  572. break;
  573. }
  574. }
  575. if (!count) {
  576. DRM_ERROR("VIA_CMDBUF_SPACE timed out.\n");
  577. ret = DRM_ERR(EAGAIN);
  578. }
  579. break;
  580. case VIA_CMDBUF_LAG:
  581. while (((tmp_size = via_cmdbuf_lag(dev_priv)) > d_siz.size)
  582. && count--) {
  583. if (!d_siz.wait) {
  584. break;
  585. }
  586. }
  587. if (!count) {
  588. DRM_ERROR("VIA_CMDBUF_LAG timed out.\n");
  589. ret = DRM_ERR(EAGAIN);
  590. }
  591. break;
  592. default:
  593. ret = DRM_ERR(EFAULT);
  594. }
  595. d_siz.size = tmp_size;
  596. DRM_COPY_TO_USER_IOCTL((drm_via_cmdbuf_size_t __user *) data, d_siz,
  597. sizeof(d_siz));
  598. return ret;
  599. }
  600. drm_ioctl_desc_t via_ioctls[] = {
  601. [DRM_IOCTL_NR(DRM_VIA_ALLOCMEM)] = {via_mem_alloc, DRM_AUTH},
  602. [DRM_IOCTL_NR(DRM_VIA_FREEMEM)] = {via_mem_free, DRM_AUTH},
  603. [DRM_IOCTL_NR(DRM_VIA_AGP_INIT)] = {via_agp_init, DRM_AUTH|DRM_MASTER},
  604. [DRM_IOCTL_NR(DRM_VIA_FB_INIT)] = {via_fb_init, DRM_AUTH|DRM_MASTER},
  605. [DRM_IOCTL_NR(DRM_VIA_MAP_INIT)] = {via_map_init, DRM_AUTH|DRM_MASTER},
  606. [DRM_IOCTL_NR(DRM_VIA_DEC_FUTEX)] = {via_decoder_futex, DRM_AUTH},
  607. [DRM_IOCTL_NR(DRM_VIA_DMA_INIT)] = {via_dma_init, DRM_AUTH},
  608. [DRM_IOCTL_NR(DRM_VIA_CMDBUFFER)] = {via_cmdbuffer, DRM_AUTH},
  609. [DRM_IOCTL_NR(DRM_VIA_FLUSH)] = {via_flush_ioctl, DRM_AUTH},
  610. [DRM_IOCTL_NR(DRM_VIA_PCICMD)] = {via_pci_cmdbuffer, DRM_AUTH},
  611. [DRM_IOCTL_NR(DRM_VIA_CMDBUF_SIZE)] = {via_cmdbuf_size, DRM_AUTH},
  612. [DRM_IOCTL_NR(DRM_VIA_WAIT_IRQ)] = {via_wait_irq, DRM_AUTH},
  613. [DRM_IOCTL_NR(DRM_VIA_DMA_BLIT)] = {via_dma_blit, DRM_AUTH},
  614. [DRM_IOCTL_NR(DRM_VIA_BLIT_SYNC)] = {via_dma_blit_sync, DRM_AUTH}
  615. };
  616. int via_max_ioctl = DRM_ARRAY_SIZE(via_ioctls);