diff options
Diffstat (limited to 'drivers/media/isdbt/fc8150/fc8150_spi.c')
-rw-r--r-- | drivers/media/isdbt/fc8150/fc8150_spi.c | 293 |
1 files changed, 293 insertions, 0 deletions
diff --git a/drivers/media/isdbt/fc8150/fc8150_spi.c b/drivers/media/isdbt/fc8150/fc8150_spi.c new file mode 100644 index 0000000..9903fc8 --- /dev/null +++ b/drivers/media/isdbt/fc8150/fc8150_spi.c @@ -0,0 +1,293 @@ +/***************************************************************************** + Copyright(c) 2012 FCI Inc. All Rights Reserved + + File name : fc8150_spi.c + + Description : fc8150 host interface + +*******************************************************************************/ +#include <linux/spi/spi.h> +#include <linux/slab.h> + +#include "fci_types.h" +#include "fc8150_regs.h" +#include "fci_oal.h" + +#define SPI_BMODE 0x00 +#define SPI_WMODE 0x10 +#define SPI_LMODE 0x20 +#define SPI_READ 0x40 +#define SPI_WRITE 0x00 +#define SPI_AINC 0x80 +#define CHIPID (0 << 3) + +#define DRIVER_NAME "fc8150_spi" + +struct spi_device *fc8150_spi; + +static u8 tx_data[10]; +static u8 rdata_buf[8192]; +static u8 wdata_buf[8192]; + +static DEFINE_MUTEX(lock); + +static int __devinit fc8150_spi_probe(struct spi_device *spi) +{ + s32 ret; + + PRINTF(0, "fc8150_spi_probe\n"); + + spi->max_speed_hz = 24000000; + spi->bits_per_word = 8; + spi->mode = SPI_MODE_0; + + ret = spi_setup(spi); + + if (ret < 0) + return ret; + + fc8150_spi = spi; + + return ret; +} + +static int fc8150_spi_remove(struct spi_device *spi) +{ + + return 0; +} + +static struct spi_driver fc8150_spi_driver = { + .driver = { + .name = DRIVER_NAME, + .owner = THIS_MODULE, + }, + .probe = fc8150_spi_probe, + .remove = __devexit_p(fc8150_spi_remove), +}; + +static int fc8150_spi_write_then_read(struct spi_device *spi + , u8 *txbuf, u16 tx_length, u8 *rxbuf, u16 rx_length) +{ + int res = 0; + + struct spi_message message; + struct spi_transfer x; + + spi_message_init(&message); + memset(&x, 0, sizeof x); + + spi_message_add_tail(&x, &message); + + memcpy(&wdata_buf[0], txbuf, tx_length); + + x.tx_buf = &wdata_buf[0]; + x.rx_buf = &rdata_buf[0]; + x.len = tx_length + rx_length; + x.cs_change = 0; + x.bits_per_word = 8; + res = spi_sync(spi, &message); + + memcpy(rxbuf, x.rx_buf + tx_length, rx_length); + + return res; +} + +static int spi_bulkread(HANDLE hDevice, u16 addr + , u8 command, u8 *data, u16 length) +{ + int res; + + tx_data[0] = addr & 0xff; + tx_data[1] = (addr >> 8) & 0xff; + tx_data[2] = (command & 0xf0) | CHIPID | ((length >> 16) & 0x07); + tx_data[3] = (length >> 8) & 0xff; + tx_data[4] = length & 0xff; + + res = fc8150_spi_write_then_read(fc8150_spi, &tx_data[0] + , 5, data, length); + + if (res) { + PRINTF(0, "fc8150_spi_bulkread fail : %d\n", res); + return BBM_NOK; + } + + return BBM_OK; +} + +static int spi_bulkwrite(HANDLE hDevice, u16 addr + , u8 command, u8 *data, u16 length) +{ + int i; + int res; + + tx_data[0] = addr & 0xff; + tx_data[1] = (addr >> 8) & 0xff; + tx_data[2] = (command & 0xf0) | CHIPID | ((length >> 16) & 0x07); + tx_data[3] = (length >> 8) & 0xff; + tx_data[4] = length & 0xff; + + for (i = 0; i < length; i++) + tx_data[5+i] = data[i]; + + res = fc8150_spi_write_then_read(fc8150_spi + , &tx_data[0], length+5, NULL, 0); + + if (res) { + PRINTF(0, "fc8150_spi_bulkwrite fail : %d\n", res); + return BBM_NOK; + } + + return BBM_OK; +} + +static int spi_dataread(HANDLE hDevice, u16 addr + , u8 command, u8 *data, u32 length) +{ + int res; + + tx_data[0] = addr & 0xff; + tx_data[1] = (addr >> 8) & 0xff; + tx_data[2] = (command & 0xf0) | CHIPID | ((length >> 16) & 0x07); + tx_data[3] = (length >> 8) & 0xff; + tx_data[4] = length & 0xff; + + res = fc8150_spi_write_then_read(fc8150_spi + , &tx_data[0], 5, data, length); + + if (res) { + PRINTF(0, "fc8150_spi_dataread fail : %d\n", res); + return BBM_NOK; + } + + return BBM_OK; +} + +int fc8150_spi_init(HANDLE hDevice, u16 param1, u16 param2) +{ + int res = 0; + + PRINTF(0, "fc8150_spi_init : %d\n", res); + + res = spi_register_driver(&fc8150_spi_driver); + + if (res) { + PRINTF(0, "fc8150_spi register fail : %d\n", res); + return BBM_NOK; + } + + return res; +} + +int fc8150_spi_byteread(HANDLE hDevice, u16 addr, u8 *data) +{ + int res; + u8 command = SPI_READ; + + mutex_lock(&lock); + res = spi_bulkread(hDevice, addr, command, data, 1); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_wordread(HANDLE hDevice, u16 addr, u16 *data) +{ + int res; + u8 command = SPI_READ | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkread(hDevice, addr, command, (u8 *)data, 2); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_longread(HANDLE hDevice, u16 addr, u32 *data) +{ + int res; + u8 command = SPI_READ | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkread(hDevice, addr, command, (u8 *)data, 4); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_bulkread(HANDLE hDevice, u16 addr, u8 *data, u16 length) +{ + int res; + u8 command = SPI_READ | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkread(hDevice, addr, command, data, length); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_bytewrite(HANDLE hDevice, u16 addr, u8 data) +{ + int res; + u8 command = SPI_WRITE; + + mutex_lock(&lock); + res = spi_bulkwrite(hDevice, addr, command, (u8 *)&data, 1); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_wordwrite(HANDLE hDevice, u16 addr, u16 data) +{ + int res; + u8 command = SPI_WRITE | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkwrite(hDevice, addr, command, (u8 *)&data, 2); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_longwrite(HANDLE hDevice, u16 addr, u32 data) +{ + int res; + u8 command = SPI_WRITE | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkwrite(hDevice, addr, command, (u8 *)&data, 4); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_bulkwrite(HANDLE hDevice, u16 addr, u8 *data, u16 length) +{ + int res; + u8 command = SPI_WRITE | SPI_AINC; + + mutex_lock(&lock); + res = spi_bulkwrite(hDevice, addr, command, data, length); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_dataread(HANDLE hDevice, u16 addr, u8 *data, u32 length) +{ + int res; + u8 command = SPI_READ; + + mutex_lock(&lock); + res = spi_dataread(hDevice, addr, command, data, length); + mutex_unlock(&lock); + + return res; +} + +int fc8150_spi_deinit(HANDLE hDevice) +{ + return BBM_OK; +} |