Commit af64fb3f authored by nibble.max's avatar nibble.max Committed by Mauro Carvalho Chehab
Browse files

[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: default avatarNibble Max <nibble.max@gmail.com>
Reviewed-by: default avatarAntti Palosaari <crope@iki.fi>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@osg.samsung.com>
parent 8db3e5df

drivers/media/usb/dvb-usb-v2/Kconfig

+7 −0
Original line number Diff line number Diff line
@@ -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.

drivers/media/usb/dvb-usb-v2/Makefile

+3 −0
Original line number Diff line number Diff line
@@ -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

drivers/media/usb/dvb-usb-v2/dvbsky.c

0 → 100644
+460 −0
Original line number Diff line number Diff line 
/*

 * 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");