Subversion Repositories mips_enhanced

#define GRGPIOADR 0x80000500;
 
 
int gpio_test(int addr) 
{
volatile int *pio = (int *) addr; 
        /*
         * pio[0] = din
         * pio[1] = dout
         * pio[2] = dir
         * pio[3] = imask
         */
 
        int mask;
        int width;
 
	report_device(0x0101a000);
        pio[3] = 0; 
        pio[2] = 0;
        pio[1] = 0;  
 
        pio[2] = 0xFFFFFFFF;
 
        /* determine port width and mask */
        mask = 0;
        width = 0;
 
        while( ((pio[2] >> width) & 1) && (width <= 32)) {
                mask = mask | (1 << width);
                width++;
        }
 
        pio[2] = mask;
        if( (pio[0] & mask) != 0) fail(1);  
        pio[1] = 0x89ABCDEF;
        if( (pio[0] & mask) != (0x89ABCDEF & mask)) fail(2);
        pio[2] = 0;
}