ALSA: ctxfi - Support SG-buffers
[linux-2.6.git] / sound / pci / ctxfi / ctvmem.c
index 74a03623d047ae2b51b8e17c5dc3daec77a05ad4..b7f8e58ae07d7874449cff296c4283900d4f8364 100644 (file)
@@ -19,7 +19,7 @@
 #include <linux/slab.h>
 #include <linux/mm.h>
 #include <linux/io.h>
 #include <linux/slab.h>
 #include <linux/mm.h>
 #include <linux/io.h>
-#include <asm/pgtable.h>
+#include <sound/pcm.h>
 
 #define CT_PTES_PER_PAGE (CT_PAGE_SIZE / sizeof(void *))
 #define CT_ADDRS_PER_PAGE (CT_PTES_PER_PAGE * CT_PAGE_SIZE)
 
 #define CT_PTES_PER_PAGE (CT_PAGE_SIZE / sizeof(void *))
 #define CT_ADDRS_PER_PAGE (CT_PTES_PER_PAGE * CT_PAGE_SIZE)
@@ -34,6 +34,13 @@ get_vm_block(struct ct_vm *vm, unsigned int size)
        struct ct_vm_block *block = NULL, *entry = NULL;
        struct list_head *pos = NULL;
 
        struct ct_vm_block *block = NULL, *entry = NULL;
        struct list_head *pos = NULL;
 
+       size = CT_PAGE_ALIGN(size);
+       if (size > vm->size) {
+               printk(KERN_ERR "ctxfi: Fail! No sufficient device virtural "
+                                 "memory space available!\n");
+               return NULL;
+       }
+
        mutex_lock(&vm->lock);
        list_for_each(pos, &vm->unused) {
                entry = list_entry(pos, struct ct_vm_block, list);
        mutex_lock(&vm->lock);
        list_for_each(pos, &vm->unused) {
                entry = list_entry(pos, struct ct_vm_block, list);
@@ -73,6 +80,8 @@ static void put_vm_block(struct ct_vm *vm, struct ct_vm_block *block)
        struct ct_vm_block *entry = NULL, *pre_ent = NULL;
        struct list_head *pos = NULL, *pre = NULL;
 
        struct ct_vm_block *entry = NULL, *pre_ent = NULL;
        struct list_head *pos = NULL, *pre = NULL;
 
+       block->size = CT_PAGE_ALIGN(block->size);
+
        mutex_lock(&vm->lock);
        list_del(&block->list);
        vm->size += block->size;
        mutex_lock(&vm->lock);
        list_del(&block->list);
        vm->size += block->size;
@@ -115,57 +124,36 @@ static void put_vm_block(struct ct_vm *vm, struct ct_vm_block *block)
 
 /* Map host addr (kmalloced/vmalloced) to device logical addr. */
 static struct ct_vm_block *
 
 /* Map host addr (kmalloced/vmalloced) to device logical addr. */
 static struct ct_vm_block *
-ct_vm_map(struct ct_vm *vm, void *host_addr, int size)
+ct_vm_map(struct ct_vm *vm, struct snd_pcm_substream *substream, int size)
 {
 {
-       struct ct_vm_block *block = NULL;
-       unsigned long pte_start;
-       unsigned long i;
-       unsigned long pages;
-       unsigned long start_phys;
+       struct ct_vm_block *block;
+       unsigned int pte_start;
+       unsigned i, pages;
        unsigned long *ptp;
 
        unsigned long *ptp;
 
-       /* do mapping */
-       if ((unsigned long)host_addr >= VMALLOC_START) {
-               printk(KERN_ERR "ctxfi: "
-                      "Fail! Not support vmalloced addr now!\n");
-               return NULL;
-       }
-
-       if (size > vm->size) {
-               printk(KERN_ERR "ctxfi: Fail! No sufficient device virtural "
-                                 "memory space available!\n");
-               return NULL;
-       }
-
-       start_phys = (virt_to_phys(host_addr) & CT_PAGE_MASK);
-       pages = (CT_PAGE_ALIGN(virt_to_phys(host_addr) + size)
-                       - start_phys) >> CT_PAGE_SHIFT;
-
-       ptp = vm->ptp[0];
-
-       block = get_vm_block(vm, (pages << CT_PAGE_SHIFT));
+       block = get_vm_block(vm, size);
        if (block == NULL) {
                printk(KERN_ERR "ctxfi: No virtual memory block that is big "
                                  "enough to allocate!\n");
                return NULL;
        }
 
        if (block == NULL) {
                printk(KERN_ERR "ctxfi: No virtual memory block that is big "
                                  "enough to allocate!\n");
                return NULL;
        }
 
+       ptp = vm->ptp[0];
        pte_start = (block->addr >> CT_PAGE_SHIFT);
        pte_start = (block->addr >> CT_PAGE_SHIFT);
-       for (i = 0; i < pages; i++)
-               ptp[pte_start+i] = start_phys + (i << CT_PAGE_SHIFT);
+       pages = block->size >> CT_PAGE_SHIFT;
+       for (i = 0; i < pages; i++) {
+               unsigned long addr;
+               addr = snd_pcm_sgbuf_get_addr(substream, i << CT_PAGE_SHIFT);
+               ptp[pte_start + i] = addr;
+       }
 
 
-       block->addr += (virt_to_phys(host_addr) & (~CT_PAGE_MASK));
        block->size = size;
        block->size = size;
-
        return block;
 }
 
 static void ct_vm_unmap(struct ct_vm *vm, struct ct_vm_block *block)
 {
        /* do unmapping */
        return block;
 }
 
 static void ct_vm_unmap(struct ct_vm *vm, struct ct_vm_block *block)
 {
        /* do unmapping */
-       block->size = ((block->addr + block->size + CT_PAGE_SIZE - 1)
-                       & CT_PAGE_MASK) - (block->addr & CT_PAGE_MASK);
-       block->addr &= CT_PAGE_MASK;
        put_vm_block(vm, block);
 }
 
        put_vm_block(vm, block);
 }