mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-27 06:34:11 +08:00
[media] dvbsky: new driver to support DVBSky S860/S960 devices
Support for DVBSky dvb-s2 usb: add dvb-usb-v2 driver for DVBSky dvb-s2 box, no ci support yet. Signed-off-by: Nibble Max <nibble.max@gmail.com> Reviewed-by: Antti Palosaari <crope@iki.fi> Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
This commit is contained in:
nibble.max
Mauro Carvalho Chehab
parent
8db3e5df4b
commit
af64fb3fa4
@ -141,3 +141,10 @@ config DVB_USB_RTL28XXU
|
||||
help
|
||||
Say Y here to support the Realtek RTL28xxU DVB USB receiver.
|
||||
|
||||
config DVB_USB_DVBSKY
|
||||
tristate "DVBSky USB support"
|
||||
depends on DVB_USB_V2
|
||||
select DVB_M88DS3103 if MEDIA_SUBDRV_AUTOSELECT
|
||||
select MEDIA_TUNER_M88TS2022 if MEDIA_SUBDRV_AUTOSELECT
|
||||
help
|
||||
Say Y here to support the USB receivers from DVBSky.
|
||||
|
||||
@ -37,6 +37,9 @@ obj-$(CONFIG_DVB_USB_MXL111SF) += mxl111sf-tuner.o
|
||||
dvb-usb-rtl28xxu-objs := rtl28xxu.o
|
||||
obj-$(CONFIG_DVB_USB_RTL28XXU) += dvb-usb-rtl28xxu.o
|
||||
|
||||
dvb-usb-dvbsky-objs := dvbsky.o
|
||||
obj-$(CONFIG_DVB_USB_DVBSKY) += dvb-usb-dvbsky.o
|
||||
|
||||
ccflags-y += -I$(srctree)/drivers/media/dvb-core
|
||||
ccflags-y += -I$(srctree)/drivers/media/dvb-frontends
|
||||
ccflags-y += -I$(srctree)/drivers/media/tuners
|
||||
|
||||
460
drivers/media/usb/dvb-usb-v2/dvbsky.c
Normal file
460
drivers/media/usb/dvb-usb-v2/dvbsky.c
Normal file
@ -0,0 +1,460 @@
|
||||
/*
|
||||
* Driver for DVBSky USB2.0 receiver
|
||||
*
|
||||
* Copyright (C) 2013 Max nibble <nibble.max@gmail.com>
|
||||
*
|
||||
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*/
|
||||
|
||||
#include "dvb_usb.h"
|
||||
#include "m88ds3103.h"
|
||||
#include "m88ts2022.h"
|
||||
|
||||
#define DVBSKY_MSG_DELAY 0/*2000*/
|
||||
#define DVBSKY_BUF_LEN 64
|
||||
|
||||
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
|
||||
|
||||
struct dvbsky_state {
|
||||
struct mutex stream_mutex;
|
||||
u8 ibuf[DVBSKY_BUF_LEN];
|
||||
u8 obuf[DVBSKY_BUF_LEN];
|
||||
u8 last_lock;
|
||||
struct i2c_client *i2c_client_tuner;
|
||||
|
||||
/* fe hook functions*/
|
||||
int (*fe_set_voltage)(struct dvb_frontend *fe,
|
||||
fe_sec_voltage_t voltage);
|
||||
int (*fe_read_status)(struct dvb_frontend *fe,
|
||||
fe_status_t *status);
|
||||
};
|
||||
|
||||
static int dvbsky_usb_generic_rw(struct dvb_usb_device *d,
|
||||
u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
|
||||
{
|
||||
int ret;
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
|
||||
mutex_lock(&d->usb_mutex);
|
||||
if (wlen != 0)
|
||||
memcpy(state->obuf, wbuf, wlen);
|
||||
|
||||
ret = dvb_usbv2_generic_rw_locked(d, state->obuf, wlen,
|
||||
state->ibuf, rlen);
|
||||
|
||||
if (!ret && (rlen != 0))
|
||||
memcpy(rbuf, state->ibuf, rlen);
|
||||
|
||||
mutex_unlock(&d->usb_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int dvbsky_stream_ctrl(struct dvb_usb_device *d, u8 onoff)
|
||||
{
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
int ret;
|
||||
u8 obuf_pre[3] = { 0x37, 0, 0 };
|
||||
u8 obuf_post[3] = { 0x36, 3, 0 };
|
||||
|
||||
mutex_lock(&state->stream_mutex);
|
||||
ret = dvbsky_usb_generic_rw(d, obuf_pre, 3, NULL, 0);
|
||||
if (!ret && onoff) {
|
||||
msleep(20);
|
||||
ret = dvbsky_usb_generic_rw(d, obuf_post, 3, NULL, 0);
|
||||
}
|
||||
mutex_unlock(&state->stream_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int dvbsky_streaming_ctrl(struct dvb_frontend *fe, int onoff)
|
||||
{
|
||||
struct dvb_usb_device *d = fe_to_d(fe);
|
||||
|
||||
return dvbsky_stream_ctrl(d, (onoff == 0) ? 0 : 1);
|
||||
}
|
||||
|
||||
/* GPIO */
|
||||
static int dvbsky_gpio_ctrl(struct dvb_usb_device *d, u8 gport, u8 value)
|
||||
{
|
||||
int ret;
|
||||
u8 obuf[3], ibuf[2];
|
||||
|
||||
obuf[0] = 0x0e;
|
||||
obuf[1] = gport;
|
||||
obuf[2] = value;
|
||||
ret = dvbsky_usb_generic_rw(d, obuf, 3, ibuf, 1);
|
||||
if (ret)
|
||||
dev_err(&d->udev->dev, "%s: %s() failed=%d\n",
|
||||
KBUILD_MODNAME, __func__, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* I2C */
|
||||
static int dvbsky_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
|
||||
int num)
|
||||
{
|
||||
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
||||
int ret = 0;
|
||||
u8 ibuf[64], obuf[64];
|
||||
|
||||
if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
|
||||
return -EAGAIN;
|
||||
|
||||
if (num > 2) {
|
||||
dev_err(&d->udev->dev,
|
||||
"dvbsky_usb: too many i2c messages[%d] than 2.", num);
|
||||
ret = -EOPNOTSUPP;
|
||||
goto i2c_error;
|
||||
}
|
||||
|
||||
if (num == 1) {
|
||||
if (msg[0].len > 60) {
|
||||
dev_err(&d->udev->dev,
|
||||
"dvbsky_usb: too many i2c bytes[%d] than 60.",
|
||||
msg[0].len);
|
||||
ret = -EOPNOTSUPP;
|
||||
goto i2c_error;
|
||||
}
|
||||
if (msg[0].flags & I2C_M_RD) {
|
||||
/* single read */
|
||||
obuf[0] = 0x09;
|
||||
obuf[1] = 0;
|
||||
obuf[2] = msg[0].len;
|
||||
obuf[3] = msg[0].addr;
|
||||
ret = dvbsky_usb_generic_rw(d, obuf, 4,
|
||||
ibuf, msg[0].len + 1);
|
||||
if (ret)
|
||||
dev_err(&d->udev->dev, "%s: %s() failed=%d\n",
|
||||
KBUILD_MODNAME, __func__, ret);
|
||||
if (!ret)
|
||||
memcpy(msg[0].buf, &ibuf[1], msg[0].len);
|
||||
} else {
|
||||
/* write */
|
||||
obuf[0] = 0x08;
|
||||
obuf[1] = msg[0].addr;
|
||||
obuf[2] = msg[0].len;
|
||||
memcpy(&obuf[3], msg[0].buf, msg[0].len);
|
||||
ret = dvbsky_usb_generic_rw(d, obuf,
|
||||
msg[0].len + 3, ibuf, 1);
|
||||
if (ret)
|
||||
dev_err(&d->udev->dev, "%s: %s() failed=%d\n",
|
||||
KBUILD_MODNAME, __func__, ret);
|
||||
}
|
||||
} else {
|
||||
if ((msg[0].len > 60) || (msg[1].len > 60)) {
|
||||
dev_err(&d->udev->dev,
|
||||
"dvbsky_usb: too many i2c bytes[w-%d][r-%d] than 60.",
|
||||
msg[0].len, msg[1].len);
|
||||
ret = -EOPNOTSUPP;
|
||||
goto i2c_error;
|
||||
}
|
||||
/* write then read */
|
||||
obuf[0] = 0x09;
|
||||
obuf[1] = msg[0].len;
|
||||
obuf[2] = msg[1].len;
|
||||
obuf[3] = msg[0].addr;
|
||||
memcpy(&obuf[4], msg[0].buf, msg[0].len);
|
||||
ret = dvbsky_usb_generic_rw(d, obuf,
|
||||
msg[0].len + 4, ibuf, msg[1].len + 1);
|
||||
if (ret)
|
||||
dev_err(&d->udev->dev, "%s: %s() failed=%d\n",
|
||||
KBUILD_MODNAME, __func__, ret);
|
||||
|
||||
if (!ret)
|
||||
memcpy(msg[1].buf, &ibuf[1], msg[1].len);
|
||||
}
|
||||
i2c_error:
|
||||
mutex_unlock(&d->i2c_mutex);
|
||||
return (ret) ? ret : num;
|
||||
}
|
||||
|
||||
static u32 dvbsky_i2c_func(struct i2c_adapter *adapter)
|
||||
{
|
||||
return I2C_FUNC_I2C;
|
||||
}
|
||||
|
||||
static struct i2c_algorithm dvbsky_i2c_algo = {
|
||||
.master_xfer = dvbsky_i2c_xfer,
|
||||
.functionality = dvbsky_i2c_func,
|
||||
};
|
||||
|
||||
#if IS_ENABLED(CONFIG_RC_CORE)
|
||||
static int dvbsky_rc_query(struct dvb_usb_device *d)
|
||||
{
|
||||
u32 code = 0xffff, scancode;
|
||||
u8 rc5_command, rc5_system;
|
||||
u8 obuf[2], ibuf[2], toggle;
|
||||
int ret;
|
||||
|
||||
obuf[0] = 0x10;
|
||||
ret = dvbsky_usb_generic_rw(d, obuf, 1, ibuf, 2);
|
||||
if (ret)
|
||||
dev_err(&d->udev->dev, "%s: %s() failed=%d\n",
|
||||
KBUILD_MODNAME, __func__, ret);
|
||||
if (ret == 0)
|
||||
code = (ibuf[0] << 8) | ibuf[1];
|
||||
if (code != 0xffff) {
|
||||
dev_dbg(&d->udev->dev, "rc code: %x\n", code);
|
||||
rc5_command = code & 0x3F;
|
||||
rc5_system = (code & 0x7C0) >> 6;
|
||||
toggle = (code & 0x800) ? 1 : 0;
|
||||
scancode = rc5_system << 8 | rc5_command;
|
||||
rc_keydown(d->rc_dev, RC_TYPE_RC5, scancode, toggle);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dvbsky_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
|
||||
{
|
||||
rc->allowed_protos = RC_BIT_RC5;
|
||||
rc->query = dvbsky_rc_query;
|
||||
rc->interval = 300;
|
||||
return 0;
|
||||
}
|
||||
#else
|
||||
#define dvbsky_get_rc_config NULL
|
||||
#endif
|
||||
|
||||
static int dvbsky_usb_set_voltage(struct dvb_frontend *fe,
|
||||
fe_sec_voltage_t voltage)
|
||||
{
|
||||
struct dvb_usb_device *d = fe_to_d(fe);
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
u8 value;
|
||||
|
||||
if (voltage == SEC_VOLTAGE_OFF)
|
||||
value = 0;
|
||||
else
|
||||
value = 1;
|
||||
dvbsky_gpio_ctrl(d, 0x80, value);
|
||||
|
||||
return state->fe_set_voltage(fe, voltage);
|
||||
}
|
||||
|
||||
static int dvbsky_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6])
|
||||
{
|
||||
struct dvb_usb_device *d = adap_to_d(adap);
|
||||
u8 obuf[] = { 0x1e, 0x00 };
|
||||
u8 ibuf[6] = { 0 };
|
||||
struct i2c_msg msg[] = {
|
||||
{
|
||||
.addr = 0x51,
|
||||
.flags = 0,
|
||||
.buf = obuf,
|
||||
.len = 2,
|
||||
}, {
|
||||
.addr = 0x51,
|
||||
.flags = I2C_M_RD,
|
||||
.buf = ibuf,
|
||||
.len = 6,
|
||||
}
|
||||
};
|
||||
|
||||
if (i2c_transfer(&d->i2c_adap, msg, 2) == 2)
|
||||
memcpy(mac, ibuf, 6);
|
||||
|
||||
dev_info(&d->udev->dev, "dvbsky_usb MAC address=%pM\n", mac);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dvbsky_usb_read_status(struct dvb_frontend *fe, fe_status_t *status)
|
||||
{
|
||||
struct dvb_usb_device *d = fe_to_d(fe);
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
int ret;
|
||||
|
||||
ret = state->fe_read_status(fe, status);
|
||||
|
||||
/* it need resync slave fifo when signal change from unlock to lock.*/
|
||||
if ((*status & FE_HAS_LOCK) && (!state->last_lock))
|
||||
dvbsky_stream_ctrl(d, 1);
|
||||
|
||||
state->last_lock = (*status & FE_HAS_LOCK) ? 1 : 0;
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct m88ds3103_config dvbsky_s960_m88ds3103_config = {
|
||||
.i2c_addr = 0x68,
|
||||
.clock = 27000000,
|
||||
.i2c_wr_max = 33,
|
||||
.clock_out = 0,
|
||||
.ts_mode = M88DS3103_TS_CI,
|
||||
.ts_clk = 16000,
|
||||
.ts_clk_pol = 0,
|
||||
.agc = 0x99,
|
||||
.lnb_hv_pol = 1,
|
||||
.lnb_en_pol = 1,
|
||||
};
|
||||
|
||||
static int dvbsky_s960_attach(struct dvb_usb_adapter *adap)
|
||||
{
|
||||
struct dvbsky_state *state = adap_to_priv(adap);
|
||||
struct dvb_usb_device *d = adap_to_d(adap);
|
||||
int ret = 0;
|
||||
/* demod I2C adapter */
|
||||
struct i2c_adapter *i2c_adapter;
|
||||
struct i2c_client *client;
|
||||
struct i2c_board_info info;
|
||||
struct m88ts2022_config m88ts2022_config = {
|
||||
.clock = 27000000,
|
||||
};
|
||||
memset(&info, 0, sizeof(struct i2c_board_info));
|
||||
|
||||
/* attach demod */
|
||||
adap->fe[0] = dvb_attach(m88ds3103_attach,
|
||||
&dvbsky_s960_m88ds3103_config,
|
||||
&d->i2c_adap,
|
||||
&i2c_adapter);
|
||||
if (!adap->fe[0]) {
|
||||
dev_err(&d->udev->dev, "dvbsky_s960_attach fail.\n");
|
||||
ret = -ENODEV;
|
||||
goto fail_attach;
|
||||
}
|
||||
|
||||
/* attach tuner */
|
||||
m88ts2022_config.fe = adap->fe[0];
|
||||
strlcpy(info.type, "m88ts2022", I2C_NAME_SIZE);
|
||||
info.addr = 0x60;
|
||||
info.platform_data = &m88ts2022_config;
|
||||
request_module("m88ts2022");
|
||||
client = i2c_new_device(i2c_adapter, &info);
|
||||
if (client == NULL || client->dev.driver == NULL) {
|
||||
dvb_frontend_detach(adap->fe[0]);
|
||||
ret = -ENODEV;
|
||||
goto fail_attach;
|
||||
}
|
||||
|
||||
if (!try_module_get(client->dev.driver->owner)) {
|
||||
i2c_unregister_device(client);
|
||||
dvb_frontend_detach(adap->fe[0]);
|
||||
ret = -ENODEV;
|
||||
goto fail_attach;
|
||||
}
|
||||
|
||||
/* delegate signal strength measurement to tuner */
|
||||
adap->fe[0]->ops.read_signal_strength =
|
||||
adap->fe[0]->ops.tuner_ops.get_rf_strength;
|
||||
|
||||
/* hook fe: need to resync the slave fifo when signal locks. */
|
||||
state->fe_read_status = adap->fe[0]->ops.read_status;
|
||||
adap->fe[0]->ops.read_status = dvbsky_usb_read_status;
|
||||
|
||||
/* hook fe: LNB off/on is control by Cypress usb chip. */
|
||||
state->fe_set_voltage = adap->fe[0]->ops.set_voltage;
|
||||
adap->fe[0]->ops.set_voltage = dvbsky_usb_set_voltage;
|
||||
|
||||
state->i2c_client_tuner = client;
|
||||
|
||||
fail_attach:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int dvbsky_identify_state(struct dvb_usb_device *d, const char **name)
|
||||
{
|
||||
dvbsky_gpio_ctrl(d, 0x04, 1);
|
||||
msleep(20);
|
||||
dvbsky_gpio_ctrl(d, 0x83, 0);
|
||||
dvbsky_gpio_ctrl(d, 0xc0, 1);
|
||||
msleep(100);
|
||||
dvbsky_gpio_ctrl(d, 0x83, 1);
|
||||
dvbsky_gpio_ctrl(d, 0xc0, 0);
|
||||
msleep(50);
|
||||
|
||||
return WARM;
|
||||
}
|
||||
|
||||
static int dvbsky_init(struct dvb_usb_device *d)
|
||||
{
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
|
||||
/* use default interface */
|
||||
/*
|
||||
ret = usb_set_interface(d->udev, 0, 0);
|
||||
if (ret)
|
||||
return ret;
|
||||
*/
|
||||
mutex_init(&state->stream_mutex);
|
||||
|
||||
state->last_lock = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void dvbsky_exit(struct dvb_usb_device *d)
|
||||
{
|
||||
struct dvbsky_state *state = d_to_priv(d);
|
||||
struct i2c_client *client;
|
||||
|
||||
client = state->i2c_client_tuner;
|
||||
/* remove I2C tuner */
|
||||
if (client) {
|
||||
module_put(client->dev.driver->owner);
|
||||
i2c_unregister_device(client);
|
||||
}
|
||||
}
|
||||
|
||||
/* DVB USB Driver stuff */
|
||||
static struct dvb_usb_device_properties dvbsky_s960_props = {
|
||||
.driver_name = KBUILD_MODNAME,
|
||||
.owner = THIS_MODULE,
|
||||
.adapter_nr = adapter_nr,
|
||||
.size_of_priv = sizeof(struct dvbsky_state),
|
||||
|
||||
.generic_bulk_ctrl_endpoint = 0x01,
|
||||
.generic_bulk_ctrl_endpoint_response = 0x81,
|
||||
.generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY,
|
||||
|
||||
.i2c_algo = &dvbsky_i2c_algo,
|
||||
.frontend_attach = dvbsky_s960_attach,
|
||||
.init = dvbsky_init,
|
||||
.get_rc_config = dvbsky_get_rc_config,
|
||||
.streaming_ctrl = dvbsky_streaming_ctrl,
|
||||
.identify_state = dvbsky_identify_state,
|
||||
.exit = dvbsky_exit,
|
||||
.read_mac_address = dvbsky_read_mac_addr,
|
||||
|
||||
.num_adapters = 1,
|
||||
.adapter = {
|
||||
{
|
||||
.stream = DVB_USB_STREAM_BULK(0x82, 8, 4096),
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
static const struct usb_device_id dvbsky_id_table[] = {
|
||||
{ DVB_USB_DEVICE(0x0572, 0x6831,
|
||||
&dvbsky_s960_props, "DVBSky S960/S860", RC_MAP_DVBSKY) },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(usb, dvbsky_id_table);
|
||||
|
||||
static struct usb_driver dvbsky_usb_driver = {
|
||||
.name = KBUILD_MODNAME,
|
||||
.id_table = dvbsky_id_table,
|
||||
.probe = dvb_usbv2_probe,
|
||||
.disconnect = dvb_usbv2_disconnect,
|
||||
.suspend = dvb_usbv2_suspend,
|
||||
.resume = dvb_usbv2_resume,
|
||||
.reset_resume = dvb_usbv2_reset_resume,
|
||||
.no_dynamic_id = 1,
|
||||
.soft_unbind = 1,
|
||||
};
|
||||
|
||||
module_usb_driver(dvbsky_usb_driver);
|
||||
|
||||
MODULE_AUTHOR("Max nibble <nibble.max@gmail.com>");
|
||||
MODULE_DESCRIPTION("Driver for DVBSky USB");
|
||||
MODULE_LICENSE("GPL");
|
||||
Loading…
Reference in New Issue
Block a user