PPC4xx memory to memory DMA

[padmanabha]

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("padmanabha at tesbv.com");

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