1203288Srnoland/* via_dmablit.c -- PCI DMA BitBlt support for the VIA Unichrome/Pro 2203288Srnoland * 3203288Srnoland * Copyright (C) 2005 Thomas Hellstrom, All Rights Reserved. 4203288Srnoland * 5203288Srnoland * Permission is hereby granted, free of charge, to any person obtaining a 6203288Srnoland * copy of this software and associated documentation files (the "Software"), 7203288Srnoland * to deal in the Software without restriction, including without limitation 8203288Srnoland * the rights to use, copy, modify, merge, publish, distribute, sub license, 9203288Srnoland * and/or sell copies of the Software, and to permit persons to whom the 10203288Srnoland * Software is furnished to do so, subject to the following conditions: 11203288Srnoland * 12203288Srnoland * The above copyright notice and this permission notice (including the 13203288Srnoland * next paragraph) shall be included in all copies or substantial portions 14203288Srnoland * of the Software. 15203288Srnoland * 16203288Srnoland * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17203288Srnoland * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18203288Srnoland * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL 19203288Srnoland * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, 20203288Srnoland * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR 21203288Srnoland * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE 22203288Srnoland * USE OR OTHER DEALINGS IN THE SOFTWARE. 23203288Srnoland * 24203288Srnoland * Authors: 25203288Srnoland * Thomas Hellstrom. 26203288Srnoland * Partially based on code obtained from Digeo Inc. 27203288Srnoland */ 28203288Srnoland 29203288Srnoland#include <sys/cdefs.h> 30203288Srnoland__FBSDID("$FreeBSD$"); 31203288Srnoland 32203288Srnoland/* 33203288Srnoland * Unmaps the DMA mappings. 34203288Srnoland * FIXME: Is this a NoOp on x86? Also 35203288Srnoland * FIXME: What happens if this one is called and a pending blit has previously done 36203288Srnoland * the same DMA mappings? 37203288Srnoland */ 38203288Srnoland 39203288Srnoland#include "dev/drm/drmP.h" 40203288Srnoland#include "dev/drm/via_drm.h" 41203288Srnoland#include "dev/drm/via_drv.h" 42203288Srnoland#include "dev/drm/via_dmablit.h" 43203288Srnoland 44203288Srnoland#define VIA_PGDN(x) (((unsigned long)(x)) & ~PAGE_MASK) 45203288Srnoland#define VIA_PGOFF(x) (((unsigned long)(x)) & PAGE_MASK) 46203288Srnoland#define VIA_PFN(x) ((unsigned long)(x) >> PAGE_SHIFT) 47203288Srnoland 48203288Srnolandtypedef struct _drm_via_descriptor { 49203288Srnoland uint32_t mem_addr; 50203288Srnoland uint32_t dev_addr; 51203288Srnoland uint32_t size; 52203288Srnoland uint32_t next; 53203288Srnoland} drm_via_descriptor_t; 54203288Srnoland 55203288Srnolandstatic void via_dmablit_timer(void *arg); 56203288Srnoland 57203288Srnoland/* 58203288Srnoland * Unmap a DMA mapping. 59203288Srnoland */ 60203288Srnolandstatic void 61203288Srnolandvia_unmap_blit_from_device(drm_via_sg_info_t *vsg) 62203288Srnoland{ 63203288Srnoland int num_desc = vsg->num_desc; 64203288Srnoland unsigned cur_descriptor_page = num_desc / vsg->descriptors_per_page; 65203288Srnoland unsigned descriptor_this_page = num_desc % vsg->descriptors_per_page; 66203288Srnoland drm_via_descriptor_t *desc_ptr = vsg->desc_pages[cur_descriptor_page] + 67203288Srnoland descriptor_this_page; 68203288Srnoland dma_addr_t next = vsg->chain_start; 69203288Srnoland 70203288Srnoland while(num_desc--) { 71203288Srnoland if (descriptor_this_page-- == 0) { 72203288Srnoland cur_descriptor_page--; 73203288Srnoland descriptor_this_page = vsg->descriptors_per_page - 1; 74203288Srnoland desc_ptr = vsg->desc_pages[cur_descriptor_page] + 75203288Srnoland descriptor_this_page; 76203288Srnoland } 77203288Srnoland next = (dma_addr_t) desc_ptr->next; 78203288Srnoland desc_ptr--; 79203288Srnoland } 80203288Srnoland} 81203288Srnoland 82203288Srnoland 83203288Srnoland/* 84203288Srnoland * If mode = 0, count how many descriptors are needed. 85203288Srnoland * If mode = 1, Map the DMA pages for the device, put together and map also the descriptors. 86203288Srnoland * Descriptors are run in reverse order by the hardware because we are not allowed to update the 87203288Srnoland * 'next' field without syncing calls when the descriptor is already mapped. 88203288Srnoland */ 89203288Srnolandstatic void 90203288Srnolandvia_map_blit_for_device(const drm_via_dmablit_t *xfer, 91203288Srnoland drm_via_sg_info_t *vsg, int mode) 92203288Srnoland{ 93203288Srnoland unsigned cur_descriptor_page = 0; 94203288Srnoland unsigned num_descriptors_this_page = 0; 95203288Srnoland unsigned char *mem_addr = xfer->mem_addr; 96203288Srnoland unsigned char *cur_mem; 97203288Srnoland unsigned char *first_addr = (unsigned char *)VIA_PGDN(mem_addr); 98203288Srnoland uint32_t fb_addr = xfer->fb_addr; 99203288Srnoland uint32_t cur_fb; 100203288Srnoland unsigned long line_len; 101203288Srnoland unsigned remaining_len; 102203288Srnoland int num_desc = 0; 103203288Srnoland int cur_line; 104203288Srnoland dma_addr_t next = 0 | VIA_DMA_DPR_EC; 105203288Srnoland drm_via_descriptor_t *desc_ptr = NULL; 106203288Srnoland 107203288Srnoland if (mode == 1) 108203288Srnoland desc_ptr = vsg->desc_pages[cur_descriptor_page]; 109203288Srnoland 110203288Srnoland for (cur_line = 0; cur_line < xfer->num_lines; ++cur_line) { 111203288Srnoland 112203288Srnoland line_len = xfer->line_length; 113203288Srnoland cur_fb = fb_addr; 114203288Srnoland cur_mem = mem_addr; 115203288Srnoland 116203288Srnoland while (line_len > 0) { 117203288Srnoland 118203288Srnoland remaining_len = min(PAGE_SIZE - VIA_PGOFF(cur_mem), 119203288Srnoland line_len); 120203288Srnoland line_len -= remaining_len; 121203288Srnoland 122203288Srnoland if (mode == 1) { 123203288Srnoland desc_ptr->mem_addr = 124203288Srnoland VM_PAGE_TO_PHYS( 125203288Srnoland vsg->pages[VIA_PFN(cur_mem) - 126203288Srnoland VIA_PFN(first_addr)]) + VIA_PGOFF(cur_mem); 127203288Srnoland desc_ptr->dev_addr = cur_fb; 128203288Srnoland 129203288Srnoland desc_ptr->size = remaining_len; 130203288Srnoland desc_ptr->next = (uint32_t) next; 131203288Srnoland 132203288Srnoland next = vtophys(desc_ptr); 133203288Srnoland 134203288Srnoland desc_ptr++; 135203288Srnoland if (++num_descriptors_this_page >= vsg->descriptors_per_page) { 136203288Srnoland num_descriptors_this_page = 0; 137203288Srnoland desc_ptr = vsg->desc_pages[++cur_descriptor_page]; 138203288Srnoland } 139203288Srnoland } 140203288Srnoland 141203288Srnoland num_desc++; 142203288Srnoland cur_mem += remaining_len; 143203288Srnoland cur_fb += remaining_len; 144203288Srnoland } 145203288Srnoland 146203288Srnoland mem_addr += xfer->mem_stride; 147203288Srnoland fb_addr += xfer->fb_stride; 148203288Srnoland } 149203288Srnoland 150203288Srnoland if (mode == 1) { 151203288Srnoland vsg->chain_start = next; 152203288Srnoland vsg->state = dr_via_device_mapped; 153203288Srnoland } 154203288Srnoland vsg->num_desc = num_desc; 155203288Srnoland} 156203288Srnoland 157203288Srnoland 158203288Srnoland/* 159203288Srnoland * Function that frees up all resources for a blit. It is usable even if the 160203288Srnoland * blit info has only been partially built as long as the status enum is consistent 161203288Srnoland * with the actual status of the used resources. 162203288Srnoland */ 163203288Srnolandstatic void 164203288Srnolandvia_free_sg_info(drm_via_sg_info_t *vsg) 165203288Srnoland{ 166203288Srnoland vm_page_t page; 167203288Srnoland int i; 168203288Srnoland 169203288Srnoland switch(vsg->state) { 170203288Srnoland case dr_via_device_mapped: 171203288Srnoland via_unmap_blit_from_device(vsg); 172203288Srnoland case dr_via_desc_pages_alloc: 173203288Srnoland for (i=0; i<vsg->num_desc_pages; ++i) { 174203288Srnoland if (vsg->desc_pages[i] != NULL) 175203288Srnoland free(vsg->desc_pages[i], DRM_MEM_PAGES); 176203288Srnoland } 177203288Srnoland free(vsg->desc_pages, DRM_MEM_DRIVER); 178203288Srnoland case dr_via_pages_locked: 179203288Srnoland for (i=0; i < vsg->num_pages; ++i) { 180216699Salc page = vsg->pages[i]; 181216699Salc vm_page_lock(page); 182216699Salc vm_page_unwire(page, 0); 183216699Salc vm_page_unlock(page); 184203288Srnoland } 185203288Srnoland case dr_via_pages_alloc: 186203288Srnoland free(vsg->pages, DRM_MEM_DRIVER); 187203288Srnoland default: 188203288Srnoland vsg->state = dr_via_sg_init; 189203288Srnoland } 190203288Srnoland free(vsg->bounce_buffer, DRM_MEM_DRIVER); 191203288Srnoland vsg->bounce_buffer = NULL; 192203288Srnoland vsg->free_on_sequence = 0; 193203288Srnoland} 194203288Srnoland 195203288Srnoland 196203288Srnoland/* 197203288Srnoland * Fire a blit engine. 198203288Srnoland */ 199203288Srnolandstatic void 200203288Srnolandvia_fire_dmablit(struct drm_device *dev, drm_via_sg_info_t *vsg, int engine) 201203288Srnoland{ 202203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 203203288Srnoland 204203288Srnoland VIA_WRITE(VIA_PCI_DMA_MAR0 + engine*0x10, 0); 205203288Srnoland VIA_WRITE(VIA_PCI_DMA_DAR0 + engine*0x10, 0); 206203288Srnoland VIA_WRITE(VIA_PCI_DMA_CSR0 + engine*0x04, VIA_DMA_CSR_DD | VIA_DMA_CSR_TD | 207203288Srnoland VIA_DMA_CSR_DE); 208203288Srnoland VIA_WRITE(VIA_PCI_DMA_MR0 + engine*0x04, VIA_DMA_MR_CM | VIA_DMA_MR_TDIE); 209203288Srnoland VIA_WRITE(VIA_PCI_DMA_BCR0 + engine*0x10, 0); 210203288Srnoland VIA_WRITE(VIA_PCI_DMA_DPR0 + engine*0x10, vsg->chain_start); 211203288Srnoland DRM_WRITEMEMORYBARRIER(); 212203288Srnoland VIA_WRITE(VIA_PCI_DMA_CSR0 + engine*0x04, VIA_DMA_CSR_DE | VIA_DMA_CSR_TS); 213203288Srnoland VIA_READ(VIA_PCI_DMA_CSR0 + engine*0x04); 214203288Srnoland} 215203288Srnoland 216203288Srnoland 217203288Srnoland/* 218203288Srnoland * Obtain a page pointer array and lock all pages into system memory. A segmentation violation will 219203288Srnoland * occur here if the calling user does not have access to the submitted address. 220203288Srnoland */ 221203288Srnolandstatic int 222203288Srnolandvia_lock_all_dma_pages(drm_via_sg_info_t *vsg, drm_via_dmablit_t *xfer) 223203288Srnoland{ 224203288Srnoland unsigned long first_pfn = VIA_PFN(xfer->mem_addr); 225203288Srnoland vm_page_t m; 226203288Srnoland int i; 227203288Srnoland 228203288Srnoland vsg->num_pages = VIA_PFN(xfer->mem_addr + 229203288Srnoland (xfer->num_lines * xfer->mem_stride -1)) - first_pfn + 1; 230203288Srnoland 231203288Srnoland if (NULL == (vsg->pages = malloc(sizeof(vm_page_t) * vsg->num_pages, 232216699Salc DRM_MEM_DRIVER, M_NOWAIT))) 233203288Srnoland return -ENOMEM; 234203288Srnoland 235216699Salc vsg->state = dr_via_pages_alloc; 236216699Salc 237216699Salc if (vm_fault_quick_hold_pages(&curproc->p_vmspace->vm_map, 238216699Salc (vm_offset_t)xfer->mem_addr, vsg->num_pages * PAGE_SIZE, 239216699Salc VM_PROT_READ | VM_PROT_WRITE, vsg->pages, vsg->num_pages) < 0) 240216699Salc return -EACCES; 241216699Salc 242216699Salc for (i = 0; i < vsg->num_pages; i++) { 243216699Salc m = vsg->pages[i]; 244207410Skmacy vm_page_lock(m); 245203288Srnoland vm_page_wire(m); 246203288Srnoland vm_page_unhold(m); 247207410Skmacy vm_page_unlock(m); 248203288Srnoland } 249203288Srnoland vsg->state = dr_via_pages_locked; 250203288Srnoland 251203288Srnoland DRM_DEBUG("DMA pages locked\n"); 252203288Srnoland 253203288Srnoland return 0; 254203288Srnoland} 255203288Srnoland 256203288Srnoland 257203288Srnoland/* 258203288Srnoland * Allocate DMA capable memory for the blit descriptor chain, and an array that keeps track of the 259203288Srnoland * pages we allocate. We don't want to use kmalloc for the descriptor chain because it may be 260203288Srnoland * quite large for some blits, and pages don't need to be contingous. 261203288Srnoland */ 262203288Srnolandstatic int 263203288Srnolandvia_alloc_desc_pages(drm_via_sg_info_t *vsg) 264203288Srnoland{ 265203288Srnoland int i; 266203288Srnoland 267203288Srnoland vsg->descriptors_per_page = PAGE_SIZE / sizeof(drm_via_descriptor_t); 268203288Srnoland vsg->num_desc_pages = (vsg->num_desc + vsg->descriptors_per_page - 1) / 269203288Srnoland vsg->descriptors_per_page; 270203288Srnoland 271203288Srnoland if (NULL == (vsg->desc_pages = malloc(vsg->num_desc_pages * 272203288Srnoland sizeof(void *), DRM_MEM_DRIVER, M_NOWAIT | M_ZERO))) 273203288Srnoland return -ENOMEM; 274203288Srnoland 275203288Srnoland vsg->state = dr_via_desc_pages_alloc; 276203288Srnoland for (i = 0; i < vsg->num_desc_pages; ++i) { 277203288Srnoland if (NULL == (vsg->desc_pages[i] = 278203288Srnoland (drm_via_descriptor_t *)malloc(PAGE_SIZE, DRM_MEM_PAGES, 279203288Srnoland M_NOWAIT | M_ZERO))) 280203288Srnoland return -ENOMEM; 281203288Srnoland } 282203288Srnoland DRM_DEBUG("Allocated %d pages for %d descriptors.\n", 283203288Srnoland vsg->num_desc_pages, vsg->num_desc); 284203288Srnoland 285203288Srnoland return 0; 286203288Srnoland} 287203288Srnoland 288203288Srnoland 289203288Srnolandstatic void 290203288Srnolandvia_abort_dmablit(struct drm_device *dev, int engine) 291203288Srnoland{ 292203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 293203288Srnoland 294203288Srnoland VIA_WRITE(VIA_PCI_DMA_CSR0 + engine*0x04, VIA_DMA_CSR_TA); 295203288Srnoland} 296203288Srnoland 297203288Srnoland 298203288Srnolandstatic void 299203288Srnolandvia_dmablit_engine_off(struct drm_device *dev, int engine) 300203288Srnoland{ 301203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 302203288Srnoland 303203288Srnoland VIA_WRITE(VIA_PCI_DMA_CSR0 + engine*0x04, VIA_DMA_CSR_TD | VIA_DMA_CSR_DD); 304203288Srnoland} 305203288Srnoland 306203288Srnoland 307203288Srnoland/* 308203288Srnoland * The dmablit part of the IRQ handler. Trying to do only reasonably fast things here. 309203288Srnoland * The rest, like unmapping and freeing memory for done blits is done in a separate workqueue 310203288Srnoland * task. Basically the task of the interrupt handler is to submit a new blit to the engine, while 311203288Srnoland * the workqueue task takes care of processing associated with the old blit. 312203288Srnoland */ 313203288Srnolandvoid 314203288Srnolandvia_dmablit_handler(struct drm_device *dev, int engine, int from_irq) 315203288Srnoland{ 316203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 317203288Srnoland drm_via_blitq_t *blitq = dev_priv->blit_queues + engine; 318203288Srnoland int cur; 319203288Srnoland int done_transfer; 320203288Srnoland uint32_t status = 0; 321203288Srnoland 322203288Srnoland DRM_DEBUG("DMA blit handler called. engine = %d, from_irq = %d, blitq = 0x%lx\n", 323203288Srnoland engine, from_irq, (unsigned long) blitq); 324203288Srnoland 325203288Srnoland mtx_lock(&blitq->blit_lock); 326203288Srnoland 327203288Srnoland done_transfer = blitq->is_active && 328203288Srnoland (( status = VIA_READ(VIA_PCI_DMA_CSR0 + engine*0x04)) & VIA_DMA_CSR_TD); 329203288Srnoland done_transfer = done_transfer || ( blitq->aborting && !(status & VIA_DMA_CSR_DE)); 330203288Srnoland 331203288Srnoland cur = blitq->cur; 332203288Srnoland if (done_transfer) { 333203288Srnoland 334203288Srnoland blitq->blits[cur]->aborted = blitq->aborting; 335203288Srnoland blitq->done_blit_handle++; 336203288Srnoland DRM_WAKEUP(&blitq->blit_queue[cur]); 337203288Srnoland 338203288Srnoland cur++; 339203288Srnoland if (cur >= VIA_NUM_BLIT_SLOTS) 340203288Srnoland cur = 0; 341203288Srnoland blitq->cur = cur; 342203288Srnoland 343203288Srnoland /* 344203288Srnoland * Clear transfer done flag. 345203288Srnoland */ 346203288Srnoland 347203288Srnoland VIA_WRITE(VIA_PCI_DMA_CSR0 + engine*0x04, VIA_DMA_CSR_TD); 348203288Srnoland 349203288Srnoland blitq->is_active = 0; 350203288Srnoland blitq->aborting = 0; 351203288Srnoland 352203288Srnoland taskqueue_enqueue(taskqueue_swi, &blitq->wq); 353203288Srnoland 354203288Srnoland } else if (blitq->is_active && (ticks >= blitq->end)) { 355203288Srnoland 356203288Srnoland /* 357203288Srnoland * Abort transfer after one second. 358203288Srnoland */ 359203288Srnoland 360203288Srnoland via_abort_dmablit(dev, engine); 361203288Srnoland blitq->aborting = 1; 362203288Srnoland blitq->end = ticks + DRM_HZ; 363203288Srnoland } 364203288Srnoland 365203288Srnoland if (!blitq->is_active) { 366203288Srnoland if (blitq->num_outstanding) { 367203288Srnoland via_fire_dmablit(dev, blitq->blits[cur], engine); 368203288Srnoland blitq->is_active = 1; 369203288Srnoland blitq->cur = cur; 370203288Srnoland blitq->num_outstanding--; 371203288Srnoland blitq->end = ticks + DRM_HZ; 372203288Srnoland 373203288Srnoland if (!callout_pending(&blitq->poll_timer)) 374203288Srnoland callout_reset(&blitq->poll_timer, 375203288Srnoland 1, (timeout_t *)via_dmablit_timer, 376203288Srnoland (void *)blitq); 377203288Srnoland } else { 378203288Srnoland if (callout_pending(&blitq->poll_timer)) { 379203288Srnoland callout_stop(&blitq->poll_timer); 380203288Srnoland } 381203288Srnoland via_dmablit_engine_off(dev, engine); 382203288Srnoland } 383203288Srnoland } 384203288Srnoland 385203288Srnoland mtx_unlock(&blitq->blit_lock); 386203288Srnoland} 387203288Srnoland 388203288Srnoland 389203288Srnoland/* 390203288Srnoland * Check whether this blit is still active, performing necessary locking. 391203288Srnoland */ 392203288Srnolandstatic int 393203288Srnolandvia_dmablit_active(drm_via_blitq_t *blitq, int engine, uint32_t handle, wait_queue_head_t **queue) 394203288Srnoland{ 395203288Srnoland uint32_t slot; 396203288Srnoland int active; 397203288Srnoland 398203288Srnoland mtx_lock(&blitq->blit_lock); 399203288Srnoland 400203288Srnoland /* 401203288Srnoland * Allow for handle wraparounds. 402203288Srnoland */ 403203288Srnoland active = ((blitq->done_blit_handle - handle) > (1 << 23)) && 404203288Srnoland ((blitq->cur_blit_handle - handle) <= (1 << 23)); 405203288Srnoland 406203288Srnoland if (queue && active) { 407203288Srnoland slot = handle - blitq->done_blit_handle + blitq->cur -1; 408203288Srnoland if (slot >= VIA_NUM_BLIT_SLOTS) { 409203288Srnoland slot -= VIA_NUM_BLIT_SLOTS; 410203288Srnoland } 411203288Srnoland *queue = blitq->blit_queue + slot; 412203288Srnoland } 413203288Srnoland 414203288Srnoland mtx_unlock(&blitq->blit_lock); 415203288Srnoland 416203288Srnoland return active; 417203288Srnoland} 418203288Srnoland 419203288Srnoland 420203288Srnoland/* 421203288Srnoland * Sync. Wait for at least three seconds for the blit to be performed. 422203288Srnoland */ 423203288Srnolandstatic int 424203288Srnolandvia_dmablit_sync(struct drm_device *dev, uint32_t handle, int engine) 425203288Srnoland{ 426203288Srnoland 427203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 428203288Srnoland drm_via_blitq_t *blitq = dev_priv->blit_queues + engine; 429203288Srnoland wait_queue_head_t *queue; 430203288Srnoland int ret = 0; 431203288Srnoland 432203288Srnoland if (via_dmablit_active(blitq, engine, handle, &queue)) { 433203288Srnoland DRM_WAIT_ON(ret, *queue, 3 * DRM_HZ, 434203288Srnoland !via_dmablit_active(blitq, engine, handle, NULL)); 435203288Srnoland } 436203288Srnoland DRM_DEBUG("DMA blit sync handle 0x%x engine %d returned %d\n", 437203288Srnoland handle, engine, ret); 438203288Srnoland 439203288Srnoland return ret; 440203288Srnoland} 441203288Srnoland 442203288Srnoland 443203288Srnoland/* 444203288Srnoland * A timer that regularly polls the blit engine in cases where we don't have interrupts: 445203288Srnoland * a) Broken hardware (typically those that don't have any video capture facility). 446203288Srnoland * b) Blit abort. The hardware doesn't send an interrupt when a blit is aborted. 447203288Srnoland * The timer and hardware IRQ's can and do work in parallel. If the hardware has 448203288Srnoland * irqs, it will shorten the latency somewhat. 449203288Srnoland */ 450203288Srnolandstatic void 451203288Srnolandvia_dmablit_timer(void *arg) 452203288Srnoland{ 453203288Srnoland drm_via_blitq_t *blitq = (drm_via_blitq_t *)arg; 454203288Srnoland struct drm_device *dev = blitq->dev; 455203288Srnoland int engine = (int) 456203288Srnoland (blitq - ((drm_via_private_t *)dev->dev_private)->blit_queues); 457203288Srnoland 458203288Srnoland DRM_DEBUG("Polling timer called for engine %d, jiffies %lu\n", engine, 459203288Srnoland (unsigned long) jiffies); 460203288Srnoland 461203288Srnoland via_dmablit_handler(dev, engine, 0); 462203288Srnoland 463203288Srnoland if (!callout_pending(&blitq->poll_timer)) { 464203288Srnoland callout_schedule(&blitq->poll_timer, 1); 465203288Srnoland 466203288Srnoland /* 467203288Srnoland * Rerun handler to delete timer if engines are off, and 468203288Srnoland * to shorten abort latency. This is a little nasty. 469203288Srnoland */ 470203288Srnoland 471203288Srnoland via_dmablit_handler(dev, engine, 0); 472203288Srnoland 473203288Srnoland } 474203288Srnoland} 475203288Srnoland 476203288Srnoland 477203288Srnoland/* 478203288Srnoland * Workqueue task that frees data and mappings associated with a blit. 479203288Srnoland * Also wakes up waiting processes. Each of these tasks handles one 480203288Srnoland * blit engine only and may not be called on each interrupt. 481203288Srnoland */ 482203288Srnolandstatic void 483203288Srnolandvia_dmablit_workqueue(void *arg, int pending) 484203288Srnoland{ 485203288Srnoland drm_via_blitq_t *blitq = (drm_via_blitq_t *)arg; 486203288Srnoland struct drm_device *dev = blitq->dev; 487203288Srnoland drm_via_sg_info_t *cur_sg; 488203288Srnoland int cur_released; 489203288Srnoland 490203288Srnoland 491203288Srnoland DRM_DEBUG("task called for blit engine %ld\n",(unsigned long) 492203288Srnoland (blitq - ((drm_via_private_t *)dev->dev_private)->blit_queues)); 493203288Srnoland 494203288Srnoland mtx_lock(&blitq->blit_lock); 495203288Srnoland 496203288Srnoland while(blitq->serviced != blitq->cur) { 497203288Srnoland 498203288Srnoland cur_released = blitq->serviced++; 499203288Srnoland 500203288Srnoland DRM_DEBUG("Releasing blit slot %d\n", cur_released); 501203288Srnoland 502203288Srnoland if (blitq->serviced >= VIA_NUM_BLIT_SLOTS) 503203288Srnoland blitq->serviced = 0; 504203288Srnoland 505203288Srnoland cur_sg = blitq->blits[cur_released]; 506203288Srnoland blitq->num_free++; 507203288Srnoland 508203288Srnoland mtx_unlock(&blitq->blit_lock); 509203288Srnoland 510203288Srnoland DRM_WAKEUP(&blitq->busy_queue); 511203288Srnoland 512203288Srnoland via_free_sg_info(cur_sg); 513203288Srnoland free(cur_sg, DRM_MEM_DRIVER); 514203288Srnoland 515203288Srnoland mtx_lock(&blitq->blit_lock); 516203288Srnoland } 517203288Srnoland 518203288Srnoland mtx_unlock(&blitq->blit_lock); 519203288Srnoland} 520203288Srnoland 521203288Srnoland 522203288Srnoland/* 523203288Srnoland * Init all blit engines. Currently we use two, but some hardware have 4. 524203288Srnoland */ 525203288Srnolandvoid 526203288Srnolandvia_init_dmablit(struct drm_device *dev) 527203288Srnoland{ 528203288Srnoland int i,j; 529203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 530203288Srnoland drm_via_blitq_t *blitq; 531203288Srnoland 532203288Srnoland for (i=0; i< VIA_NUM_BLIT_ENGINES; ++i) { 533203288Srnoland blitq = dev_priv->blit_queues + i; 534203288Srnoland blitq->dev = dev; 535203288Srnoland blitq->cur_blit_handle = 0; 536203288Srnoland blitq->done_blit_handle = 0; 537203288Srnoland blitq->head = 0; 538203288Srnoland blitq->cur = 0; 539203288Srnoland blitq->serviced = 0; 540203288Srnoland blitq->num_free = VIA_NUM_BLIT_SLOTS - 1; 541203288Srnoland blitq->num_outstanding = 0; 542203288Srnoland blitq->is_active = 0; 543203288Srnoland blitq->aborting = 0; 544203288Srnoland mtx_init(&blitq->blit_lock, "via_blit_lk", NULL, MTX_DEF); 545203288Srnoland for (j=0; j<VIA_NUM_BLIT_SLOTS; ++j) { 546203288Srnoland DRM_INIT_WAITQUEUE(blitq->blit_queue + j); 547203288Srnoland } 548203288Srnoland DRM_INIT_WAITQUEUE(&blitq->busy_queue); 549203288Srnoland TASK_INIT(&blitq->wq, 0, via_dmablit_workqueue, blitq); 550203288Srnoland callout_init(&blitq->poll_timer, 0); 551203288Srnoland } 552203288Srnoland} 553203288Srnoland 554203288Srnoland 555203288Srnoland/* 556203288Srnoland * Build all info and do all mappings required for a blit. 557203288Srnoland */ 558203288Srnolandstatic int 559203288Srnolandvia_build_sg_info(struct drm_device *dev, drm_via_sg_info_t *vsg, 560203288Srnoland drm_via_dmablit_t *xfer) 561203288Srnoland{ 562203288Srnoland int ret = 0; 563203288Srnoland 564203288Srnoland vsg->bounce_buffer = NULL; 565203288Srnoland 566203288Srnoland vsg->state = dr_via_sg_init; 567203288Srnoland 568203288Srnoland if (xfer->num_lines <= 0 || xfer->line_length <= 0) { 569203288Srnoland DRM_ERROR("Zero size bitblt.\n"); 570203288Srnoland return -EINVAL; 571203288Srnoland } 572203288Srnoland 573203288Srnoland /* 574203288Srnoland * Below check is a driver limitation, not a hardware one. We 575203288Srnoland * don't want to lock unused pages, and don't want to incoporate the 576203288Srnoland * extra logic of avoiding them. Make sure there are no. 577203288Srnoland * (Not a big limitation anyway.) 578203288Srnoland */ 579203288Srnoland if ((xfer->mem_stride - xfer->line_length) > 2 * PAGE_SIZE) { 580203288Srnoland DRM_ERROR("Too large system memory stride. Stride: %d, " 581203288Srnoland "Length: %d\n", xfer->mem_stride, xfer->line_length); 582203288Srnoland return -EINVAL; 583203288Srnoland } 584203288Srnoland 585203288Srnoland if ((xfer->mem_stride == xfer->line_length) && 586203288Srnoland (xfer->fb_stride == xfer->line_length)) { 587203288Srnoland xfer->mem_stride *= xfer->num_lines; 588203288Srnoland xfer->line_length = xfer->mem_stride; 589203288Srnoland xfer->fb_stride = xfer->mem_stride; 590203288Srnoland xfer->num_lines = 1; 591203288Srnoland } 592203288Srnoland 593203288Srnoland /* 594203288Srnoland * Don't lock an arbitrary large number of pages, since that causes a 595203288Srnoland * DOS security hole. 596203288Srnoland */ 597203288Srnoland if (xfer->num_lines > 2048 || 598203288Srnoland (xfer->num_lines*xfer->mem_stride > (2048*2048*4))) { 599203288Srnoland DRM_ERROR("Too large PCI DMA bitblt.\n"); 600203288Srnoland return -EINVAL; 601203288Srnoland } 602203288Srnoland 603203288Srnoland /* 604203288Srnoland * we allow a negative fb stride to allow flipping of images in 605203288Srnoland * transfer. 606203288Srnoland */ 607203288Srnoland if (xfer->mem_stride < xfer->line_length || 608203288Srnoland abs(xfer->fb_stride) < xfer->line_length) { 609203288Srnoland DRM_ERROR("Invalid frame-buffer / memory stride.\n"); 610203288Srnoland return -EINVAL; 611203288Srnoland } 612203288Srnoland 613203288Srnoland /* 614203288Srnoland * A hardware bug seems to be worked around if system memory addresses 615203288Srnoland * start on 16 byte boundaries. This seems a bit restrictive however. 616203288Srnoland * VIA is contacted about this. Meanwhile, impose the following 617203288Srnoland * restrictions: 618203288Srnoland */ 619203288Srnoland#ifdef VIA_BUGFREE 620203288Srnoland if ((((unsigned long)xfer->mem_addr & 3) != 621203288Srnoland ((unsigned long)xfer->fb_addr & 3)) || 622203288Srnoland ((xfer->num_lines > 1) && ((xfer->mem_stride & 3) != 623203288Srnoland (xfer->fb_stride & 3)))) { 624203288Srnoland DRM_ERROR("Invalid DRM bitblt alignment.\n"); 625203288Srnoland return -EINVAL; 626203288Srnoland } 627203288Srnoland#else 628203288Srnoland if ((((unsigned long)xfer->mem_addr & 15) || 629203288Srnoland ((unsigned long)xfer->fb_addr & 3)) || 630203288Srnoland ((xfer->num_lines > 1) && 631203288Srnoland ((xfer->mem_stride & 15) || (xfer->fb_stride & 3)))) { 632203288Srnoland DRM_ERROR("Invalid DRM bitblt alignment.\n"); 633203288Srnoland return -EINVAL; 634203288Srnoland } 635203288Srnoland#endif 636203288Srnoland 637203288Srnoland if (0 != (ret = via_lock_all_dma_pages(vsg, xfer))) { 638203288Srnoland DRM_ERROR("Could not lock DMA pages.\n"); 639203288Srnoland via_free_sg_info(vsg); 640203288Srnoland return ret; 641203288Srnoland } 642203288Srnoland 643203288Srnoland via_map_blit_for_device(xfer, vsg, 0); 644203288Srnoland if (0 != (ret = via_alloc_desc_pages(vsg))) { 645203288Srnoland DRM_ERROR("Could not allocate DMA descriptor pages.\n"); 646203288Srnoland via_free_sg_info(vsg); 647203288Srnoland return ret; 648203288Srnoland } 649203288Srnoland via_map_blit_for_device(xfer, vsg, 1); 650203288Srnoland 651203288Srnoland return 0; 652203288Srnoland} 653203288Srnoland 654203288Srnoland 655203288Srnoland/* 656203288Srnoland * Reserve one free slot in the blit queue. Will wait for one second for one 657203288Srnoland * to become available. Otherwise -EBUSY is returned. 658203288Srnoland */ 659203288Srnolandstatic int 660203288Srnolandvia_dmablit_grab_slot(drm_via_blitq_t *blitq, int engine) 661203288Srnoland{ 662203288Srnoland struct drm_device *dev = blitq->dev; 663203288Srnoland int ret=0; 664203288Srnoland 665203288Srnoland DRM_DEBUG("Num free is %d\n", blitq->num_free); 666203288Srnoland mtx_lock(&blitq->blit_lock); 667203288Srnoland while(blitq->num_free == 0) { 668203288Srnoland mtx_unlock(&blitq->blit_lock); 669203288Srnoland 670203288Srnoland DRM_WAIT_ON(ret, blitq->busy_queue, DRM_HZ, 671203288Srnoland blitq->num_free > 0); 672203288Srnoland if (ret) { 673203288Srnoland return (-EINTR == ret) ? -EAGAIN : ret; 674203288Srnoland } 675203288Srnoland 676203288Srnoland mtx_lock(&blitq->blit_lock); 677203288Srnoland } 678203288Srnoland 679203288Srnoland blitq->num_free--; 680203288Srnoland mtx_unlock(&blitq->blit_lock); 681203288Srnoland 682203288Srnoland return 0; 683203288Srnoland} 684203288Srnoland 685203288Srnoland 686203288Srnoland/* 687203288Srnoland * Hand back a free slot if we changed our mind. 688203288Srnoland */ 689203288Srnolandstatic void 690203288Srnolandvia_dmablit_release_slot(drm_via_blitq_t *blitq) 691203288Srnoland{ 692203288Srnoland 693203288Srnoland mtx_lock(&blitq->blit_lock); 694203288Srnoland blitq->num_free++; 695203288Srnoland mtx_unlock(&blitq->blit_lock); 696203288Srnoland DRM_WAKEUP( &blitq->busy_queue ); 697203288Srnoland} 698203288Srnoland 699203288Srnoland 700203288Srnoland/* 701203288Srnoland * Grab a free slot. Build blit info and queue a blit. 702203288Srnoland */ 703203288Srnolandstatic int 704203288Srnolandvia_dmablit(struct drm_device *dev, drm_via_dmablit_t *xfer) 705203288Srnoland{ 706203288Srnoland drm_via_private_t *dev_priv = (drm_via_private_t *)dev->dev_private; 707203288Srnoland drm_via_sg_info_t *vsg; 708203288Srnoland drm_via_blitq_t *blitq; 709203288Srnoland int ret; 710203288Srnoland int engine; 711203288Srnoland 712203288Srnoland if (dev_priv == NULL) { 713203288Srnoland DRM_ERROR("Called without initialization.\n"); 714203288Srnoland return -EINVAL; 715203288Srnoland } 716203288Srnoland 717203288Srnoland engine = (xfer->to_fb) ? 0 : 1; 718203288Srnoland blitq = dev_priv->blit_queues + engine; 719203288Srnoland if (0 != (ret = via_dmablit_grab_slot(blitq, engine))) { 720203288Srnoland return ret; 721203288Srnoland } 722203288Srnoland if (NULL == (vsg = malloc(sizeof(*vsg), DRM_MEM_DRIVER, 723203288Srnoland M_NOWAIT | M_ZERO))) { 724203288Srnoland via_dmablit_release_slot(blitq); 725203288Srnoland return -ENOMEM; 726203288Srnoland } 727203288Srnoland if (0 != (ret = via_build_sg_info(dev, vsg, xfer))) { 728203288Srnoland via_dmablit_release_slot(blitq); 729203288Srnoland free(vsg, DRM_MEM_DRIVER); 730203288Srnoland return ret; 731203288Srnoland } 732203288Srnoland mtx_lock(&blitq->blit_lock); 733203288Srnoland 734203288Srnoland blitq->blits[blitq->head++] = vsg; 735203288Srnoland if (blitq->head >= VIA_NUM_BLIT_SLOTS) 736203288Srnoland blitq->head = 0; 737203288Srnoland blitq->num_outstanding++; 738203288Srnoland xfer->sync.sync_handle = ++blitq->cur_blit_handle; 739203288Srnoland 740203288Srnoland mtx_unlock(&blitq->blit_lock); 741203288Srnoland xfer->sync.engine = engine; 742203288Srnoland 743203288Srnoland via_dmablit_handler(dev, engine, 0); 744203288Srnoland 745203288Srnoland return 0; 746203288Srnoland} 747203288Srnoland 748203288Srnoland 749203288Srnoland/* 750203288Srnoland * Sync on a previously submitted blit. Note that the X server use signals 751203288Srnoland * extensively, and that there is a very big probability that this IOCTL will 752203288Srnoland * be interrupted by a signal. In that case it returns with -EAGAIN for the 753203288Srnoland * signal to be delivered. The caller should then reissue the IOCTL. This is 754203288Srnoland * similar to what is being done for drmGetLock(). 755203288Srnoland */ 756203288Srnolandint 757203288Srnolandvia_dma_blit_sync( struct drm_device *dev, void *data, 758203288Srnoland struct drm_file *file_priv ) 759203288Srnoland{ 760203288Srnoland drm_via_blitsync_t *sync = data; 761203288Srnoland int err; 762203288Srnoland 763203288Srnoland if (sync->engine >= VIA_NUM_BLIT_ENGINES) 764203288Srnoland return -EINVAL; 765203288Srnoland 766203288Srnoland err = via_dmablit_sync(dev, sync->sync_handle, sync->engine); 767203288Srnoland 768203288Srnoland if (-EINTR == err) 769203288Srnoland err = -EAGAIN; 770203288Srnoland 771203288Srnoland return err; 772203288Srnoland} 773203288Srnoland 774203288Srnoland 775203288Srnoland/* 776203288Srnoland * Queue a blit and hand back a handle to be used for sync. This IOCTL may be 777203288Srnoland * interrupted by a signal while waiting for a free slot in the blit queue. 778203288Srnoland * In that case it returns with -EAGAIN and should be reissued. See the above 779203288Srnoland * IOCTL code. 780203288Srnoland */ 781203288Srnolandint 782203288Srnolandvia_dma_blit( struct drm_device *dev, void *data, struct drm_file *file_priv ) 783203288Srnoland{ 784203288Srnoland drm_via_dmablit_t *xfer = data; 785203288Srnoland int err; 786203288Srnoland 787203288Srnoland err = via_dmablit(dev, xfer); 788203288Srnoland 789203288Srnoland return err; 790203288Srnoland} 791