mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-11-01 17:08:10 +00:00
media: cxd2880: Add spi device IO routines
Add functions for initializing, reading and writing to the SPI device for the Sony CXD2880 DVB-T2/T tuner + demodulator. Signed-off-by: Yasunari Takiguchi <Yasunari.Takiguchi@sony.com> Signed-off-by: Masayuki Yamamoto <Masayuki.Yamamoto@sony.com> Signed-off-by: Hideki Nozawa <Hideki.Nozawa@sony.com> Signed-off-by: Kota Yonezawa <Kota.Yonezawa@sony.com> Signed-off-by: Toshihiko Matsumoto <Toshihiko.Matsumoto@sony.com> Signed-off-by: Satoshi Watanabe <Satoshi.C.Watanabe@sony.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>
This commit is contained in:
parent
1a3ef038d0
commit
4e67e6cb06
5 changed files with 325 additions and 0 deletions
129
drivers/media/dvb-frontends/cxd2880/cxd2880_devio_spi.c
Normal file
129
drivers/media/dvb-frontends/cxd2880/cxd2880_devio_spi.c
Normal file
|
@ -0,0 +1,129 @@
|
|||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* cxd2880_devio_spi.c
|
||||
* Sony CXD2880 DVB-T2/T tuner + demodulator driver
|
||||
* I/O interface via SPI
|
||||
*
|
||||
* Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
|
||||
*/
|
||||
|
||||
#include "cxd2880_devio_spi.h"
|
||||
|
||||
#define BURST_WRITE_MAX 128
|
||||
|
||||
static int cxd2880_io_spi_read_reg(struct cxd2880_io *io,
|
||||
enum cxd2880_io_tgt tgt,
|
||||
u8 sub_address, u8 *data,
|
||||
u32 size)
|
||||
{
|
||||
int ret;
|
||||
struct cxd2880_spi *spi = NULL;
|
||||
u8 send_data[6];
|
||||
u8 *read_data_top = data;
|
||||
|
||||
if (!io || !io->if_object || !data)
|
||||
return -EINVAL;
|
||||
|
||||
if (sub_address + size > 0x100)
|
||||
return -EINVAL;
|
||||
|
||||
spi = io->if_object;
|
||||
|
||||
if (tgt == CXD2880_IO_TGT_SYS)
|
||||
send_data[0] = 0x0b;
|
||||
else
|
||||
send_data[0] = 0x0a;
|
||||
|
||||
send_data[3] = 0;
|
||||
send_data[4] = 0;
|
||||
send_data[5] = 0;
|
||||
|
||||
while (size > 0) {
|
||||
send_data[1] = sub_address;
|
||||
if (size > 255)
|
||||
send_data[2] = 255;
|
||||
else
|
||||
send_data[2] = size;
|
||||
|
||||
ret =
|
||||
spi->write_read(spi, send_data, sizeof(send_data),
|
||||
read_data_top, send_data[2]);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
sub_address += send_data[2];
|
||||
read_data_top += send_data[2];
|
||||
size -= send_data[2];
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int cxd2880_io_spi_write_reg(struct cxd2880_io *io,
|
||||
enum cxd2880_io_tgt tgt,
|
||||
u8 sub_address,
|
||||
const u8 *data, u32 size)
|
||||
{
|
||||
int ret;
|
||||
struct cxd2880_spi *spi = NULL;
|
||||
u8 send_data[BURST_WRITE_MAX + 4];
|
||||
const u8 *write_data_top = data;
|
||||
|
||||
if (!io || !io->if_object || !data)
|
||||
return -EINVAL;
|
||||
|
||||
if (size > BURST_WRITE_MAX)
|
||||
return -EINVAL;
|
||||
|
||||
if (sub_address + size > 0x100)
|
||||
return -EINVAL;
|
||||
|
||||
spi = io->if_object;
|
||||
|
||||
if (tgt == CXD2880_IO_TGT_SYS)
|
||||
send_data[0] = 0x0f;
|
||||
else
|
||||
send_data[0] = 0x0e;
|
||||
|
||||
while (size > 0) {
|
||||
send_data[1] = sub_address;
|
||||
if (size > 255)
|
||||
send_data[2] = 255;
|
||||
else
|
||||
send_data[2] = size;
|
||||
|
||||
memcpy(&send_data[3], write_data_top, send_data[2]);
|
||||
|
||||
if (tgt == CXD2880_IO_TGT_SYS) {
|
||||
send_data[3 + send_data[2]] = 0x00;
|
||||
ret = spi->write(spi, send_data, send_data[2] + 4);
|
||||
} else {
|
||||
ret = spi->write(spi, send_data, send_data[2] + 3);
|
||||
}
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
sub_address += send_data[2];
|
||||
write_data_top += send_data[2];
|
||||
size -= send_data[2];
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int cxd2880_io_spi_create(struct cxd2880_io *io,
|
||||
struct cxd2880_spi *spi, u8 slave_select)
|
||||
{
|
||||
if (!io || !spi)
|
||||
return -EINVAL;
|
||||
|
||||
io->read_regs = cxd2880_io_spi_read_reg;
|
||||
io->write_regs = cxd2880_io_spi_write_reg;
|
||||
io->write_reg = cxd2880_io_common_write_one_reg;
|
||||
io->if_object = spi;
|
||||
io->i2c_address_sys = 0;
|
||||
io->i2c_address_demod = 0;
|
||||
io->slave_select = slave_select;
|
||||
|
||||
return 0;
|
||||
}
|
23
drivers/media/dvb-frontends/cxd2880/cxd2880_devio_spi.h
Normal file
23
drivers/media/dvb-frontends/cxd2880/cxd2880_devio_spi.h
Normal file
|
@ -0,0 +1,23 @@
|
|||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* cxd2880_devio_spi.h
|
||||
* Sony CXD2880 DVB-T2/T tuner + demodulator driver
|
||||
* I/O interface via SPI
|
||||
*
|
||||
* Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
|
||||
*/
|
||||
|
||||
#ifndef CXD2880_DEVIO_SPI_H
|
||||
#define CXD2880_DEVIO_SPI_H
|
||||
|
||||
#include "cxd2880_common.h"
|
||||
#include "cxd2880_io.h"
|
||||
#include "cxd2880_spi.h"
|
||||
|
||||
#include "cxd2880_tnrdmd.h"
|
||||
|
||||
int cxd2880_io_spi_create(struct cxd2880_io *io,
|
||||
struct cxd2880_spi *spi,
|
||||
u8 slave_select);
|
||||
|
||||
#endif
|
34
drivers/media/dvb-frontends/cxd2880/cxd2880_spi.h
Normal file
34
drivers/media/dvb-frontends/cxd2880/cxd2880_spi.h
Normal file
|
@ -0,0 +1,34 @@
|
|||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* cxd2880_spi.h
|
||||
* Sony CXD2880 DVB-T2/T tuner + demodulator driver
|
||||
* SPI access definitions
|
||||
*
|
||||
* Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
|
||||
*/
|
||||
|
||||
#ifndef CXD2880_SPI_H
|
||||
#define CXD2880_SPI_H
|
||||
|
||||
#include "cxd2880_common.h"
|
||||
|
||||
enum cxd2880_spi_mode {
|
||||
CXD2880_SPI_MODE_0,
|
||||
CXD2880_SPI_MODE_1,
|
||||
CXD2880_SPI_MODE_2,
|
||||
CXD2880_SPI_MODE_3
|
||||
};
|
||||
|
||||
struct cxd2880_spi {
|
||||
int (*read)(struct cxd2880_spi *spi, u8 *data,
|
||||
u32 size);
|
||||
int (*write)(struct cxd2880_spi *spi, const u8 *data,
|
||||
u32 size);
|
||||
int (*write_read)(struct cxd2880_spi *spi,
|
||||
const u8 *tx_data, u32 tx_size,
|
||||
u8 *rx_data, u32 rx_size);
|
||||
u32 flags;
|
||||
void *user;
|
||||
};
|
||||
|
||||
#endif
|
113
drivers/media/dvb-frontends/cxd2880/cxd2880_spi_device.c
Normal file
113
drivers/media/dvb-frontends/cxd2880/cxd2880_spi_device.c
Normal file
|
@ -0,0 +1,113 @@
|
|||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* cxd2880_spi_device.c
|
||||
* Sony CXD2880 DVB-T2/T tuner + demodulator driver
|
||||
* SPI access functions
|
||||
*
|
||||
* Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
|
||||
*/
|
||||
|
||||
#include <linux/spi/spi.h>
|
||||
|
||||
#include "cxd2880_spi_device.h"
|
||||
|
||||
static int cxd2880_spi_device_write(struct cxd2880_spi *spi,
|
||||
const u8 *data, u32 size)
|
||||
{
|
||||
struct cxd2880_spi_device *spi_device = NULL;
|
||||
struct spi_message msg;
|
||||
struct spi_transfer tx;
|
||||
int result = 0;
|
||||
|
||||
if (!spi || !spi->user || !data || size == 0)
|
||||
return -EINVAL;
|
||||
|
||||
spi_device = spi->user;
|
||||
|
||||
memset(&tx, 0, sizeof(tx));
|
||||
tx.tx_buf = data;
|
||||
tx.len = size;
|
||||
|
||||
spi_message_init(&msg);
|
||||
spi_message_add_tail(&tx, &msg);
|
||||
result = spi_sync(spi_device->spi, &msg);
|
||||
|
||||
if (result < 0)
|
||||
return -EIO;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int cxd2880_spi_device_write_read(struct cxd2880_spi *spi,
|
||||
const u8 *tx_data,
|
||||
u32 tx_size,
|
||||
u8 *rx_data,
|
||||
u32 rx_size)
|
||||
{
|
||||
struct cxd2880_spi_device *spi_device = NULL;
|
||||
int result = 0;
|
||||
|
||||
if (!spi || !spi->user || !tx_data ||
|
||||
!tx_size || !rx_data || !rx_size)
|
||||
return -EINVAL;
|
||||
|
||||
spi_device = spi->user;
|
||||
|
||||
result = spi_write_then_read(spi_device->spi, tx_data,
|
||||
tx_size, rx_data, rx_size);
|
||||
if (result < 0)
|
||||
return -EIO;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
cxd2880_spi_device_initialize(struct cxd2880_spi_device *spi_device,
|
||||
enum cxd2880_spi_mode mode,
|
||||
u32 speed_hz)
|
||||
{
|
||||
int result = 0;
|
||||
struct spi_device *spi = spi_device->spi;
|
||||
|
||||
switch (mode) {
|
||||
case CXD2880_SPI_MODE_0:
|
||||
spi->mode = SPI_MODE_0;
|
||||
break;
|
||||
case CXD2880_SPI_MODE_1:
|
||||
spi->mode = SPI_MODE_1;
|
||||
break;
|
||||
case CXD2880_SPI_MODE_2:
|
||||
spi->mode = SPI_MODE_2;
|
||||
break;
|
||||
case CXD2880_SPI_MODE_3:
|
||||
spi->mode = SPI_MODE_3;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
spi->max_speed_hz = speed_hz;
|
||||
spi->bits_per_word = 8;
|
||||
result = spi_setup(spi);
|
||||
if (result != 0) {
|
||||
pr_err("spi_setup failed %d\n", result);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cxd2880_spi_device_create_spi(struct cxd2880_spi *spi,
|
||||
struct cxd2880_spi_device *spi_device)
|
||||
{
|
||||
if (!spi || !spi_device)
|
||||
return -EINVAL;
|
||||
|
||||
spi->read = NULL;
|
||||
spi->write = cxd2880_spi_device_write;
|
||||
spi->write_read = cxd2880_spi_device_write_read;
|
||||
spi->flags = 0;
|
||||
spi->user = spi_device;
|
||||
|
||||
return 0;
|
||||
}
|
26
drivers/media/dvb-frontends/cxd2880/cxd2880_spi_device.h
Normal file
26
drivers/media/dvb-frontends/cxd2880/cxd2880_spi_device.h
Normal file
|
@ -0,0 +1,26 @@
|
|||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* cxd2880_spi_device.h
|
||||
* Sony CXD2880 DVB-T2/T tuner + demodulator driver
|
||||
* SPI access interface
|
||||
*
|
||||
* Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
|
||||
*/
|
||||
|
||||
#ifndef CXD2880_SPI_DEVICE_H
|
||||
#define CXD2880_SPI_DEVICE_H
|
||||
|
||||
#include "cxd2880_spi.h"
|
||||
|
||||
struct cxd2880_spi_device {
|
||||
struct spi_device *spi;
|
||||
};
|
||||
|
||||
int cxd2880_spi_device_initialize(struct cxd2880_spi_device *spi_device,
|
||||
enum cxd2880_spi_mode mode,
|
||||
u32 speedHz);
|
||||
|
||||
int cxd2880_spi_device_create_spi(struct cxd2880_spi *spi,
|
||||
struct cxd2880_spi_device *spi_device);
|
||||
|
||||
#endif /* CXD2880_SPI_DEVICE_H */
|
Loading…
Reference in a new issue