#include <stdio.h>
#include <string.h>

#define error(x) { printf(x); exit( 999); }

void wrtest( unsigned *reg, unsigned w, unsigned e)
{
    unsigned r;

    *reg = w;
    r = *reg;
    if( r != e)
    {
	printf( "wrtest: at 0x%08lx wrote=0x%08x read=0x%08x expected=0x%08x\n",
		reg, w, r, e);
	exit( 999);
    }
}

/*
DMA tag in target format (LE).
BE=0x00000000_00000000_aaaaaaa0_ip00cccc
*/
typedef struct { unsigned tagL __attribute__ ((aligned (16))), tagH, pke1, pke0; } quad;

			quad data0 = {  3,  2,  1,  0};

/* DMArefe 1, data0 */	quad dma_refe =	{ 0x0c000001, 000, 0, 0};
/* DMAcnt 2 */		quad dma_cnt =	{ 0x10000002, 0, 0, 0};
			quad data1 =	{  7,  6,  5,  4};
			quad data2 =	{ 11, 10,  9,  8};
/* DMAnext 3,dma_ref */	quad dma_next =	{ 0x20000003, 000, 0, 0};
			quad data3 =	{ 15, 14, 13, 12};
			quad data4 =	{ 19, 18, 17, 16};
			quad data5 =	{ 23, 22, 21, 20};

			quad data6 =	{ 27, 26, 25, 24};
			quad data7 =	{ 31, 30, 29, 28};
			quad data8 =	{ 35, 34, 33, 32};
/* DMAref 1,data6 */	quad dma_ref =	{ 0x30000001, 000, 0, 0};
/* DMArefs 2,data7 */	quad dma_refs =	{ 0x40000002, 000, 0, 0};
/* DMAcall 3,dma_cal2 */quad dma_call =	{ 0x50000003, 000, 0, 0};
			quad data9 =	{ 39, 38, 37, 36};
			quad dataA =	{ 43, 42, 41, 40};
			quad dataB =	{ 47, 46, 45, 44};
/* DMAend 1 */  	quad dma_end =	{ 0x78000001, 0, 0, 0};
			quad dataE =	{ 59, 58, 57, 56};

/* DMAcall 1,dma_rt2 */	quad dma_cal2 =	{ 0x50000001, 000, 0, 0 };
			quad dataC =	{ 51, 50, 49, 48};
/* DMAret 0 */		quad dma_ret =	{ 0x60000000, 0, 0, 0}; 

/* DMAret 1 */		quad dma_rt2 =	{ 0x60000001, 0, 0, 0};
			quad dataD =	{ 55, 54, 53, 52};

int main()
{

#define DMA_D0_START	0x10008000
#define DMA_D0_CHCR	(unsigned*) 0x10008000
#define DMA_Dn_CHCR__STR	0x00000100
#define DMA_Dn_CHCR__TIE	0x00000080
#define DMA_Dn_CHCR__TTE	0x00000040
#define DMA_Dn_CHCR__MOD	0x0000000c
#define DMA_Dn_CHCR__MOD_NORM	0x00000000
#define DMA_Dn_CHCR__MOD_CHAIN	0x00000004
#define DMA_Dn_CHCR__DIR	0x00000001
#define DMA_D0_MADR	(unsigned*) 0x10008010
#define DMA_D0_QWC	(unsigned*) 0x10008020
#define DMA_D0_TADR	(unsigned*) 0x10008030
#define DMA_D0_ASR0	(unsigned*) 0x10008040
#define DMA_D0_ASR1	(unsigned*) 0x10008050
#define DMA_D0_PKTFLAG	(unsigned*) 0x10008060	/* virtual reg to indicate presence of tag in data */
#define DMA_D0_END	0x10008070

#define DMA_D1_START	0x10009000
#define DMA_D1_CHCR	(unsigned*) 0x10009000
#define DMA_D1_MADR	(unsigned*) 0x10009010
#define DMA_D1_QWC	(unsigned*) 0x10009020
#define DMA_D1_TADR	(unsigned*) 0x10009030
#define DMA_D1_ASR0	(unsigned*) 0x10009040
#define DMA_D1_ASR1	(unsigned*) 0x10009050
#define DMA_D1_PKTFLAG	(unsigned*) 0x10009060	/* virtual reg to indicate presence of tag in data */ 
#define DMA_D1_END	0x10009070

#define DMA_D2_START	0x1000a000
#define DMA_D2_CHCR	(unsigned*) 0x1000a000
#define DMA_D2_MADR	(unsigned*) 0x1000a010
#define DMA_D2_QWC	(unsigned*) 0x1000a020
#define DMA_D2_TADR	(unsigned*) 0x1000a030
#define DMA_D2_ASR0	(unsigned*) 0x1000a040
#define DMA_D2_ASR1	(unsigned*) 0x1000a050
#define DMA_D2_PKTFLAG	(unsigned*) 0x1000a060	/* virtual reg to indicate presence of tag in data */ 
#define DMA_D2_END	0x1000a070

#define DMA_D_CTRL	(unsigned*) 0x1000e000
#define DMA_D_CTRL__DMAE	0x00000001
#define DMA_D_STAT	(unsigned*) 0x1000e010
#define DMA_D_STAT__TOGGLE	0x63ff0000
#define DMA_D_STAT__CLEAR	0x0000e3ff
#define DMA_D_PCR	(unsigned*) 0x1000e020
#define DMA_D_PCR__PCE		0x80000000
#define DMA_D_PCR__CDE		0x03ff0000
#define DMA_D_PCR__CDE0		0x00010000
#define DMA_D_PCR__CDE1		0x00020000
#define DMA_D_PCR__CDE2		0x00040000
#define DMA_D_SQWC	(unsigned*) 0x1000e030
#define DMA_D_RBSR	(unsigned*) 0x1000e040
#define DMA_D_RBOR	(unsigned*) 0x1000e050
#define DMA_D_STADR	(unsigned*) 0x1000e060

#define DMA_TAG_IRQ	0x80000000;


    unsigned *reg, temp;

    printf( "Testing DMA_D_CTRL...\n");
    reg = DMA_D_CTRL;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x00000555, 0x00000555);
    wrtest( reg, 0x000002aa, 0x000002aa);
    *reg = 0;

    printf( "Testing DMA_D_STAT...\n");
    reg = DMA_D_STAT;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0xffffffff, 0x63ff0000);
    wrtest( reg, 0x63ff0000, 0x00000000);

    printf( "Testing DMA_D_PCR...\n");
    reg = DMA_D_PCR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x80000000, 0x83ff0000);
    wrtest( reg, 0x8fff0000, 0x83ff0000);
    wrtest( reg, 0x05550000, 0x01550000);
    wrtest( reg, 0x0155aaaa, 0x015502aa);
    wrtest( reg, 0x00005555, 0x00000155);
    *reg = 0;

    printf( "Testing DMA_D_SQWC...\n");
    reg = DMA_D_SQWC;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x005500aa);
    wrtest( reg, 0xaaaa5555, 0x00aa0055);
    *reg = 0;

    printf( "Testing DMA_D_RBOR...\n");
    reg = DMA_D_RBOR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0xaaaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D_RBSR...\n");
    reg = DMA_D_RBSR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0xaaaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D_STADR...\n");
    reg = DMA_D_STADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0xaaaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D0_CHCR...\n");
    reg = DMA_D0_CHCR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x000000aa);
    wrtest( reg, 0xaaaa5555, 0x00000155);
    *reg = 0;

    printf( "Testing DMA_D0_MADR...\n");
    reg = DMA_D0_MADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D0_TADR...\n");
    reg = DMA_D0_TADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D0_ASR0...\n");
    reg = DMA_D0_ASR0;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D0_ASR1...\n");
    reg = DMA_D0_ASR1;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D0_QWC...\n");
    reg = DMA_D0_QWC;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x0000aaaa);
    wrtest( reg, 0xaaaa5555, 0x00005555);
    *reg = 0;

    printf( "Testing DMA_D0_PKTFLAG...\n");
    reg = DMA_D0_PKTFLAG;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaaa);
    wrtest( reg, 0xaaaa5555, 0xaaaa5555);
    *reg = 0;

    printf( "Testing DMA_D1_CHCR...\n");
    reg = DMA_D1_CHCR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x000000aa);
    wrtest( reg, 0xaaaa5555, 0x00000155);
    *reg = 0;

    printf( "Testing DMA_D1_MADR...\n");
    reg = DMA_D1_MADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D1_TADR...\n");
    reg = DMA_D1_TADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D1_ASR0...\n");
    reg = DMA_D1_ASR0;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D1_ASR1...\n");
    reg = DMA_D1_ASR1;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D1_QWC...\n");
    reg = DMA_D1_QWC;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x0000aaaa);
    wrtest( reg, 0xaaaa5555, 0x00005555);
    *reg = 0;

    printf( "Testing DMA_D1_PKTFLAG...\n");
    reg = DMA_D1_PKTFLAG;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaaa);
    wrtest( reg, 0xaaaa5555, 0xaaaa5555);
    *reg = 0;

    printf( "Testing DMA_D2_CHCR...\n");
    reg = DMA_D2_CHCR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x000000aa);
    wrtest( reg, 0xaaaa5555, 0x00000155);
    *reg = 0;

    printf( "Testing DMA_D2_MADR...\n");
    reg = DMA_D2_MADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D2_TADR...\n");
    reg = DMA_D2_TADR;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D2_ASR0...\n");
    reg = DMA_D2_ASR0;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D2_ASR1...\n");
    reg = DMA_D2_ASR1;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaa0);
    wrtest( reg, 0x2aaa5555, 0x2aaa5550);
    *reg = 0;

    printf( "Testing DMA_D2_QWC...\n");
    reg = DMA_D2_QWC;
    if( *reg)
    {
	printf ("Not initialized to zero (0x%08x).\n", *reg);
	exit (999);
    }
    wrtest( reg, 0x5555aaaa, 0x0000aaaa);
    wrtest( reg, 0xaaaa5555, 0x00005555);
    *reg = 0;

    printf( "Testing DMA_D2_PKTFLAG...\n");
    reg = DMA_D2_PKTFLAG;
    if( *reg) error( "Not initialized to zero.\n");
    wrtest( reg, 0x5555aaaa, 0x5555aaaa);
    wrtest( reg, 0xaaaa5555, 0xaaaa5555);
    *reg = 0;

    /* Initiate a non-chained 0-length transfer. */
    printf ("\nPreparing for a DMA1 NORM transfer...\n");
    reg = DMA_D_CTRL;			/* enable DMA */
    *reg = DMA_D_CTRL__DMAE;
    reg = DMA_D1_QWC;			/* set # of quad words to xfr */
    *reg = 0;
    reg = DMA_D1_MADR;			/* set data address */
    *reg = 0x00012340;
    reg = DMA_D1_CHCR;
    printf ("Ready...\n");
    *reg = DMA_Dn_CHCR__STR | DMA_Dn_CHCR__MOD_NORM;

    reg = DMA_D1_QWC;
    if (*reg)
    {
	printf ("D1_QWC is not zero after transfer.\n");
	exit (999);
    }
    reg = DMA_D1_MADR;
    if (*reg != 0x00012340)
    {
	printf ("D1_MADR value is wrong after transfer.\n");
	exit (999);
    }
    reg = DMA_D1_CHCR;
    if ((*reg & DMA_Dn_CHCR__STR) != 0)
    {
	printf ("D1_CHCR.STR is not reset after transfer.\n");
	exit (999);
    }
    printf ("Completed OK...\n");

    /* Initiate a chained transfer. */

    /* Some of the "tag" fields couldn't be initialised statically. */
    /* The first address is unaligned to force a warning. */
    dma_refe.tagH = (unsigned)&data0 + 1;
    dma_next.tagH = (unsigned)&dma_ref;
    dma_ref.tagH = (unsigned)&data6;
    dma_refs.tagH = (unsigned)&data7;
    dma_call.tagH = (unsigned)&dma_cal2;
    dma_cal2.tagH = (unsigned)&dma_rt2;

    printf ("\nPreparing for a DMA0 TAG transfer...\n");
    reg = DMA_D_PCR;			/* disable DMA0 */
    *reg &= ~DMA_D_PCR__CDE0;
    *reg |= DMA_D_PCR__PCE;
    reg = DMA_D_CTRL;			/* enable DMA */
    *reg = DMA_D_CTRL__DMAE;
    reg = DMA_D0_TADR;			/* set tag address */
    *reg = (unsigned) & dma_refe;
    reg = DMA_D0_QWC;			/* set fictitious count */
    *reg = 51;
    printf ("Ready...\n");
    reg = DMA_D0_CHCR;
    *reg = DMA_Dn_CHCR__STR | DMA_Dn_CHCR__TTE | DMA_Dn_CHCR__MOD_CHAIN;

    reg = DMA_D0_QWC;
    if (*reg != 51)
    {
	printf ("DMA0 transfer not inhibited by DMA_D_PCR__CDE0 (%d).\n", *reg);
	exit (999);
    }
    reg = DMA_D_PCR;			/* enable DMA0 */
    *reg &= ~DMA_D_PCR__PCE;

    reg = DMA_D0_QWC;
    if (*reg)
    {
	printf ("D0_QWC is not zero after transfer.\n");
	exit (999);
    }
    reg = DMA_D0_MADR;
    if (*reg != (unsigned)&dma_cal2)
    {
	printf ("D0_MADR value is wrong after transfer.\n");
	exit (999);
    }
    reg = DMA_D0_CHCR;
    if ((*reg & DMA_Dn_CHCR__STR) != 0)
    {
	printf ("D0_CHCR.STR is not reset after transfer.\n");
	exit (999);
    }
    printf ("Completed OK...\n");

    /* Initiate a chained transfer that will be suspended
    and restarted. */

    /* Request suspension part way through. */
    dma_ref.tagL |= DMA_TAG_IRQ;

    printf ("\nPreparing for a DMA2 TAG transfer with suspension...\n");
    reg = DMA_D_CTRL;			/* enable DMA */
    *reg = DMA_D_CTRL__DMAE;
    reg = DMA_D2_TADR;			/* set tag address */
    *reg = (unsigned) & dma_refe;
    printf ("Ready...\n");
    reg = DMA_D2_CHCR;
    *reg = DMA_Dn_CHCR__STR | DMA_Dn_CHCR__MOD_CHAIN;
    printf ("returns...\n");

    reg = DMA_D2_QWC;
    if (*reg)
    {
	printf ("D2_QWC (0x%08x) is not zero after suspension.\n", *reg);
	exit (999);
    }
    reg = DMA_D2_MADR;
    if (*reg != (unsigned)&data7)
    {
	printf ("D2_MADR value (0x%08x) is wrong after suspension.\n", *reg);
	exit (999);
    }
    reg = DMA_D2_TADR;
    if (*reg != (unsigned)&dma_refs)
    {
	printf ("D2_TADR value (0x%08x) is wrong after suspension.\n", *reg);
	exit (999);
    }
    reg = DMA_D2_CHCR;
    if ((*reg & DMA_Dn_CHCR__STR) != 0)
    {
	printf ("D2_CHCR.STR (0x%08x) is not reset after suspension.\n", *reg);
	exit (999);
    }
    reg = DMA_D_PCR;
    if ((*reg & DMA_D_PCR__PCE) == 0)
    {
	printf ("DMA_D_PCR__PCE not set by transfer.\n");
	exit (999);
    }
    printf ("Suspended OK...\n");

    /* Reset the suspension request and continue. */
    dma_ref.tagL &= ~DMA_TAG_IRQ;
    reg = DMA_D2_CHCR;
    *reg |= DMA_Dn_CHCR__STR;

    reg = DMA_D2_QWC;
    if (*reg)
    {
	printf ("D2_QWC (0x%08x) is not zero after transfer.\n", *reg);
	exit (999);
    }
    reg = DMA_D2_MADR;
    if (*reg != (unsigned)&dma_cal2)
    {
	printf ("D2_MADR value (0x%08x) is wrong after transfer.\n", *reg);
	exit (999);
    }
    reg = DMA_D2_CHCR;
    if ((*reg & DMA_Dn_CHCR__STR) != 0)
    {
	printf ("D2_CHCR.STR (0x%08x) is not reset after transfer.\n", *reg);
	exit (999);
    }
    reg = DMA_D_PCR;
    if (*reg & DMA_D_PCR__PCE)
    {
	printf ("DMA_D_PCR__PCE not reset by transfer.\n");
	exit (999);
    }
    printf ("Completed OK...\n");

    exit (0);
}