linux-imx

​

static int init_q(struct fs_dev *dev, struct queue *txq, int queue,

          int nentries, int is_rq)

{

    int sz = nentries * sizeof (struct FS_QENTRY);

    struct FS_QENTRY *p;

​

    func_enter ();

​

            queue, nentries);

​

    p = aligned_kmalloc (sz, GFP_KERNEL, 0x10);

    fs_dprintk (FS_DEBUG_ALLOC, "Alloc queue: %p(%d)\n", p, sz);

​

    if (!p) return 0;

​

    write_fs (dev, Q_SA(queue), virt_to_bus(p));

    write_fs (dev, Q_EA(queue), virt_to_bus(p+nentries-1));

    write_fs (dev, Q_WP(queue), virt_to_bus(p));

    return 1;

}

​

​

static int init_fp(struct fs_dev *dev, struct freepool *fp, int queue,

           int bufsize, int nr_buffers)

{

    func_enter ();

​

​

    write_fs (dev, FP_CNF(queue), (bufsize * RBFP_RBS) | RBFP_RBSVAL | RBFP_CME);

    write_fs (dev, FP_SA(queue),  0);

    write_fs (dev, FP_EA(queue),  0);

    write_fs (dev, FP_CTU(queue), 0);

    write_fs (dev, FP_CNT(queue), 0);

​

    fp->offset = queue; 

    fp->bufsize = bufsize;

    fp->nr_buffers = nr_buffers;