[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / usb / tlg2300 / pd-main.c

/*
 * device driver for Telegent tlg2300 based TV cards
 *
 * Author :
 * 	Kang Yong	<kangyong@telegent.com>
 * 	Zhang Xiaobing	<xbzhang@telegent.com>
 * 	Huang Shijie	<zyziii@telegent.com> or <shijie8@gmail.com>
 *
 *	(c) 2009 Telegent Systems
 *	(c) 2010 Telegent Systems
 *
 *  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 <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/kref.h>
#include <linux/suspend.h>
#include <linux/usb/quirks.h>
#include <linux/ctype.h>
#include <linux/string.h>
#include <linux/types.h>
#include <linux/firmware.h>

#include "vendorcmds.h"
#include "pd-common.h"

#define VENDOR_ID	0x1B24
#define PRODUCT_ID	0x4001
static struct usb_device_id id_table[] = {
	{ USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID, PRODUCT_ID, 255, 1, 0) },
	{ USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID, PRODUCT_ID, 255, 1, 1) },
	{ },
};
MODULE_DEVICE_TABLE(usb, id_table);

int debug_mode;
module_param(debug_mode, int, 0644);
MODULE_PARM_DESC(debug_mode, "0 = disable, 1 = enable, 2 = verbose");

#define TLG2300_FIRMWARE "tlg2300_firmware.bin"
static const char *firmware_name = TLG2300_FIRMWARE;
static LIST_HEAD(pd_device_list);

/*
 * send set request to USB firmware.
 */
s32 send_set_req(struct poseidon *pd, u8 cmdid, s32 param, s32 *cmd_status)
{
	s32 ret;
	s8  data[32] = {};
	u16 lower_16, upper_16;

	if (pd->state & POSEIDON_STATE_DISCONNECT)
		return -ENODEV;

	mdelay(30);

	if (param == 0) {
		upper_16 = lower_16 = 0;
	} else {
		/* send 32 bit param as  two 16 bit param,little endian */
		lower_16 = (unsigned short)(param & 0xffff);
		upper_16 = (unsigned short)((param >> 16) & 0xffff);
	}
	ret = usb_control_msg(pd->udev,
			 usb_rcvctrlpipe(pd->udev, 0),
			 REQ_SET_CMD | cmdid,
			 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			 lower_16,
			 upper_16,
			 &data,
			 sizeof(*cmd_status),
			 USB_CTRL_GET_TIMEOUT);

	if (!ret) {
		return -ENXIO;
	} else {
		/*  1st 4 bytes into cmd_status   */
		memcpy((char *)cmd_status, &(data[0]), sizeof(*cmd_status));
	}
	return 0;
}

/*
 * send get request to Poseidon firmware.
 */
s32 send_get_req(struct poseidon *pd, u8 cmdid, s32 param,
			void *buf, s32 *cmd_status, s32 datalen)
{
	s32 ret;
	s8 data[128] = {};
	u16 lower_16, upper_16;

	if (pd->state & POSEIDON_STATE_DISCONNECT)
		return -ENODEV;

	mdelay(30);
	if (param == 0) {
		upper_16 = lower_16 = 0;
	} else {
		/*send 32 bit param as two 16 bit param, little endian */
		lower_16 = (unsigned short)(param & 0xffff);
		upper_16 = (unsigned short)((param >> 16) & 0xffff);
	}
	ret = usb_control_msg(pd->udev,
			 usb_rcvctrlpipe(pd->udev, 0),
			 REQ_GET_CMD | cmdid,
			 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			 lower_16,
			 upper_16,
			 &data,
			 (datalen + sizeof(*cmd_status)),
			 USB_CTRL_GET_TIMEOUT);

	if (ret < 0) {
		return -ENXIO;
	} else {
		/* 1st 4 bytes into cmd_status, remaining data into cmd_data */
		memcpy((char *)cmd_status, &data[0], sizeof(*cmd_status));
		memcpy((char *)buf, &data[sizeof(*cmd_status)], datalen);
	}
	return 0;
}

static int pm_notifier_block(struct notifier_block *nb,
				unsigned long event, void *dummy)
{
	struct poseidon *pd = NULL;
	struct list_head *node, *next;

	switch (event) {
	case PM_POST_HIBERNATION:
		list_for_each_safe(node, next, &pd_device_list) {
			struct usb_device *udev;
			struct usb_interface *iface;
			int rc = 0;

			pd = container_of(node, struct poseidon, device_list);
			udev = pd->udev;
			iface = pd->interface;

			/* It will cause the system to reload the firmware */
			rc = usb_lock_device_for_reset(udev, iface);
			if (rc >= 0) {
				usb_reset_device(udev);
				usb_unlock_device(udev);
			}
		}
		break;
	default:
		break;
	}
	log("event :%ld\n", event);
	return 0;
}

static struct notifier_block pm_notifer = {
	.notifier_call = pm_notifier_block,
};

int set_tuner_mode(struct poseidon *pd, unsigned char mode)
{
	s32 ret, cmd_status;

	if (pd->state & POSEIDON_STATE_DISCONNECT)
		return -ENODEV;

	ret = send_set_req(pd, TUNE_MODE_SELECT, mode, &cmd_status);
	if (ret || cmd_status)
		return -ENXIO;
	return 0;
}

void poseidon_delete(struct kref *kref)
{
	struct poseidon *pd = container_of(kref, struct poseidon, kref);

	if (!pd)
		return;
	list_del_init(&pd->device_list);

	pd_dvb_usb_device_cleanup(pd);
	/* clean_audio_data(&pd->audio_data);*/

	if (pd->udev) {
		usb_put_dev(pd->udev);
		pd->udev = NULL;
	}
	if (pd->interface) {
		usb_put_intf(pd->interface);
		pd->interface = NULL;
	}
	kfree(pd);
	log();
}

static int firmware_download(struct usb_device *udev)
{
	int ret = 0, actual_length;
	const struct firmware *fw = NULL;
	void *fwbuf = NULL;
	size_t fwlength = 0, offset;
	size_t max_packet_size;

	ret = request_firmware(&fw, firmware_name, &udev->dev);
	if (ret) {
		log("download err : %d", ret);
		return ret;
	}

	fwlength = fw->size;

	fwbuf = kmemdup(fw->data, fwlength, GFP_KERNEL);
	if (!fwbuf) {
		ret = -ENOMEM;
		goto out;
	}

	max_packet_size = udev->ep_out[0x1]->desc.wMaxPacketSize;
	log("\t\t download size : %d", (int)max_packet_size);

	for (offset = 0; offset < fwlength; offset += max_packet_size) {
		actual_length = 0;
		ret = usb_bulk_msg(udev,
				usb_sndbulkpipe(udev, 0x01), /* ep 1 */
				fwbuf + offset,
				min(max_packet_size, fwlength - offset),
				&actual_length,
				HZ * 10);
		if (ret)
			break;
	}
	kfree(fwbuf);
out:
	release_firmware(fw);
	return ret;
}

static inline struct poseidon *get_pd(struct usb_interface *intf)
{
	return usb_get_intfdata(intf);
}

#ifdef CONFIG_PM
/* one-to-one map : poseidon{} <----> usb_device{}'s port */
static inline void set_map_flags(struct poseidon *pd, struct usb_device *udev)
{
	pd->portnum = udev->portnum;
}

static inline int get_autopm_ref(struct poseidon *pd)
{
	return  pd->video_data.users + pd->vbi_data.users + pd->audio.users
		+ atomic_read(&pd->dvb_data.users) +
		!list_empty(&pd->radio_data.fm_dev.fh_list);
}

/* fixup something for poseidon */
static inline struct poseidon *fixup(struct poseidon *pd)
{
	int count;

	/* old udev and interface have gone, so put back reference . */
	count = get_autopm_ref(pd);
	log("count : %d, ref count : %d", count, get_pm_count(pd));
	while (count--)
		usb_autopm_put_interface(pd->interface);
	/*usb_autopm_set_interface(pd->interface); */

	usb_put_dev(pd->udev);
	usb_put_intf(pd->interface);
	log("event : %d\n", pd->msg.event);
	return pd;
}

static struct poseidon *find_old_poseidon(struct usb_device *udev)
{
	struct poseidon *pd;

	list_for_each_entry(pd, &pd_device_list, device_list) {
		if (pd->portnum == udev->portnum && in_hibernation(pd))
			return fixup(pd);
	}
	return NULL;
}

/* Is the card working now ? */
static inline int is_working(struct poseidon *pd)
{
	return get_pm_count(pd) > 0;
}

static int poseidon_suspend(struct usb_interface *intf, pm_message_t msg)
{
	struct poseidon *pd = get_pd(intf);

	if (!pd)
		return 0;
	if (!is_working(pd)) {
		if (get_pm_count(pd) <= 0 && !in_hibernation(pd)) {
			pd->msg.event = PM_EVENT_AUTO_SUSPEND;
			pd->pm_resume = NULL; /*  a good guard */
			printk(KERN_DEBUG "TLG2300 auto suspend\n");
		}
		return 0;
	}
	pd->msg = msg; /* save it here */
	logpm(pd);
	return pd->pm_suspend ? pd->pm_suspend(pd) : 0;
}

static int poseidon_resume(struct usb_interface *intf)
{
	struct poseidon *pd = get_pd(intf);

	if (!pd)
		return 0;
	printk(KERN_DEBUG "TLG2300 resume\n");

	if (!is_working(pd)) {
		if (PM_EVENT_AUTO_SUSPEND == pd->msg.event)
			pd->msg = PMSG_ON;
		return 0;
	}
	if (in_hibernation(pd)) {
		logpm(pd);
		return 0;
	}
	logpm(pd);
	return pd->pm_resume ? pd->pm_resume(pd) : 0;
}

static void hibernation_resume(struct work_struct *w)
{
	struct poseidon *pd = container_of(w, struct poseidon, pm_work);
	int count;

	pd->msg.event = 0; /* clear it here */
	pd->state &= ~POSEIDON_STATE_DISCONNECT;

	/* set the new interface's reference */
	count = get_autopm_ref(pd);
	while (count--)
		usb_autopm_get_interface(pd->interface);

	/* resume the context */
	logpm(pd);
	if (pd->pm_resume)
		pd->pm_resume(pd);
}
#else /* CONFIG_PM is not enabled: */
static inline struct poseidon *find_old_poseidon(struct usb_device *udev)
{
	return NULL;
}

static inline void set_map_flags(struct poseidon *pd, struct usb_device *udev)
{
}
#endif

static int check_firmware(struct usb_device *udev, int *down_firmware)
{
	void *buf;
	int ret;
	struct cmd_firmware_vers_s *cmd_firm;

	buf = kzalloc(sizeof(*cmd_firm) + sizeof(u32), GFP_KERNEL);
	if (!buf)
		return -ENOMEM;
	ret = usb_control_msg(udev,
			 usb_rcvctrlpipe(udev, 0),
			 REQ_GET_CMD | GET_FW_ID,
			 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			 0,
			 0,
			 buf,
			 sizeof(*cmd_firm) + sizeof(u32),
			 USB_CTRL_GET_TIMEOUT);
	kfree(buf);

	if (ret < 0) {
		*down_firmware = 1;
		return firmware_download(udev);
	}
	return 0;
}

static int poseidon_probe(struct usb_interface *interface,
				const struct usb_device_id *id)
{
	struct usb_device *udev = interface_to_usbdev(interface);
	struct poseidon *pd = NULL;
	int ret = 0;
	int new_one = 0;

	/* download firmware */
	check_firmware(udev, &ret);
	if (ret)
		return 0;

	/* Do I recovery from the hibernate ? */
	pd = find_old_poseidon(udev);
	if (!pd) {
		pd = kzalloc(sizeof(*pd), GFP_KERNEL);
		if (!pd)
			return -ENOMEM;
		kref_init(&pd->kref);
		set_map_flags(pd, udev);
		new_one = 1;
	}

	pd->udev	= usb_get_dev(udev);
	pd->interface	= usb_get_intf(interface);
	usb_set_intfdata(interface, pd);

	if (new_one) {
		logpm(pd);
		mutex_init(&pd->lock);

		/* register v4l2 device */
		ret = v4l2_device_register(&interface->dev, &pd->v4l2_dev);

		/* register devices in directory /dev */
		ret = pd_video_init(pd);
		poseidon_audio_init(pd);
		poseidon_fm_init(pd);
		pd_dvb_usb_device_init(pd);

		INIT_LIST_HEAD(&pd->device_list);
		list_add_tail(&pd->device_list, &pd_device_list);
	}

	device_init_wakeup(&udev->dev, 1);
#ifdef CONFIG_PM
	pm_runtime_set_autosuspend_delay(&pd->udev->dev,
			1000 * PM_SUSPEND_DELAY);
	usb_enable_autosuspend(pd->udev);

	if (in_hibernation(pd)) {
		INIT_WORK(&pd->pm_work, hibernation_resume);
		schedule_work(&pd->pm_work);
	}
#endif
	return 0;
}

static void poseidon_disconnect(struct usb_interface *interface)
{
	struct poseidon *pd = get_pd(interface);

	if (!pd)
		return;
	logpm(pd);
	if (in_hibernation(pd))
		return;

	mutex_lock(&pd->lock);
	pd->state |= POSEIDON_STATE_DISCONNECT;
	mutex_unlock(&pd->lock);

	/* stop urb transferring */
	stop_all_video_stream(pd);
	dvb_stop_streaming(&pd->dvb_data);

	/*unregister v4l2 device */
	v4l2_device_unregister(&pd->v4l2_dev);

	pd_dvb_usb_device_exit(pd);
	poseidon_fm_exit(pd);

	poseidon_audio_free(pd);
	pd_video_exit(pd);

	usb_set_intfdata(interface, NULL);
	kref_put(&pd->kref, poseidon_delete);
}

static struct usb_driver poseidon_driver = {
	.name		= "poseidon",
	.probe		= poseidon_probe,
	.disconnect	= poseidon_disconnect,
	.id_table	= id_table,
#ifdef CONFIG_PM
	.suspend	= poseidon_suspend,
	.resume		= poseidon_resume,
#endif
	.supports_autosuspend = 1,
};

static int __init poseidon_init(void)
{
	int ret;

	ret = usb_register(&poseidon_driver);
	if (ret)
		return ret;
	register_pm_notifier(&pm_notifer);
	return ret;
}

static void __exit poseidon_exit(void)
{
	log();
	unregister_pm_notifier(&pm_notifer);
	usb_deregister(&poseidon_driver);
}

module_init(poseidon_init);
module_exit(poseidon_exit);

MODULE_AUTHOR("Telegent Systems");
MODULE_DESCRIPTION("For tlg2300-based USB device");
MODULE_LICENSE("GPL");
MODULE_VERSION("0.0.2");
MODULE_FIRMWARE(TLG2300_FIRMWARE);
Commit	Line	Data
5b3f03f0 HS	1	/*
	2	* device driver for Telegent tlg2300 based TV cards
	3	*
	4	* Author :
	5	* Kang Yong <kangyong@telegent.com>
	6	* Zhang Xiaobing <xbzhang@telegent.com>
	7	* Huang Shijie <zyziii@telegent.com> or <shijie8@gmail.com>
	8	*
	9	* (c) 2009 Telegent Systems
	10	* (c) 2010 Telegent Systems
	11	*
	12	* This program is free software; you can redistribute it and/or modify
	13	* it under the terms of the GNU General Public License as published by
	14	* the Free Software Foundation; either version 2 of the License, or
	15	* (at your option) any later version.
	16	*
	17	* This program is distributed in the hope that it will be useful,
	18	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	19	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	20	* GNU General Public License for more details.
	21	*
	22	* You should have received a copy of the GNU General Public License
	23	* along with this program; if not, write to the Free Software
	24	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	25	*/
	26
5b3f03f0 HS	27	#include <linux/kernel.h>
	28	#include <linux/errno.h>
	29	#include <linux/init.h>
	30	#include <linux/slab.h>
	31	#include <linux/module.h>
	32	#include <linux/kref.h>
	33	#include <linux/suspend.h>
	34	#include <linux/usb/quirks.h>
	35	#include <linux/ctype.h>
	36	#include <linux/string.h>
	37	#include <linux/types.h>
	38	#include <linux/firmware.h>
5b3f03f0 HS	39
	40	#include "vendorcmds.h"
	41	#include "pd-common.h"
	42
	43	#define VENDOR_ID 0x1B24
	44	#define PRODUCT_ID 0x4001
	45	static struct usb_device_id id_table[] = {
	46	{ USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID, PRODUCT_ID, 255, 1, 0) },
	47	{ USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID, PRODUCT_ID, 255, 1, 1) },
	48	{ },
	49	};
	50	MODULE_DEVICE_TABLE(usb, id_table);
	51
	52	int debug_mode;
	53	module_param(debug_mode, int, 0644);
	54	MODULE_PARM_DESC(debug_mode, "0 = disable, 1 = enable, 2 = verbose");
	55
4d98015e TG	56	#define TLG2300_FIRMWARE "tlg2300_firmware.bin"
4d98015e TG	57	static const char *firmware_name = TLG2300_FIRMWARE;
5b3f03f0 HS	58	static LIST_HEAD(pd_device_list);
	59
	60	/*
	61	* send set request to USB firmware.
	62	*/
	63	s32 send_set_req(struct poseidon pd, u8 cmdid, s32 param, s32 cmd_status)
	64	{
	65	s32 ret;
	66	s8 data[32] = {};
	67	u16 lower_16, upper_16;
	68
	69	if (pd->state & POSEIDON_STATE_DISCONNECT)
	70	return -ENODEV;
	71
	72	mdelay(30);
	73
	74	if (param == 0) {
	75	upper_16 = lower_16 = 0;
	76	} else {
	77	/* send 32 bit param as two 16 bit param,little endian */
	78	lower_16 = (unsigned short)(param & 0xffff);
	79	upper_16 = (unsigned short)((param >> 16) & 0xffff);
	80	}
	81	ret = usb_control_msg(pd->udev,
	82	usb_rcvctrlpipe(pd->udev, 0),
	83	REQ_SET_CMD \| cmdid,
	84	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	85	lower_16,
	86	upper_16,
	87	&data,
	88	sizeof(*cmd_status),
	89	USB_CTRL_GET_TIMEOUT);
	90
	91	if (!ret) {
	92	return -ENXIO;
	93	} else {
	94	/* 1st 4 bytes into cmd_status */
	95	memcpy((char )cmd_status, &(data[0]), sizeof(cmd_status));
	96	}
	97	return 0;
	98	}
	99
	100	/*
	101	* send get request to Poseidon firmware.
	102	*/
	103	s32 send_get_req(struct poseidon *pd, u8 cmdid, s32 param,
	104	void buf, s32 cmd_status, s32 datalen)
	105	{
	106	s32 ret;
	107	s8 data[128] = {};
	108	u16 lower_16, upper_16;
	109
	110	if (pd->state & POSEIDON_STATE_DISCONNECT)
	111	return -ENODEV;
	112
	113	mdelay(30);
	114	if (param == 0) {
	115	upper_16 = lower_16 = 0;
	116	} else {
	117	/send 32 bit param as two 16 bit param, little endian /
	118	lower_16 = (unsigned short)(param & 0xffff);
	119	upper_16 = (unsigned short)((param >> 16) & 0xffff);
	120	}
	121	ret = usb_control_msg(pd->udev,
122	usb_rcvctrlpipe(pd->udev, 0),
123	REQ_GET_CMD \| cmdid,
124	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
125	lower_16,
126	upper_16,
127	&data,
128	(datalen + sizeof(*cmd_status)),
129	USB_CTRL_GET_TIMEOUT);
130
131	if (ret < 0) {
132	return -ENXIO;
133	} else {
134	/* 1st 4 bytes into cmd_status, remaining data into cmd_data */
135	memcpy((char )cmd_status, &data[0], sizeof(cmd_status));
136	memcpy((char )buf, &data[sizeof(cmd_status)], datalen);
137	}
138	return 0;
139	}
140
141	static int pm_notifier_block(struct notifier_block *nb,
142	unsigned long event, void *dummy)
143	{
144	struct poseidon *pd = NULL;
145	struct list_head node, next;
146
147	switch (event) {
148	case PM_POST_HIBERNATION:
149	list_for_each_safe(node, next, &pd_device_list) {
150	struct usb_device *udev;
151	struct usb_interface *iface;
152	int rc = 0;
153
154	pd = container_of(node, struct poseidon, device_list);
155	udev = pd->udev;
156	iface = pd->interface;
157
158	/* It will cause the system to reload the firmware */
159	rc = usb_lock_device_for_reset(udev, iface);
160	if (rc >= 0) {
161	usb_reset_device(udev);
162	usb_unlock_device(udev);
163	}
164	}
165	break;
166	default:
167	break;
168	}
169	log("event :%ld\n", event);
170	return 0;
171	}
172
173	static struct notifier_block pm_notifer = {
174	.notifier_call = pm_notifier_block,
175	};
176
177	int set_tuner_mode(struct poseidon *pd, unsigned char mode)
178	{
179	s32 ret, cmd_status;
180
181	if (pd->state & POSEIDON_STATE_DISCONNECT)
182	return -ENODEV;
183
184	ret = send_set_req(pd, TUNE_MODE_SELECT, mode, &cmd_status);
185	if (ret \|\| cmd_status)
186	return -ENXIO;
187	return 0;
188	}
189
5b3f03f0 HS	190	void poseidon_delete(struct kref *kref)
	191	{
	192	struct poseidon *pd = container_of(kref, struct poseidon, kref);
	193
	194	if (!pd)
	195	return;
	196	list_del_init(&pd->device_list);
	197
	198	pd_dvb_usb_device_cleanup(pd);
	199	/* clean_audio_data(&pd->audio_data);*/
	200
	201	if (pd->udev) {
	202	usb_put_dev(pd->udev);
	203	pd->udev = NULL;
	204	}
	205	if (pd->interface) {
	206	usb_put_intf(pd->interface);
	207	pd->interface = NULL;
	208	}
	209	kfree(pd);
	210	log();
	211	}
	212
	213	static int firmware_download(struct usb_device *udev)
	214	{
	215	int ret = 0, actual_length;
	216	const struct firmware *fw = NULL;
	217	void *fwbuf = NULL;
	218	size_t fwlength = 0, offset;
	219	size_t max_packet_size;
	220
	221	ret = request_firmware(&fw, firmware_name, &udev->dev);
	222	if (ret) {
	223	log("download err : %d", ret);
	224	return ret;
	225	}
	226
	227	fwlength = fw->size;
	228
2b3c543a	229	fwbuf = kmemdup(fw->data, fwlength, GFP_KERNEL);
5b3f03f0 HS	230	if (!fwbuf) {
	231	ret = -ENOMEM;
	232	goto out;
	233	}
5b3f03f0 HS	234
	235	max_packet_size = udev->ep_out[0x1]->desc.wMaxPacketSize;
	236	log("\t\t download size : %d", (int)max_packet_size);
	237
	238	for (offset = 0; offset < fwlength; offset += max_packet_size) {
	239	actual_length = 0;
	240	ret = usb_bulk_msg(udev,
	241	usb_sndbulkpipe(udev, 0x01), /* ep 1 */
	242	fwbuf + offset,
	243	min(max_packet_size, fwlength - offset),
	244	&actual_length,
	245	HZ * 10);
	246	if (ret)
	247	break;
	248	}
	249	kfree(fwbuf);
	250	out:
	251	release_firmware(fw);
	252	return ret;
	253	}
	254
08cf8a57 RD	255	static inline struct poseidon get_pd(struct usb_interface intf)
	256	{
	257	return usb_get_intfdata(intf);
	258	}
	259
5b3f03f0 HS	260	#ifdef CONFIG_PM
	261	/* one-to-one map : poseidon{} <----> usb_device{}'s port */
	262	static inline void set_map_flags(struct poseidon pd, struct usb_device udev)
	263	{
	264	pd->portnum = udev->portnum;
	265	}
	266
	267	static inline int get_autopm_ref(struct poseidon *pd)
	268	{
	269	return pd->video_data.users + pd->vbi_data.users + pd->audio.users
668cb00e HV	270	+ atomic_read(&pd->dvb_data.users) +
668cb00e HV	271	!list_empty(&pd->radio_data.fm_dev.fh_list);
5b3f03f0 HS	272	}
	273
	274	/* fixup something for poseidon */
	275	static inline struct poseidon fixup(struct poseidon pd)
	276	{
	277	int count;
	278
	279	/* old udev and interface have gone, so put back reference . */
	280	count = get_autopm_ref(pd);
	281	log("count : %d, ref count : %d", count, get_pm_count(pd));
	282	while (count--)
	283	usb_autopm_put_interface(pd->interface);
	284	/usb_autopm_set_interface(pd->interface); /
	285
	286	usb_put_dev(pd->udev);
	287	usb_put_intf(pd->interface);
	288	log("event : %d\n", pd->msg.event);
	289	return pd;
	290	}
	291
	292	static struct poseidon find_old_poseidon(struct usb_device udev)
	293	{
	294	struct poseidon *pd;
	295
	296	list_for_each_entry(pd, &pd_device_list, device_list) {
	297	if (pd->portnum == udev->portnum && in_hibernation(pd))
	298	return fixup(pd);
	299	}
	300	return NULL;
	301	}
	302
	303	/* Is the card working now ? */
	304	static inline int is_working(struct poseidon *pd)
	305	{
	306	return get_pm_count(pd) > 0;
	307	}
	308
5b3f03f0 HS	309	static int poseidon_suspend(struct usb_interface *intf, pm_message_t msg)
	310	{
	311	struct poseidon *pd = get_pd(intf);
	312
	313	if (!pd)
	314	return 0;
	315	if (!is_working(pd)) {
	316	if (get_pm_count(pd) <= 0 && !in_hibernation(pd)) {
	317	pd->msg.event = PM_EVENT_AUTO_SUSPEND;
	318	pd->pm_resume = NULL; /* a good guard */
91972923	319	printk(KERN_DEBUG "TLG2300 auto suspend\n");
5b3f03f0 HS	320	}
	321	return 0;
	322	}
	323	pd->msg = msg; /* save it here */
	324	logpm(pd);
	325	return pd->pm_suspend ? pd->pm_suspend(pd) : 0;
	326	}
	327
	328	static int poseidon_resume(struct usb_interface *intf)
	329	{
	330	struct poseidon *pd = get_pd(intf);
	331
	332	if (!pd)
	333	return 0;
91972923	334	printk(KERN_DEBUG "TLG2300 resume\n");
5b3f03f0 HS	335
	336	if (!is_working(pd)) {
	337	if (PM_EVENT_AUTO_SUSPEND == pd->msg.event)
	338	pd->msg = PMSG_ON;
	339	return 0;
	340	}
	341	if (in_hibernation(pd)) {
	342	logpm(pd);
	343	return 0;
	344	}
	345	logpm(pd);
	346	return pd->pm_resume ? pd->pm_resume(pd) : 0;
	347	}
	348
	349	static void hibernation_resume(struct work_struct *w)
	350	{
	351	struct poseidon *pd = container_of(w, struct poseidon, pm_work);
	352	int count;
	353
	354	pd->msg.event = 0; /* clear it here */
	355	pd->state &= ~POSEIDON_STATE_DISCONNECT;
	356
	357	/* set the new interface's reference */
	358	count = get_autopm_ref(pd);
	359	while (count--)
	360	usb_autopm_get_interface(pd->interface);
	361
	362	/* resume the context */
	363	logpm(pd);
	364	if (pd->pm_resume)
	365	pd->pm_resume(pd);
	366	}
08cf8a57 RD	367	#else /* CONFIG_PM is not enabled: */
	368	static inline struct poseidon find_old_poseidon(struct usb_device udev)
	369	{
	370	return NULL;
	371	}
	372
	373	static inline void set_map_flags(struct poseidon pd, struct usb_device udev)
	374	{
	375	}
5b3f03f0 HS	376	#endif
5b3f03f0 HS	377
e9ae4d4f	378	static int check_firmware(struct usb_device udev, int down_firmware)
5b3f03f0 HS	379	{
	380	void *buf;
	381	int ret;
	382	struct cmd_firmware_vers_s *cmd_firm;
	383
	384	buf = kzalloc(sizeof(*cmd_firm) + sizeof(u32), GFP_KERNEL);
	385	if (!buf)
	386	return -ENOMEM;
	387	ret = usb_control_msg(udev,
	388	usb_rcvctrlpipe(udev, 0),
	389	REQ_GET_CMD \| GET_FW_ID,
	390	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	391	0,
	392	0,
	393	buf,
	394	sizeof(*cmd_firm) + sizeof(u32),
	395	USB_CTRL_GET_TIMEOUT);
	396	kfree(buf);
	397
	398	if (ret < 0) {
	399	*down_firmware = 1;
	400	return firmware_download(udev);
	401	}
e9ae4d4f	402	return 0;
5b3f03f0 HS	403	}
	404
	405	static int poseidon_probe(struct usb_interface *interface,
	406	const struct usb_device_id *id)
	407	{
	408	struct usb_device *udev = interface_to_usbdev(interface);
	409	struct poseidon *pd = NULL;
	410	int ret = 0;
	411	int new_one = 0;
	412
	413	/* download firmware */
	414	check_firmware(udev, &ret);
	415	if (ret)
	416	return 0;
	417
	418	/* Do I recovery from the hibernate ? */
	419	pd = find_old_poseidon(udev);
	420	if (!pd) {
	421	pd = kzalloc(sizeof(*pd), GFP_KERNEL);
	422	if (!pd)
	423	return -ENOMEM;
	424	kref_init(&pd->kref);
	425	set_map_flags(pd, udev);
	426	new_one = 1;
	427	}
	428
	429	pd->udev = usb_get_dev(udev);
	430	pd->interface = usb_get_intf(interface);
	431	usb_set_intfdata(interface, pd);
	432
	433	if (new_one) {
5b3f03f0	434	logpm(pd);
5b3f03f0 HS	435	mutex_init(&pd->lock);
	436
	437	/* register v4l2 device */
91972923	438	ret = v4l2_device_register(&interface->dev, &pd->v4l2_dev);
5b3f03f0 HS	439
	440	/* register devices in directory /dev */
	441	ret = pd_video_init(pd);
	442	poseidon_audio_init(pd);
	443	poseidon_fm_init(pd);
	444	pd_dvb_usb_device_init(pd);
	445
	446	INIT_LIST_HEAD(&pd->device_list);
	447	list_add_tail(&pd->device_list, &pd_device_list);
	448	}
	449
	450	device_init_wakeup(&udev->dev, 1);
	451	#ifdef CONFIG_PM
2f15744c AS	452	pm_runtime_set_autosuspend_delay(&pd->udev->dev,
2f15744c AS	453	1000 * PM_SUSPEND_DELAY);
beb7b04a	454	usb_enable_autosuspend(pd->udev);
5b3f03f0 HS	455
	456	if (in_hibernation(pd)) {
	457	INIT_WORK(&pd->pm_work, hibernation_resume);
	458	schedule_work(&pd->pm_work);
	459	}
	460	#endif
	461	return 0;
	462	}
	463
	464	static void poseidon_disconnect(struct usb_interface *interface)
	465	{
	466	struct poseidon *pd = get_pd(interface);
	467
	468	if (!pd)
	469	return;
	470	logpm(pd);
	471	if (in_hibernation(pd))
	472	return;
	473
	474	mutex_lock(&pd->lock);
	475	pd->state \|= POSEIDON_STATE_DISCONNECT;
	476	mutex_unlock(&pd->lock);
	477
	478	/* stop urb transferring */
	479	stop_all_video_stream(pd);
	480	dvb_stop_streaming(&pd->dvb_data);
	481
	482	/unregister v4l2 device /
	483	v4l2_device_unregister(&pd->v4l2_dev);
	484
0edf2e5e AB	485	pd_dvb_usb_device_exit(pd);
0edf2e5e AB	486	poseidon_fm_exit(pd);
5b3f03f0	487
0edf2e5e AB	488	poseidon_audio_free(pd);
0edf2e5e AB	489	pd_video_exit(pd);
5b3f03f0 HS	490
	491	usb_set_intfdata(interface, NULL);
	492	kref_put(&pd->kref, poseidon_delete);
	493	}
	494
278a58cf	495	static struct usb_driver poseidon_driver = {
5b3f03f0 HS	496	.name = "poseidon",
	497	.probe = poseidon_probe,
	498	.disconnect = poseidon_disconnect,
	499	.id_table = id_table,
	500	#ifdef CONFIG_PM
	501	.suspend = poseidon_suspend,
	502	.resume = poseidon_resume,
	503	#endif
	504	.supports_autosuspend = 1,
	505	};
	506
	507	static int __init poseidon_init(void)
	508	{
	509	int ret;
	510
	511	ret = usb_register(&poseidon_driver);
	512	if (ret)
	513	return ret;
	514	register_pm_notifier(&pm_notifer);
	515	return ret;
	516	}
	517
	518	static void __exit poseidon_exit(void)
	519	{
	520	log();
	521	unregister_pm_notifier(&pm_notifer);
	522	usb_deregister(&poseidon_driver);
	523	}
	524
	525	module_init(poseidon_init);
	526	module_exit(poseidon_exit);
	527
	528	MODULE_AUTHOR("Telegent Systems");
91972923	529	MODULE_DESCRIPTION("For tlg2300-based USB device");
5b3f03f0	530	MODULE_LICENSE("GPL");
1990d50b	531	MODULE_VERSION("0.0.2");
4d98015e	532	MODULE_FIRMWARE(TLG2300_FIRMWARE);