123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319 |
- /*****************************************************************************
- Copyright(c) 2013 FCI Inc. All Rights Reserved
- File name : fc8080_spi.c
- Description : spi interface source file
- 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.
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- History :
- ----------------------------------------------------------------------
- *******************************************************************************/
- #include <linux/input.h>
- #include <linux/spi/spi.h>
- #include <linux/cache.h>
- #include "fci_types.h"
- #include "fc8080_regs.h"
- #include "fci_oal.h"
- #include "fc8080_spi.h"
- #include "tdmb.h"
- #define SPI_BMODE 0x00
- #define SPI_WMODE 0x04
- #define SPI_LMODE 0x08
- #define SPI_RD_THRESH 0x30
- #define SPI_RD_REG 0x20
- #define SPI_READ 0x40
- #define SPI_WRITE 0x00
- #define SPI_AINC 0x80
- #define CHIPID 0
- #define DRIVER_NAME "fc8080_spi"
- u32 fc8080_spi;
- static u8 tx_data[32] __cacheline_aligned;
- static DEFINE_MUTEX(lock);
- int fc8080_spi_write_then_read(
- struct spi_device *spi
- , u8 *txbuf
- , u16 tx_length
- , u8 *rxbuf
- , u16 rx_length)
- {
- s32 res;
- struct spi_message message;
- struct spi_transfer x;
- spi_message_init(&message);
- memset(&x, 0, sizeof x);
- spi_message_add_tail(&x, &message);
- x.tx_buf = txbuf;
- x.rx_buf = txbuf;
- x.len = tx_length + rx_length;
- res = spi_sync(spi, &message);
- memcpy(rxbuf, x.rx_buf + tx_length, rx_length);
- return res;
- }
- int fc8080_spi_write_then_burstread(
- struct spi_device *spi
- , u8 *txbuf
- , u16 tx_length
- , u8 *rxbuf
- , u16 rx_length)
- {
- s32 res;
- struct spi_message message;
- struct spi_transfer x;
- spi_message_init(&message);
- memset(&x, 0, sizeof x);
- spi_message_add_tail(&x, &message);
- x.tx_buf = txbuf;
- x.rx_buf = rxbuf;
- x.len = tx_length + rx_length;
- res = spi_sync(spi, &message);
- return res;
- }
- static s32 spi_bulkread(HANDLE handle, u16 addr, u8 command, u8 *data,
- u16 length)
- {
- s32 res = BBM_OK;
- tx_data[0] = (u8) (addr & 0xff);
- tx_data[1] = (u8) ((addr >> 8) & 0xff);
- tx_data[2] = (u8) ((command & 0xfc) | CHIPID);
- tx_data[3] = (u8) (length & 0xff);
- res = fc8080_spi_write_then_read(
- (struct spi_device *)fc8080_spi, &tx_data[0], 4, &data[0], length);
- if (res) {
- print_log(0, "fc8080_spi_bulkread fail : %d\n", res);
- return BBM_NOK;
- }
- return BBM_OK;
- }
- static s32 spi_bulkwrite(HANDLE handle, u16 addr, u8 command, u8 *data,
- u16 length)
- {
- s32 res = BBM_OK;
- s32 i = 0;
- tx_data[0] = (u8) (addr & 0xff);
- tx_data[1] = (u8) ((addr >> 8) & 0xff);
- tx_data[2] = (u8) ((command & 0xfc) | CHIPID);
- tx_data[3] = (u8) (length & 0xff);
- for (i = 0; i < length; i++)
- tx_data[4+i] = data[i];
- res = fc8080_spi_write_then_read(
- (struct spi_device *)fc8080_spi, &tx_data[0], length+4, NULL, 0);
- if (res) {
- print_log(0, "fc8080_spi_bulkwrite fail : %d\n", res);
- return BBM_NOK;
- }
- return BBM_OK;
- }
- static s32 spi_dataread(HANDLE handle, u16 addr, u8 command, u8 *data,
- u32 length)
- {
- s32 res = BBM_OK;
- tx_data[0] = (u8) (addr & 0xff);
- tx_data[1] = (u8) ((addr >> 8) & 0xff);
- tx_data[2] = (u8) ((command & 0xfc) | CHIPID);
- tx_data[3] = (u8) (length & 0xff);
- res = fc8080_spi_write_then_burstread(
- (struct spi_device *)fc8080_spi, &tx_data[0], 4, &data[0], length);
- if (res) {
- print_log(0, "fc8080_spi_dataread fail : %d\n", res);
- return BBM_NOK;
- }
- return BBM_OK;
- }
- s32 fc8080_spi_init(HANDLE handle, u16 param1, u16 param2)
- {
- fc8080_spi = param2;
- fc8080_spi <<= 16;
- fc8080_spi |= param1;
- DPRINTK("%s : 0x%p\n", __func__, (struct spi_device *)fc8080_spi);
- return BBM_OK;
- }
- s32 fc8080_spi_byteread(HANDLE handle, u16 addr, u8 *data)
- {
- s32 res;
- u8 command = SPI_READ;
- mutex_lock(&lock);
- res = spi_bulkread(handle, addr, command, data, 1);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_wordread(HANDLE handle, u16 addr, u16 *data)
- {
- s32 res;
- u8 command = SPI_READ | SPI_AINC;
- mutex_lock(&lock);
- res = spi_bulkread(handle, addr, command, (u8 *) data, 2);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_longread(HANDLE handle, u16 addr, u32 *data)
- {
- s32 res;
- u8 command = SPI_READ | SPI_AINC;
- mutex_lock(&lock);
- res = spi_bulkread(handle, addr, command, (u8 *) data, 4);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_bulkread(HANDLE handle, u16 addr, u8 *data, u16 length)
- {
- s32 i;
- u16 x, y;
- s32 res = BBM_OK;
- u8 command = SPI_READ | SPI_AINC;
- x = length / 255;
- y = length % 255;
- mutex_lock(&lock);
- for (i = 0; i < x; i++, addr += 255)
- res |= spi_bulkread(handle, addr, command, &data[i * 255], 255);
- if (y)
- res |= spi_bulkread(handle, addr, command, &data[x * 255], y);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_bytewrite(HANDLE handle, u16 addr, u8 data)
- {
- s32 res;
- u8 command = SPI_WRITE;
- mutex_lock(&lock);
- res = spi_bulkwrite(handle, addr, command, (u8 *) &data, 1);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_wordwrite(HANDLE handle, u16 addr, u16 data)
- {
- s32 res;
- u8 command = SPI_WRITE;
- if ((addr & 0xff00) != 0x0f00)
- command |= SPI_AINC;
- mutex_lock(&lock);
- res = spi_bulkwrite(handle, addr, command, (u8 *) &data, 2);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_longwrite(HANDLE handle, u16 addr, u32 data)
- {
- s32 res;
- u8 command = SPI_WRITE | SPI_AINC;
- mutex_lock(&lock);
- res = spi_bulkwrite(handle, addr, command, (u8 *) &data, 4);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_bulkwrite(HANDLE handle, u16 addr, u8 *data, u16 length)
- {
- s32 i;
- u16 x, y;
- s32 res = BBM_OK;
- u8 command = SPI_WRITE | SPI_AINC;
- x = length / 255;
- y = length % 255;
- mutex_lock(&lock);
- for (i = 0; i < x; i++, addr += 255)
- res |= spi_bulkwrite(handle, addr, command, &data[i * 255],
- 255);
- if (y)
- res |= spi_bulkwrite(handle, addr, command, &data[x * 255], y);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_dataread(HANDLE handle, u16 addr, u8 *data, u32 length)
- {
- s32 res;
- u8 command = SPI_READ | SPI_RD_THRESH;
- mutex_lock(&lock);
- res = spi_dataread(handle, addr, command, data, length);
- mutex_unlock(&lock);
- return res;
- }
- s32 fc8080_spi_deinit(HANDLE handle)
- {
- fc8080_spi = 0;
- return BBM_OK;
- }
|