/**

 * $Id$

 * 

 * General ASIC support code

 *

 * Copyright (c) 2006 Nathan Keynes.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 */

#include "lib.h"

#define ASIC_BASE 0xA05F6000

#define ASIC_PIRQ(n) (ASIC_BASE + 0x900 + (n<<2))

#define ASIC_IRQA(n) (ASIC_BASE + 0x910 + (n<<2))

#define ASIC_IRQB(n) (ASIC_BASE + 0x920 + (n<<2))

#define ASIC_IRQC(n) (ASIC_BASE + 0x930 + (n<<2))

#define G2_FIFO  (ASIC_BASE + 0x88C)

#define TIMEOUT 10000000

/**

 * Wait for an ASIC event. 

 * @return 0 if the event occurred, otherwise -1 if the wait timed out.

 */

int asic_wait( int event )

{

    int n = event >> 5;

    unsigned int mask = (1<< (event&0x1f));

    int i;

    for( i=0; i<TIMEOUT; i++ ) {

	if( long_read(ASIC_PIRQ(n)) & mask ) {

	    return 0;

	}

    }

    return -1; /* Timeout */

}

/**

 * Wait for either of 2 ASIC events. 

 * @return the event id if the event occurred, otherwise -1 if the wait timed out.

 */

int asic_wait2( int event1, int event2 )

{

    int n1 = event1 >> 5;

    int n2 = event2 >> 5;

    unsigned int mask1 = (1<< (event1&0x1f));

    unsigned int mask2 = (1<< (event2&0x1f));

    int i;

    for( i=0; i<TIMEOUT; i++ ) {

	if( long_read(ASIC_PIRQ(n1)) & mask1 ) {

	    return event1;

	}

	if( long_read(ASIC_PIRQ(n2)) & mask2 ) {

            return event2;

        }

    }

    return -1; /* Timeout */

}

/**

 * Clear all asic events

 */

void asic_clear()

{

    long_write(ASIC_PIRQ(0), 0xFFFFFFFF);

    long_write(ASIC_PIRQ(1), 0xFFFFFFFF);

    long_write(ASIC_PIRQ(2), 0xFFFFFFFF);

}

int asic_check( int event ) 

{

    int n = event >> 5;

    unsigned int mask = (1<< (event&0x1f));

    return (long_read(ASIC_PIRQ(n)) & mask) != 0;

}

void asic_mask_all()

{

    long_write(ASIC_IRQA(0), 0);

    long_write(ASIC_IRQA(1), 0);

    long_write(ASIC_IRQA(2), 0);

    long_write(ASIC_IRQB(0), 0);

    long_write(ASIC_IRQB(1), 0);

    long_write(ASIC_IRQB(2), 0);

    long_write(ASIC_IRQC(0), 0);

    long_write(ASIC_IRQC(1), 0);

    long_write(ASIC_IRQC(2), 0);

}

/**

 * Print the contents of the ASIC event registers to the supplied FILE

 */

void asic_dump( FILE *f )

{

    int i,j;

    fprintf( f, "Events: " );

    for( i=0; i<3; i++ ) {

	uint32_t val = long_read(ASIC_PIRQ(i));

	for( j=0; j<32; j++ ) {

	    if( val & (1<<j) ) {

		fprintf( f, "%d ", (i<<5)+j );

	    }

	}

    }

    fprintf( f, "\n" );

}

/**

 * Wait until the g2 fifo is clear to write more data.

 */

int g2_fifo_wait()

{

    int i;

    for (i=0; i<0x1800; i++) {

        if (!(long_read(G2_FIFO) & 0x11)) {

            return 0;

        }

    }

    return -1;

}