PPC4xx memory to memory DMA

Hi,

I am using 2.6.23 kernel for ppc 440spe based board. When i tried memory to memory DMA ( please find the code given below ) DMA is not happening.

I am trying the same for last few days.... without any success. Can any one guide me.

/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

#include<linux/kernel.h>
#include<linux/module.h>
#include<linux/delay.h>

#include<asm/ppc4xx_dma.h>
#include<asm/io.h>
#include<linux/slab.h>

MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("PPC4xx Mem to Mem DMA demo"); MODULE_AUTHOR("[email protected]");

extern void flush_dcache_all(void);

#define DMA_CHANNEL_NUM 0
#define SIZE 4096

ppc_dma_ch_t ppc_dma_channel;
ppc_dma_ch_t p_init;

void * vir_dst_addr;
void * vir_src_addr;

unsigned long int phy_src;
unsigned long int phy_dst;

int ret, offset;

void dma_trns(void)
{

     memset( (char *)&p_init, 0, sizeof(p_init));

     p_init.polarity = 0;
     p_init.pwidth   = PW_8;

     ret = ppc4xx_init_dma_channel( DMA_CHANNEL_NUM, &p_init);

     if (ret  ==   DMA_STATUS_GOOD)
     {
         printk("%s: init_dma_channel return %d, dest is 
%p\n",__FUNCTION__, ret, vir_dst_addr);
     }

     else if(ret  ==   DMA_STATUS_BAD_CHANNEL)
     {

       printk("TS2: bad channel \n");

     }

     flush_dcache_all();

     ppc4xx_clr_dma_status( DMA_CHANNEL_NUM);

     ppc4xx_set_dma_mode(DMA_CHANNEL_NUM,DMA_MODE_MM);
     ppc4xx_set_src_addr( DMA_CHANNEL_NUM, (phys_addr_t) phy_src);
     ppc4xx_set_dst_addr(DMA_CHANNEL_NUM,  (phys_addr_t) phy_dst);
     ppc4xx_set_dma_count(DMA_CHANNEL_NUM,(SIZE * 2 ));

     ppc4xx_set_channel_priority(DMA_CHANNEL_NUM,PRIORITY_HIGH);

     ppc4xx_enable_dma(DMA_CHANNEL_NUM);


     // wait till completion of DMA


      while( 1)
      {
           mdelay(100);

           ret = 1;
           ret = ppc4xx_get_dma_residue( DMA_CHANNEL_NUM);

           if( ret == 0)
           {
               printk(" no dma operation is pending\n");
               break;
           }

      }

    ppc4xx_disable_dma( DMA_CHANNEL_NUM);

return ;
}

static int dma_test_init(void)
{

   vir_src_addr = (void *) __get_free_pages(GFP_KERNEL | GFP_DMA, 1);

if( vir_src_addr == NULL )

   {
       printk( " Memory not allocated\n");
       return 1;

}
printk("%s: virtual address for src buffer is 0x%p \n",__FUNCTION__,
(unsigned int *)vir_src_addr);
memset( (unsigned long *)vir_src_addr, 0x55, sizeof(unsigned long) *
(SIZE *2));

#if SRC_DISPLAY

   ret = 0;

   while(ret < 100)
   {

       printk( "%s: value at virtual addr 0x%p is 0x%X \n", 

__FUNCTION__,( (unsigned int *)vir_src_addr + ret ),\

       *( (unsigned int *)vir_src_addr + ret));

       ret++;

   }

#endif

   vir_dst_addr = (void *) __get_free_pages(GFP_KERNEL | GFP_DMA,1);

if( vir_dst_addr == NULL )

   {
       printk( " Memory not allocated\n");
       free_pages( (unsigned long)vir_src_addr, 1);
       return 1;

}
printk("%s: virtual address for dst buffer is 0x%p
\n",__FUNCTION__,(unsigned int *)vir_dst_addr);
memset( (unsigned long *)vir_dst_addr, 0, sizeof(unsigned long) *
(SIZE *2));

#if DST_DISPLAY

   ret = 0;
   while(ret < 100)
   {

       printk( "%s: value at virtual addr 0x%p is 0x%X \n", 
__FUNCTION__,( (unsigned int *)vir_dst_addr + ret ),\
       *( (unsigned int *)vir_dst_addr + ret));

       ret++;

}
#endif

// phy_src = virt_to_bus(vir_src_addr);
// phy_dst = virt_to_bus(vir_dst_addr);

     phy_src = iopa( (unsigned long ) vir_src_addr);
     phy_dst =  iopa(  (unsigned long )vir_dst_addr);

   dma_trns();

     ret = 1;
     ret = ppc4xx_get_dma_residue( DMA_CHANNEL_NUM);
     if( ret == 0)
     {
         printk(" no dma operation is pending\n");

     }

return 0;
}

void dma_test_exit(void)

{
     ret = ppc4xx_get_channel_config( DMA_CHANNEL_NUM, &ppc_dma_channel);

     if( ret != DMA_STATUS_GOOD )
     {
        printk("TS2: DMA STATUS  is not good \n");
     }
     else
     {
        printk("TS2:  DMA STATUS  good \n");

     }

     ret = 0;

     while(ret < 100)
     {

        printk( "%s: value at virtual addr 0x%p after dma is 0x%X \n", 
__FUNCTION__,( (unsigned int *)vir_dst_addr + ret ), \
        *( (unsigned int *)vir_dst_addr + ret)) ;

        ret++;
     }

    mdelay(100);

    free_pages( (unsigned long)vir_src_addr, 1);
    free_pages( (unsigned long)vir_dst_addr, 1);

}

module_init(dma_test_init);
module_exit(dma_test_exit);

/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

Thanks and Regards,
Padmanabha.s