drivers/media/dvb/dvb-usb/dvb_usb_dvb.c - kernel/msm-4.9 - Gitiles

 /* dvb-usb-dvb.c is part of the DVB USB library.
  *
  * Copyright (C) 2004-6 Patrick Boettcher (patrick.boettcher@desy.de)
  * see dvb-usb-init.c for copyright information.
  *
  * This file contains functions for initializing and handling the
  * linux-dvb API.
  */
 #include "dvb_usb_common.h"

 static void dvb_usb_data_complete(struct usb_data_stream *stream, u8 *buffer,
 		size_t length)
 {
 	struct dvb_usb_adapter *adap = stream->user_priv;
 	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
 		dvb_dmx_swfilter(&adap->demux, buffer, length);
 }

 static void dvb_usb_data_complete_204(struct usb_data_stream *stream,
 		u8 *buffer, size_t length)
 {
 	struct dvb_usb_adapter *adap = stream->user_priv;
 	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
 		dvb_dmx_swfilter_204(&adap->demux, buffer, length);
 }

 static void dvb_usb_data_complete_raw(struct usb_data_stream *stream,
 				      u8 *buffer, size_t length)
 {
 	struct dvb_usb_adapter *adap = stream->user_priv;
 	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
 		dvb_dmx_swfilter_raw(&adap->demux, buffer, length);
 }

 int dvb_usbv2_adapter_stream_init(struct dvb_usb_adapter *adap)
 {
 	int ret;
 	struct usb_data_stream_properties stream_props;

 	adap->stream.udev = adap->dev->udev;
 	adap->stream.user_priv = adap;

 	/* resolve USB stream configuration for buffer alloc */
 	if (adap->dev->props.get_usb_stream_config) {
 		ret = adap->dev->props.get_usb_stream_config(NULL,
 				&stream_props);
 		if (ret < 0)
 			return ret;
 	} else {
 		stream_props = adap->props.stream;
 	}

 	/* FIXME: can be removed as set later in anyway */
 	adap->stream.complete = dvb_usb_data_complete;

 	return usb_urb_initv2(&adap->stream, &stream_props);
 }

 int dvb_usbv2_adapter_stream_exit(struct dvb_usb_adapter *adap)
 {
 	usb_urb_exitv2(&adap->stream);
 	return 0;
 }

 /* does the complete input transfer handling */
 static int dvb_usb_ctrl_feed(struct dvb_demux_feed *dvbdmxfeed, int onoff)
 {
 	struct dvb_usb_adapter *adap = dvbdmxfeed->demux->priv;
 	int newfeedcount, ret;

 	if (adap == NULL || adap->active_fe < 0) {
 		ret = -ENODEV;
 		goto err;
 	}

 	newfeedcount = adap->feedcount + (onoff ? 1 : -1);

 	/* stop feed before setting a new pid if there will be no pid anymore */
 	if (newfeedcount == 0) {
 		pr_debug("%s: stop feeding\n", __func__);
 		usb_urb_killv2(&adap->stream);

 		if (adap->dev->props.streaming_ctrl != NULL) {
 			ret = adap->dev->props.streaming_ctrl(adap, 0);
 			if (ret < 0) {
 				pr_err("%s: error while stopping stream\n",
 						KBUILD_MODNAME);
 				return ret;
 			}
 		}
 	}

 	adap->feedcount = newfeedcount;

 	/* activate the pid on the device specific pid_filter */
 	pr_debug("%s: setting pid (%s): %5d %04x at index %d '%s'\n", __func__,
 			adap->pid_filtering ? "yes" : "no", dvbdmxfeed->pid,
 			dvbdmxfeed->pid, dvbdmxfeed->index,
 			onoff ? "on" : "off");
 	if (adap->props.caps & DVB_USB_ADAP_HAS_PID_FILTER &&
 			adap->pid_filtering &&
 			adap->props.pid_filter != NULL)
 		adap->props.pid_filter(adap, dvbdmxfeed->index,
 				dvbdmxfeed->pid, onoff);

 	/* start the feed if this was the first feed and there is still a feed
 	 * for reception.
 	 */
 	if (adap->feedcount == onoff && adap->feedcount > 0) {
 		struct usb_data_stream_properties stream_props;
 		unsigned int ts_props;

 		/* resolve TS configuration */
 		if (adap->dev->props.get_ts_config) {
 			ret = adap->dev->props.get_ts_config(
 					adap->fe[adap->active_fe],
 					&ts_props);
 			if (ret < 0)
 				return ret;
 		} else {
 			ts_props = 0; /* normal 188 payload only TS */
 		}

 		if (ts_props & DVB_USB_ADAP_RECEIVES_204_BYTE_TS)
 			adap->stream.complete = dvb_usb_data_complete_204;
 		else if (ts_props & DVB_USB_ADAP_RECEIVES_RAW_PAYLOAD)
 			adap->stream.complete = dvb_usb_data_complete_raw;
 		else
 			adap->stream.complete = dvb_usb_data_complete;

 		/* resolve USB stream configuration */
 		if (adap->dev->props.get_usb_stream_config) {
 			ret = adap->dev->props.get_usb_stream_config(
 					adap->fe[adap->active_fe],
 					&stream_props);
 			if (ret < 0)
 				return ret;
 		} else {
 			stream_props = adap->props.stream;
 		}

 		pr_debug("%s: submitting all URBs\n", __func__);

 		usb_urb_submitv2(&adap->stream, &stream_props);

 		pr_debug("%s: controlling pid parser\n", __func__);
 		if (adap->props.caps & DVB_USB_ADAP_HAS_PID_FILTER &&
 				adap->props.caps &
 				DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF &&
 				adap->props.pid_filter_ctrl != NULL) {
 			ret = adap->props.pid_filter_ctrl(adap,
 					adap->pid_filtering);
 			if (ret < 0) {
 				pr_err("%s: could not handle pid_parser\n",
 						KBUILD_MODNAME);
 				return ret;
 			}
 		}
 		pr_debug("%s: start feeding\n", __func__);
 		if (adap->dev->props.streaming_ctrl != NULL) {
 			ret = adap->dev->props.streaming_ctrl(adap, 1);
 			if (ret < 0) {
 				pr_err("%s: error while enabling fifo\n",
 						KBUILD_MODNAME);
 				return ret;
 			}
 		}

 	}
 	return 0;
 err:
 	pr_debug("%s: failed=%d\n", __func__, ret);
 	return ret;
 }

 static int dvb_usb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
 {
 	pr_debug("%s: start pid=%04x feedtype=%d\n", __func__, dvbdmxfeed->pid,
 			dvbdmxfeed->type);
 	return dvb_usb_ctrl_feed(dvbdmxfeed, 1);
 }

 static int dvb_usb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
 {
 	pr_debug("%s: stop pid=%04x feedtype=%d\n", __func__, dvbdmxfeed->pid,
 			dvbdmxfeed->type);
 	return dvb_usb_ctrl_feed(dvbdmxfeed, 0);
 }

 int dvb_usbv2_adapter_dvb_init(struct dvb_usb_adapter *adap)
 {
 	int ret = dvb_register_adapter(&adap->dvb_adap, adap->dev->name,
 				       adap->dev->props.owner,
 				       &adap->dev->udev->dev,
 				       adap->dev->props.adapter_nr);
 	if (ret < 0) {
 		pr_debug("%s: dvb_register_adapter failed=%d\n", __func__, ret);
 		goto err;
 	}
 	adap->dvb_adap.priv = adap;
 	adap->dvb_adap.fe_ioctl_override = adap->props.fe_ioctl_override;

 	if (adap->dev->props.read_mac_address) {
 		if (adap->dev->props.read_mac_address(adap->dev,
 				adap->dvb_adap.proposed_mac) == 0)
 			pr_info("%s: MAC address: %pM\n", KBUILD_MODNAME,
 					adap->dvb_adap.proposed_mac);
 		else
 			pr_err("%s: MAC address reading failed\n",
 					KBUILD_MODNAME);
 	}


 	adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;
 	adap->demux.priv             = adap;

 	adap->demux.filternum        = 0;
 	if (adap->demux.filternum < adap->max_feed_count)
 		adap->demux.filternum = adap->max_feed_count;
 	adap->demux.feednum          = adap->demux.filternum;
 	adap->demux.start_feed       = dvb_usb_start_feed;
 	adap->demux.stop_feed        = dvb_usb_stop_feed;
 	adap->demux.write_to_decoder = NULL;
 	ret = dvb_dmx_init(&adap->demux);
 	if (ret < 0) {
 		pr_err("%s: dvb_dmx_init() failed=%d\n", KBUILD_MODNAME, ret);
 		goto err_dmx;
 	}

 	adap->dmxdev.filternum       = adap->demux.filternum;
 	adap->dmxdev.demux           = &adap->demux.dmx;
 	adap->dmxdev.capabilities    = 0;
 	ret = dvb_dmxdev_init(&adap->dmxdev, &adap->dvb_adap);
 	if (ret < 0) {
 		pr_err("%s: dvb_dmxdev_init() failed=%d\n", KBUILD_MODNAME,
 				ret);
 		goto err_dmx_dev;
 	}

 	ret = dvb_net_init(&adap->dvb_adap, &adap->dvb_net, &adap->demux.dmx);
 	if (ret < 0) {
 		pr_err("%s: dvb_net_init() failed=%d\n", KBUILD_MODNAME, ret);
 		goto err_net_init;
 	}

 	adap->state |= DVB_USB_ADAP_STATE_DVB;
 	return 0;

 err_net_init:
 	dvb_dmxdev_release(&adap->dmxdev);
 err_dmx_dev:
 	dvb_dmx_release(&adap->demux);
 err_dmx:
 	dvb_unregister_adapter(&adap->dvb_adap);
 err:
 	return ret;
 }

 int dvb_usbv2_adapter_dvb_exit(struct dvb_usb_adapter *adap)
 {
 	if (adap->state & DVB_USB_ADAP_STATE_DVB) {
 		pr_debug("%s: unregistering DVB part\n", __func__);
 		dvb_net_release(&adap->dvb_net);
 		adap->demux.dmx.close(&adap->demux.dmx);
 		dvb_dmxdev_release(&adap->dmxdev);
 		dvb_dmx_release(&adap->demux);
 		dvb_unregister_adapter(&adap->dvb_adap);
 		adap->state &= ~DVB_USB_ADAP_STATE_DVB;
 	}
 	return 0;
 }

 static int dvb_usb_fe_wakeup(struct dvb_frontend *fe)
 {
 	int ret;
 	struct dvb_usb_adapter *adap = fe->dvb->priv;

 	ret = dvb_usbv2_device_power_ctrl(adap->dev, 1);
 	if (ret < 0)
 		goto err;

 	if (adap->dev->props.frontend_ctrl) {
 		ret = adap->dev->props.frontend_ctrl(fe, 1);
 		if (ret < 0)
 			goto err;
 	}

 	if (adap->fe_init[fe->id]) {
 		ret = adap->fe_init[fe->id](fe);
 		if (ret < 0)
 			goto err;
 	}

 	adap->active_fe = fe->id;

 	return 0;
 err:
 	pr_debug("%s: failed=%d\n", __func__, ret);
 	return ret;
 }

 static int dvb_usb_fe_sleep(struct dvb_frontend *fe)
 {
 	int ret;
 	struct dvb_usb_adapter *adap = fe->dvb->priv;

 	if (adap->fe_sleep[fe->id]) {
 		ret = adap->fe_sleep[fe->id](fe);
 		if (ret < 0)
 			goto err;
 	}

 	if (adap->dev->props.frontend_ctrl) {
 		ret = adap->dev->props.frontend_ctrl(fe, 0);
 		if (ret < 0)
 			goto err;
 	}

 	ret = dvb_usbv2_device_power_ctrl(adap->dev, 0);
 	if (ret < 0)
 		goto err;

 	adap->active_fe = -1;

 	return 0;
 err:
 	pr_debug("%s: failed=%d\n", __func__, ret);
 	return ret;
 }

 int dvb_usbv2_adapter_frontend_init(struct dvb_usb_adapter *adap)
 {
 	int ret, i, count_registered = 0;

 	pr_debug("%s:\n", __func__);

 	memset(adap->fe, 0, sizeof(adap->fe));
 	adap->active_fe = -1;

 	if (adap->dev->props.frontend_attach) {
 		ret = adap->dev->props.frontend_attach(adap);
 		if (ret < 0) {
 			pr_debug("%s: frontend_attach() failed=%d\n", __func__,
 					ret);
 			goto err_dvb_frontend_detach;
 		}
 	} else {
 		pr_debug("%s: frontend_attach() do not exists\n", __func__);
 		ret = 0;
 		goto err;
 	}

 	if (adap->dev->props.tuner_attach) {
 		ret = adap->dev->props.tuner_attach(adap);
 		if (ret < 0) {
 			pr_debug("%s: tuner_attach() failed=%d\n", __func__,
 					ret);
 			goto err_dvb_frontend_detach;
 		}
 	}

 	for (i = 0; i < MAX_NO_OF_FE_PER_ADAP && adap->fe[i]; i++) {
 		adap->fe[i]->id = i;

 		/* re-assign sleep and wakeup functions */
 		adap->fe_init[i] = adap->fe[i]->ops.init;
 		adap->fe[i]->ops.init  = dvb_usb_fe_wakeup;
 		adap->fe_sleep[i] = adap->fe[i]->ops.sleep;
 		adap->fe[i]->ops.sleep = dvb_usb_fe_sleep;

 		ret = dvb_register_frontend(&adap->dvb_adap, adap->fe[i]);
 		if (ret < 0) {
 			pr_err("%s: frontend%d registration failed\n",
 					KBUILD_MODNAME, i);
 			goto err_dvb_unregister_frontend;
 		}

 		count_registered++;
 	}

 	adap->num_frontends_initialized = count_registered;

 	return 0;

 err_dvb_unregister_frontend:
 	for (i = count_registered - 1; i >= 0; i--)
 		dvb_unregister_frontend(adap->fe[i]);

 err_dvb_frontend_detach:
 	for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
 		if (adap->fe[i])
 			dvb_frontend_detach(adap->fe[i]);
 	}

 err:
 	pr_debug("%s: failed=%d\n", __func__, ret);
 	return ret;
 }

 int dvb_usbv2_adapter_frontend_exit(struct dvb_usb_adapter *adap)
 {
 	int i;

 	pr_debug("%s:\n", __func__);

 	for (i = adap->num_frontends_initialized - 1; i >= 0; i--) {
 		if (adap->fe[i]) {
 			dvb_unregister_frontend(adap->fe[i]);
 			dvb_frontend_detach(adap->fe[i]);
 		}
 	}

 	adap->num_frontends_initialized = 0;

 	return 0;
 }
	/* dvb-usb-dvb.c is part of the DVB USB library.
	*
	* Copyright (C) 2004-6 Patrick Boettcher (patrick.boettcher@desy.de)
	* see dvb-usb-init.c for copyright information.
	*
	* This file contains functions for initializing and handling the
	* linux-dvb API.
	*/
	#include "dvb_usb_common.h"

	static void dvb_usb_data_complete(struct usb_data_stream stream, u8 buffer,
	size_t length)
	{
	struct dvb_usb_adapter *adap = stream->user_priv;
	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
	dvb_dmx_swfilter(&adap->demux, buffer, length);
	}

	static void dvb_usb_data_complete_204(struct usb_data_stream *stream,
	u8 *buffer, size_t length)
	{
	struct dvb_usb_adapter *adap = stream->user_priv;
	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
	dvb_dmx_swfilter_204(&adap->demux, buffer, length);
	}

	static void dvb_usb_data_complete_raw(struct usb_data_stream *stream,
	u8 *buffer, size_t length)
	{
	struct dvb_usb_adapter *adap = stream->user_priv;
	if (adap->feedcount > 0 && adap->state & DVB_USB_ADAP_STATE_DVB)
	dvb_dmx_swfilter_raw(&adap->demux, buffer, length);
	}

	int dvb_usbv2_adapter_stream_init(struct dvb_usb_adapter *adap)
	{
	int ret;
	struct usb_data_stream_properties stream_props;

	adap->stream.udev = adap->dev->udev;
	adap->stream.user_priv = adap;

	/* resolve USB stream configuration for buffer alloc */
	if (adap->dev->props.get_usb_stream_config) {
	ret = adap->dev->props.get_usb_stream_config(NULL,
	&stream_props);
	if (ret < 0)
	return ret;
	} else {
	stream_props = adap->props.stream;
	}

	/* FIXME: can be removed as set later in anyway */
	adap->stream.complete = dvb_usb_data_complete;

	return usb_urb_initv2(&adap->stream, &stream_props);
	}

	int dvb_usbv2_adapter_stream_exit(struct dvb_usb_adapter *adap)
	{
	usb_urb_exitv2(&adap->stream);
	return 0;
	}

	/* does the complete input transfer handling */
	static int dvb_usb_ctrl_feed(struct dvb_demux_feed *dvbdmxfeed, int onoff)
	{
	struct dvb_usb_adapter *adap = dvbdmxfeed->demux->priv;
	int newfeedcount, ret;

	if (adap == NULL \|\| adap->active_fe < 0) {
	ret = -ENODEV;
	goto err;
	}

	newfeedcount = adap->feedcount + (onoff ? 1 : -1);

	/* stop feed before setting a new pid if there will be no pid anymore */
	if (newfeedcount == 0) {
	pr_debug("%s: stop feeding\n", __func__);
	usb_urb_killv2(&adap->stream);

	if (adap->dev->props.streaming_ctrl != NULL) {
	ret = adap->dev->props.streaming_ctrl(adap, 0);
	if (ret < 0) {
	pr_err("%s: error while stopping stream\n",
	KBUILD_MODNAME);
	return ret;
	}
	}
	}

	adap->feedcount = newfeedcount;

	/* activate the pid on the device specific pid_filter */
	pr_debug("%s: setting pid (%s): %5d %04x at index %d '%s'\n", __func__,
	adap->pid_filtering ? "yes" : "no", dvbdmxfeed->pid,
	dvbdmxfeed->pid, dvbdmxfeed->index,
	onoff ? "on" : "off");
	if (adap->props.caps & DVB_USB_ADAP_HAS_PID_FILTER &&
	adap->pid_filtering &&
	adap->props.pid_filter != NULL)
	adap->props.pid_filter(adap, dvbdmxfeed->index,
	dvbdmxfeed->pid, onoff);

	/* start the feed if this was the first feed and there is still a feed
	* for reception.
	*/
	if (adap->feedcount == onoff && adap->feedcount > 0) {
	struct usb_data_stream_properties stream_props;
	unsigned int ts_props;

	/* resolve TS configuration */
	if (adap->dev->props.get_ts_config) {
	ret = adap->dev->props.get_ts_config(
	adap->fe[adap->active_fe],
	&ts_props);
	if (ret < 0)
	return ret;
	} else {
	ts_props = 0; /* normal 188 payload only TS */
	}

	if (ts_props & DVB_USB_ADAP_RECEIVES_204_BYTE_TS)
	adap->stream.complete = dvb_usb_data_complete_204;
	else if (ts_props & DVB_USB_ADAP_RECEIVES_RAW_PAYLOAD)
	adap->stream.complete = dvb_usb_data_complete_raw;
	else
	adap->stream.complete = dvb_usb_data_complete;

	/* resolve USB stream configuration */
	if (adap->dev->props.get_usb_stream_config) {
	ret = adap->dev->props.get_usb_stream_config(
	adap->fe[adap->active_fe],
	&stream_props);
	if (ret < 0)
	return ret;
	} else {
	stream_props = adap->props.stream;
	}

	pr_debug("%s: submitting all URBs\n", __func__);

	usb_urb_submitv2(&adap->stream, &stream_props);

	pr_debug("%s: controlling pid parser\n", __func__);
	if (adap->props.caps & DVB_USB_ADAP_HAS_PID_FILTER &&
	adap->props.caps &
	DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF &&
	adap->props.pid_filter_ctrl != NULL) {
	ret = adap->props.pid_filter_ctrl(adap,
	adap->pid_filtering);
	if (ret < 0) {
	pr_err("%s: could not handle pid_parser\n",
	KBUILD_MODNAME);
	return ret;
	}
	}
	pr_debug("%s: start feeding\n", __func__);
	if (adap->dev->props.streaming_ctrl != NULL) {
	ret = adap->dev->props.streaming_ctrl(adap, 1);
	if (ret < 0) {
	pr_err("%s: error while enabling fifo\n",
	KBUILD_MODNAME);
	return ret;
	}
	}

	}
	return 0;
	err:
	pr_debug("%s: failed=%d\n", __func__, ret);
	return ret;
	}

	static int dvb_usb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
	{
	pr_debug("%s: start pid=%04x feedtype=%d\n", __func__, dvbdmxfeed->pid,
	dvbdmxfeed->type);
	return dvb_usb_ctrl_feed(dvbdmxfeed, 1);
	}

	static int dvb_usb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
	{
	pr_debug("%s: stop pid=%04x feedtype=%d\n", __func__, dvbdmxfeed->pid,
	dvbdmxfeed->type);
	return dvb_usb_ctrl_feed(dvbdmxfeed, 0);
	}

	int dvb_usbv2_adapter_dvb_init(struct dvb_usb_adapter *adap)
	{
	int ret = dvb_register_adapter(&adap->dvb_adap, adap->dev->name,
	adap->dev->props.owner,
	&adap->dev->udev->dev,
	adap->dev->props.adapter_nr);
	if (ret < 0) {
	pr_debug("%s: dvb_register_adapter failed=%d\n", __func__, ret);
	goto err;
	}
	adap->dvb_adap.priv = adap;
	adap->dvb_adap.fe_ioctl_override = adap->props.fe_ioctl_override;

	if (adap->dev->props.read_mac_address) {
	if (adap->dev->props.read_mac_address(adap->dev,
	adap->dvb_adap.proposed_mac) == 0)
	pr_info("%s: MAC address: %pM\n", KBUILD_MODNAME,
	adap->dvb_adap.proposed_mac);
	else
	pr_err("%s: MAC address reading failed\n",
	KBUILD_MODNAME);
	}


	adap->demux.dmx.capabilities = DMX_TS_FILTERING \| DMX_SECTION_FILTERING;
	adap->demux.priv = adap;

	adap->demux.filternum = 0;
	if (adap->demux.filternum < adap->max_feed_count)
	adap->demux.filternum = adap->max_feed_count;
	adap->demux.feednum = adap->demux.filternum;
	adap->demux.start_feed = dvb_usb_start_feed;
	adap->demux.stop_feed = dvb_usb_stop_feed;
	adap->demux.write_to_decoder = NULL;
	ret = dvb_dmx_init(&adap->demux);
	if (ret < 0) {
	pr_err("%s: dvb_dmx_init() failed=%d\n", KBUILD_MODNAME, ret);
	goto err_dmx;
	}

	adap->dmxdev.filternum = adap->demux.filternum;
	adap->dmxdev.demux = &adap->demux.dmx;
	adap->dmxdev.capabilities = 0;
	ret = dvb_dmxdev_init(&adap->dmxdev, &adap->dvb_adap);
	if (ret < 0) {
	pr_err("%s: dvb_dmxdev_init() failed=%d\n", KBUILD_MODNAME,
	ret);
	goto err_dmx_dev;
	}

	ret = dvb_net_init(&adap->dvb_adap, &adap->dvb_net, &adap->demux.dmx);
	if (ret < 0) {
	pr_err("%s: dvb_net_init() failed=%d\n", KBUILD_MODNAME, ret);
	goto err_net_init;
	}

	adap->state \|= DVB_USB_ADAP_STATE_DVB;
	return 0;

	err_net_init:
	dvb_dmxdev_release(&adap->dmxdev);
	err_dmx_dev:
	dvb_dmx_release(&adap->demux);
	err_dmx:
	dvb_unregister_adapter(&adap->dvb_adap);
	err:
	return ret;
	}

	int dvb_usbv2_adapter_dvb_exit(struct dvb_usb_adapter *adap)
	{
	if (adap->state & DVB_USB_ADAP_STATE_DVB) {
	pr_debug("%s: unregistering DVB part\n", __func__);
	dvb_net_release(&adap->dvb_net);
	adap->demux.dmx.close(&adap->demux.dmx);
	dvb_dmxdev_release(&adap->dmxdev);
	dvb_dmx_release(&adap->demux);
	dvb_unregister_adapter(&adap->dvb_adap);
	adap->state &= ~DVB_USB_ADAP_STATE_DVB;
	}
	return 0;
	}

	static int dvb_usb_fe_wakeup(struct dvb_frontend *fe)
	{
	int ret;
	struct dvb_usb_adapter *adap = fe->dvb->priv;

	ret = dvb_usbv2_device_power_ctrl(adap->dev, 1);
	if (ret < 0)
	goto err;

	if (adap->dev->props.frontend_ctrl) {
	ret = adap->dev->props.frontend_ctrl(fe, 1);
	if (ret < 0)
	goto err;
	}

	if (adap->fe_init[fe->id]) {
	ret = adap->fe_init[fe->id](fe);
	if (ret < 0)
	goto err;
	}

	adap->active_fe = fe->id;

	return 0;
	err:
	pr_debug("%s: failed=%d\n", __func__, ret);
	return ret;
	}

	static int dvb_usb_fe_sleep(struct dvb_frontend *fe)
	{
	int ret;
	struct dvb_usb_adapter *adap = fe->dvb->priv;

	if (adap->fe_sleep[fe->id]) {
	ret = adap->fe_sleep[fe->id](fe);
	if (ret < 0)
	goto err;
	}

	if (adap->dev->props.frontend_ctrl) {
	ret = adap->dev->props.frontend_ctrl(fe, 0);
	if (ret < 0)
	goto err;
	}

	ret = dvb_usbv2_device_power_ctrl(adap->dev, 0);
	if (ret < 0)
	goto err;

	adap->active_fe = -1;

	return 0;
	err:
	pr_debug("%s: failed=%d\n", __func__, ret);
	return ret;
	}

	int dvb_usbv2_adapter_frontend_init(struct dvb_usb_adapter *adap)
	{
	int ret, i, count_registered = 0;

	pr_debug("%s:\n", __func__);

	memset(adap->fe, 0, sizeof(adap->fe));
	adap->active_fe = -1;

	if (adap->dev->props.frontend_attach) {
	ret = adap->dev->props.frontend_attach(adap);
	if (ret < 0) {
	pr_debug("%s: frontend_attach() failed=%d\n", __func__,
	ret);
	goto err_dvb_frontend_detach;
	}
	} else {
	pr_debug("%s: frontend_attach() do not exists\n", __func__);
	ret = 0;
	goto err;
	}

	if (adap->dev->props.tuner_attach) {
	ret = adap->dev->props.tuner_attach(adap);
	if (ret < 0) {
	pr_debug("%s: tuner_attach() failed=%d\n", __func__,
	ret);
	goto err_dvb_frontend_detach;
	}
	}

	for (i = 0; i < MAX_NO_OF_FE_PER_ADAP && adap->fe[i]; i++) {
	adap->fe[i]->id = i;

	/* re-assign sleep and wakeup functions */
	adap->fe_init[i] = adap->fe[i]->ops.init;
	adap->fe[i]->ops.init = dvb_usb_fe_wakeup;
	adap->fe_sleep[i] = adap->fe[i]->ops.sleep;
	adap->fe[i]->ops.sleep = dvb_usb_fe_sleep;

	ret = dvb_register_frontend(&adap->dvb_adap, adap->fe[i]);
	if (ret < 0) {
	pr_err("%s: frontend%d registration failed\n",
	KBUILD_MODNAME, i);
	goto err_dvb_unregister_frontend;
	}

	count_registered++;
	}

	adap->num_frontends_initialized = count_registered;

	return 0;

	err_dvb_unregister_frontend:
	for (i = count_registered - 1; i >= 0; i--)
	dvb_unregister_frontend(adap->fe[i]);

	err_dvb_frontend_detach:
	for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
	if (adap->fe[i])
	dvb_frontend_detach(adap->fe[i]);
	}

	err:
	pr_debug("%s: failed=%d\n", __func__, ret);
	return ret;
	}

	int dvb_usbv2_adapter_frontend_exit(struct dvb_usb_adapter *adap)
	{
	int i;

	pr_debug("%s:\n", __func__);

	for (i = adap->num_frontends_initialized - 1; i >= 0; i--) {
	if (adap->fe[i]) {
	dvb_unregister_frontend(adap->fe[i]);
	dvb_frontend_detach(adap->fe[i]);
	}
	}

	adap->num_frontends_initialized = 0;

	return 0;
	}