write_chip，read_chip

int write_chip(UINT32 addr, UINT32 data)

{

    if(0 == fpgaRWMode)   /* localbus mode */

    {

        UINT16 datah, datal;

        UINT32 dataread;

    

        datah = (UINT16)(data >> 16);

        FPGA_REG(addr) = datah;

        rwWait(60);



        datal = (UINT16)(data & 0xFFFF);

        FPGA_REG(addr) = datal;

        rwWait(60);

    	

    #if 0

        read_chip(addr, &dataread);

        if (data != dataread)

        {

            printf("ERROR:write 0x%08X; read 0x%08X\n", data, dataread);

            return OK;

        }

    #endif

        read_chip(addr, (UINT32 *)(&dataread));

        if(print_level == 1)

            printf("spi write 0x%05X: 0x%08X\n", addr, data);

        return OK;

    }

    else if(1 == fpgaRWMode) /* i2c mode */

    {

        int ret = 0;

        

        ret = fpgaMAC_i2c_write(0,0,0,addr,(unsigned char *)(&data),4);



    	  if(print_level == 1)

    	  {

    	      if(ret != 0)

    	          printf("spi write failed! read 0x%05x: 0x%08x\n", addr, data);

    	      else

                printf("spi write 0x%05x: 0x%08x\n", addr, data);

        }



    	  if(!ret)

            return OK;

        else

            return ERROR;

    }

    else if(2 == fpgaRWMode) /* spi mode */

    {

        int ret = 0;



		unsigned char *wtBuff = (unsigned char *)malloc(8);

		if(NULL == wtBuff)

		{

			printf("No memory!\n");

			return -1;

		}



		*wtBuff 	= (unsigned char)((data>>24) & 0xff);

		*(wtBuff+1) = (unsigned char)((data>>16) & 0xff);

		*(wtBuff+2) = (unsigned char)((data>>8 ) & 0xff);

		*(wtBuff+3) = (unsigned char)((data    ) & 0xff);

		

        ret = fpga_spi_write(addr,(unsigned char *)(wtBuff),4);

		

		

    	  if(print_level == 1)

    	  {

    	      if(ret != 0)

    	          printf("spi write failed! read 0x%05x: 0x%08x\n", addr, data);

    	      else

                printf("spi write 0x%05x: 0x%08x\n", addr, data);

         }



		free(wtBuff);  



    	  if(!ret)

            return OK;

        else

            return ERROR;

    }

    else

    {

        return ERROR;

    }

}



int read_chip(UINT32 addr, UINT32 *data)

{

    if(data == NULL)

        return ERROR;



    if(0 == fpgaRWMode)   /* localbus mode */

    {

        UINT16 datah, datal;

        

        datah = FPGA_REG(addr);

        rwWait(60);

        

        datal = FPGA_REG(addr);

        rwWait(60);

    

        *data = datal + (((UINT32)datah) << 16);



    	  if(print_level == 1)

        printf("localbus read 0x%05X: 0x%08X\n", addr, *data);



    	  return OK;

    }

    else if(1 == fpgaRWMode)  /* i2c mode */

    {

        int ret = 0;



        ret = fpgaMAC_i2c_read(0,0,0,addr,(unsigned char *)data,4);

        

    	  if(print_level == 1)

    	  {

    	      if(ret != 0)

    	          printf("i2c read failed! read 0x%05x: 0x%08x\n", addr, *data);

    	      else

                printf("i2c read 0x%05x: 0x%08x\n", addr, *data);

        }



    	  if(!ret)

            return OK;

        else

            return ERROR;

    }

    else if(2 == fpgaRWMode)  /* spi mode */

    {

        int ret = 0;



        ret = fpga_spi_read(addr,(unsigned char *)data,4);

        

    	  if(print_level == 1)

    	  {

    	      if(ret != 0)

    	          printf("spi read failed! read 0x%05x: 0x%08x\n", addr, *data);

    	      else

                printf("spi read 0x%05x: 0x%08x\n", addr, *data);

        }



    	  if(!ret)

            return OK;

        else

            return ERROR;

    }

    else

    {

        return ERROR;

    }

}