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
", data, dataread);
            return OK;
        }
    #endif
        read_chip(addr, (UINT32 *)(&dataread));
        if(print_level == 1)
            printf("spi write 0x%05X: 0x%08X
", 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
", addr, data);
    	      else
                printf("spi write 0x%05x: 0x%08x
", 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!
");
			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
", addr, data);
    	      else
                printf("spi write 0x%05x: 0x%08x
", 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
", 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
", addr, *data);
    	      else
                printf("i2c read 0x%05x: 0x%08x
", 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
", addr, *data);
    	      else
                printf("spi read 0x%05x: 0x%08x
", addr, *data);
        }

    	  if(!ret)
            return OK;
        else
            return ERROR;
    }
    else
    {
        return ERROR;
    }
}