Files
linux_media/drivers/media/pci/tbscapture/tbs_pcie-sdi.c

101 lines
2.4 KiB
C

#include "tbs_pcie.h"
#include "tbs_pcie-reg.h"
u8 sdi_CheckFree(struct tbs_pcie_dev *dev,int sdi_base_addr, unsigned char OpbyteNum)
{
unsigned char tmpbuf[4];
int i;
int j=500;
if(OpbyteNum==2)
j=400;
else if(OpbyteNum==1)
j=200;
//pauseThread(OpbyteNum+1);
tmpbuf[0] = 0;
for(i=0;(i<j) && (tmpbuf[0] != 1);i++)
{
*(u32 *)tmpbuf = TBS_PCIE_READ(sdi_base_addr, ASI_STATUS );
}
//return (tmpbuf[0] == 1);
if(tmpbuf[0] == 1)
return true;
else
{
printk("----------sdi spi interface check error! %x\n",tmpbuf[0]);
return false;
}
}
bool sdi_chip_reset(struct tbs_pcie_dev *dev,int sdi_base_addr)
{
unsigned char tmpbuf[4];
tmpbuf[0] = 0;
TBS_PCIE_WRITE( sdi_base_addr, ASI_CHIP_RST, *(u32 *)&tmpbuf[0]);
msleep(20);
tmpbuf[0] = 1;
TBS_PCIE_WRITE( sdi_base_addr, ASI_CHIP_RST, *(u32 *)&tmpbuf[0]);
msleep(100);
return true ;
}
int sdi_read16bit(struct tbs_pcie_dev *dev,int sdi_base_addr,int reg_addr)
{
unsigned char tmpbuf[4];
int regData;
tmpbuf[0] = (unsigned char) (reg_addr>>8)&0xff; //read_address, msb first;
tmpbuf[1] = (unsigned char)(reg_addr&0xff);
tmpbuf[0] += 0x80; //read data;
TBS_PCIE_WRITE( sdi_base_addr, ASI_SPI_CMD, *(u32 *)&tmpbuf[0]);
tmpbuf[0] = 0xf0; //cs low,cs high, write, read;
tmpbuf[1] = 0x20; // 2 bytes command for writing;
tmpbuf[1] += 0x02; //read 2 bytes data;
TBS_PCIE_WRITE( sdi_base_addr, ASI_SPI_CONFIG, *(u32 *)&tmpbuf[0]);
if(sdi_CheckFree(dev,sdi_base_addr,2)== false)
{
printk(" spi_read16bit error!\n");
return false;
}
*(u32 *)tmpbuf = TBS_PCIE_READ(sdi_base_addr, ASI_SPI_RD_32 );
regData = ((tmpbuf[0]<<8) | tmpbuf[1]);
return regData;
}
bool sdi_write16bit(struct tbs_pcie_dev *dev,int sdi_base_addr, int reg_addr, int data16bit)
{
unsigned char tmpbuf[4];
int regData;
tmpbuf[0] = (unsigned char) (reg_addr>>8)&0xff; //read_address, msb first;
tmpbuf[1] = (unsigned char)(reg_addr&0xff);
tmpbuf[2] = (unsigned char) (data16bit>>8)&0xff; //read_address, msb first;
tmpbuf[3] = (unsigned char)(data16bit&0xff);
TBS_PCIE_WRITE( sdi_base_addr, ASI_SPI_CMD, *(u32 *)&tmpbuf[0]);
tmpbuf[0] = 0xe0; //cs low,cs high, write, no read;
tmpbuf[1] = 0x40; // 4 bytes command for writing;
TBS_PCIE_WRITE( sdi_base_addr, ASI_SPI_CONFIG, *(u32 *)&tmpbuf[0]);
if(sdi_CheckFree(dev,sdi_base_addr,2)== false)
{
printk(" spi_write16bit error!\n");
return false;
}
return true ;
}