[linux-block.git] / drivers / usb / storage / sierra_ms.c

#include <scsi/scsi.h>
#include <scsi/scsi_host.h>
#include <scsi/scsi_cmnd.h>
#include <scsi/scsi_device.h>
#include <linux/usb.h>
#include <linux/module.h>
#include <linux/slab.h>

#include "usb.h"
#include "transport.h"
#include "protocol.h"
#include "scsiglue.h"
#include "sierra_ms.h"
#include "debug.h"

#define SWIMS_USB_REQUEST_SetSwocMode	0x0B
#define SWIMS_USB_REQUEST_GetSwocInfo	0x0A
#define SWIMS_USB_INDEX_SetMode		0x0000
#define SWIMS_SET_MODE_Modem		0x0001

#define TRU_NORMAL 			0x01
#define TRU_FORCE_MS 			0x02
#define TRU_FORCE_MODEM 		0x03

static unsigned int swi_tru_install = 1;
module_param(swi_tru_install, uint, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(swi_tru_install, "TRU-Install mode (1=Full Logic (def),"
		 " 2=Force CD-Rom, 3=Force Modem)");

struct swoc_info {
	__u8 rev;
	__u8 reserved[8];
	__u16 LinuxSKU;
	__u16 LinuxVer;
	__u8 reserved2[47];
} __attribute__((__packed__));

static bool containsFullLinuxPackage(struct swoc_info *swocInfo)
{
	if ((swocInfo->LinuxSKU >= 0x2100 && swocInfo->LinuxSKU <= 0x2FFF) ||
	   (swocInfo->LinuxSKU >= 0x7100 && swocInfo->LinuxSKU <= 0x7FFF))
		return true;
	else
		return false;
}

static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
{
	int result;
	US_DEBUGP("SWIMS: %s", "DEVICE MODE SWITCH\n");
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
			SWIMS_USB_REQUEST_SetSwocMode,	/* __u8 request      */
			USB_TYPE_VENDOR | USB_DIR_OUT,	/* __u8 request type */
			eSWocMode,			/* __u16 value       */
			0x0000,				/* __u16 index       */
			NULL,				/* void *data        */
			0,				/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout       */
	return result;
}


static int sierra_get_swoc_info(struct usb_device *udev,
				struct swoc_info *swocInfo)
{
	int result;

	US_DEBUGP("SWIMS: Attempting to get TRU-Install info.\n");

	result = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
			SWIMS_USB_REQUEST_GetSwocInfo,	/* __u8 request      */
			USB_TYPE_VENDOR | USB_DIR_IN,	/* __u8 request type */
			0,				/* __u16 value       */
			0,				/* __u16 index       */
			(void *) swocInfo,		/* void *data        */
			sizeof(struct swoc_info),	/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout 	     */

	swocInfo->LinuxSKU = le16_to_cpu(swocInfo->LinuxSKU);
	swocInfo->LinuxVer = le16_to_cpu(swocInfo->LinuxVer);
	return result;
}

static void debug_swoc(struct swoc_info *swocInfo)
{
	US_DEBUGP("SWIMS: SWoC Rev: %02d \n", swocInfo->rev);
	US_DEBUGP("SWIMS: Linux SKU: %04X \n", swocInfo->LinuxSKU);
	US_DEBUGP("SWIMS: Linux Version: %04X \n", swocInfo->LinuxVer);
}


static ssize_t show_truinst(struct device *dev, struct device_attribute *attr,
			char *buf)
{
	struct swoc_info *swocInfo;
	struct usb_interface *intf = to_usb_interface(dev);
	struct usb_device *udev = interface_to_usbdev(intf);
	int result;
	if (swi_tru_install == TRU_FORCE_MS) {
		result = snprintf(buf, PAGE_SIZE, "Forced Mass Storage\n");
	} else {
		swocInfo = kmalloc(sizeof(struct swoc_info), GFP_KERNEL);
		if (!swocInfo) {
			US_DEBUGP("SWIMS: Allocation failure\n");
			snprintf(buf, PAGE_SIZE, "Error\n");
			return -ENOMEM;
		}
		result = sierra_get_swoc_info(udev, swocInfo);
		if (result < 0) {
			US_DEBUGP("SWIMS: failed SWoC query\n");
			kfree(swocInfo);
			snprintf(buf, PAGE_SIZE, "Error\n");
			return -EIO;
		}
		debug_swoc(swocInfo);
		result = snprintf(buf, PAGE_SIZE,
			"REV=%02d SKU=%04X VER=%04X\n",
			swocInfo->rev,
			swocInfo->LinuxSKU,
			swocInfo->LinuxVer);
		kfree(swocInfo);
	}
	return result;
}
static DEVICE_ATTR(truinst, S_IRUGO, show_truinst, NULL);

int sierra_ms_init(struct us_data *us)
{
	int result, retries;
	struct swoc_info *swocInfo;
	struct usb_device *udev;
	struct Scsi_Host *sh;
	struct scsi_device *sd;

	retries = 3;
	result = 0;
	udev = us->pusb_dev;

	sh = us_to_host(us);
	sd = scsi_get_host_dev(sh);

	US_DEBUGP("SWIMS: sierra_ms_init called\n");

	/* Force Modem mode */
	if (swi_tru_install == TRU_FORCE_MODEM) {
		US_DEBUGP("SWIMS: %s", "Forcing Modem Mode\n");
		result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
		if (result < 0)
			US_DEBUGP("SWIMS: Failed to switch to modem mode.\n");
		return -EIO;
	}
	/* Force Mass Storage mode (keep CD-Rom) */
	else if (swi_tru_install == TRU_FORCE_MS) {
		US_DEBUGP("SWIMS: %s", "Forcing Mass Storage Mode\n");
		goto complete;
	}
	/* Normal TRU-Install Logic */
	else {
		US_DEBUGP("SWIMS: %s", "Normal SWoC Logic\n");

		swocInfo = kmalloc(sizeof(struct swoc_info),
				GFP_KERNEL);
		if (!swocInfo) {
			US_DEBUGP("SWIMS: %s", "Allocation failure\n");
			return -ENOMEM;
		}

		retries = 3;
		do {
			retries--;
			result = sierra_get_swoc_info(udev, swocInfo);
			if (result < 0) {
				US_DEBUGP("SWIMS: %s", "Failed SWoC query\n");
				schedule_timeout_uninterruptible(2*HZ);
			}
		} while (retries && result < 0);

		if (result < 0) {
			US_DEBUGP("SWIMS: %s",
				  "Completely failed SWoC query\n");
			kfree(swocInfo);
			return -EIO;
		}

		debug_swoc(swocInfo);

		/* If there is not Linux software on the TRU-Install device
		 * then switch to modem mode
		 */
		if (!containsFullLinuxPackage(swocInfo)) {
			US_DEBUGP("SWIMS: %s",
				"Switching to Modem Mode\n");
			result = sierra_set_ms_mode(udev,
				SWIMS_SET_MODE_Modem);
			if (result < 0)
				US_DEBUGP("SWIMS: Failed to switch modem\n");
			kfree(swocInfo);
			return -EIO;
		}
		kfree(swocInfo);
	}
complete:
	result = device_create_file(&us->pusb_intf->dev, &dev_attr_truinst);

	return 0;
}
Commit	Line	Data
32fe5e39 KL	1	#include <scsi/scsi.h>
	2	#include <scsi/scsi_host.h>
	3	#include <scsi/scsi_cmnd.h>
	4	#include <scsi/scsi_device.h>
	5	#include <linux/usb.h>
6eb0de82	6	#include <linux/module.h>
5a0e3ad6	7	#include <linux/slab.h>
32fe5e39 KL	8
	9	#include "usb.h"
	10	#include "transport.h"
	11	#include "protocol.h"
	12	#include "scsiglue.h"
	13	#include "sierra_ms.h"
	14	#include "debug.h"
	15
	16	#define SWIMS_USB_REQUEST_SetSwocMode 0x0B
	17	#define SWIMS_USB_REQUEST_GetSwocInfo 0x0A
	18	#define SWIMS_USB_INDEX_SetMode 0x0000
	19	#define SWIMS_SET_MODE_Modem 0x0001
	20
	21	#define TRU_NORMAL 0x01
	22	#define TRU_FORCE_MS 0x02
	23	#define TRU_FORCE_MODEM 0x03
	24
	25	static unsigned int swi_tru_install = 1;
	26	module_param(swi_tru_install, uint, S_IRUGO \| S_IWUSR);
	27	MODULE_PARM_DESC(swi_tru_install, "TRU-Install mode (1=Full Logic (def),"
	28	" 2=Force CD-Rom, 3=Force Modem)");
	29
	30	struct swoc_info {
	31	__u8 rev;
	32	__u8 reserved[8];
	33	__u16 LinuxSKU;
	34	__u16 LinuxVer;
	35	__u8 reserved2[47];
	36	} __attribute__((__packed__));
	37
	38	static bool containsFullLinuxPackage(struct swoc_info *swocInfo)
	39	{
	40	if ((swocInfo->LinuxSKU >= 0x2100 && swocInfo->LinuxSKU <= 0x2FFF) \|\|
	41	(swocInfo->LinuxSKU >= 0x7100 && swocInfo->LinuxSKU <= 0x7FFF))
	42	return true;
	43	else
	44	return false;
	45	}
	46
	47	static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
	48	{
	49	int result;
	50	US_DEBUGP("SWIMS: %s", "DEVICE MODE SWITCH\n");
	51	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
	52	SWIMS_USB_REQUEST_SetSwocMode, /* __u8 request */
	53	USB_TYPE_VENDOR \| USB_DIR_OUT, /* __u8 request type */
	54	eSWocMode, /* __u16 value */
	55	0x0000, /* __u16 index */
	56	NULL, /* void data /
	57	0, /* __u16 size */
	58	USB_CTRL_SET_TIMEOUT); /* int timeout */
	59	return result;
	60	}
	61
	62
	63	static int sierra_get_swoc_info(struct usb_device *udev,
	64	struct swoc_info *swocInfo)
	65	{
	66	int result;
	67
	68	US_DEBUGP("SWIMS: Attempting to get TRU-Install info.\n");
	69
	70	result = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
	71	SWIMS_USB_REQUEST_GetSwocInfo, /* __u8 request */
72	USB_TYPE_VENDOR \| USB_DIR_IN, /* __u8 request type */
73	0, /* __u16 value */
74	0, /* __u16 index */
75	(void ) swocInfo, / void data /
76	sizeof(struct swoc_info), /* __u16 size */
77	USB_CTRL_SET_TIMEOUT); /* int timeout */
78
79	swocInfo->LinuxSKU = le16_to_cpu(swocInfo->LinuxSKU);
80	swocInfo->LinuxVer = le16_to_cpu(swocInfo->LinuxVer);
81	return result;
82	}
83
84	static void debug_swoc(struct swoc_info *swocInfo)
85	{
86	US_DEBUGP("SWIMS: SWoC Rev: %02d \n", swocInfo->rev);
87	US_DEBUGP("SWIMS: Linux SKU: %04X \n", swocInfo->LinuxSKU);
88	US_DEBUGP("SWIMS: Linux Version: %04X \n", swocInfo->LinuxVer);
89	}
90
91
92	static ssize_t show_truinst(struct device dev, struct device_attribute attr,
93	char *buf)
94	{
95	struct swoc_info *swocInfo;
96	struct usb_interface *intf = to_usb_interface(dev);
97	struct usb_device *udev = interface_to_usbdev(intf);
98	int result;
99	if (swi_tru_install == TRU_FORCE_MS) {
100	result = snprintf(buf, PAGE_SIZE, "Forced Mass Storage\n");
101	} else {
102	swocInfo = kmalloc(sizeof(struct swoc_info), GFP_KERNEL);
103	if (!swocInfo) {
104	US_DEBUGP("SWIMS: Allocation failure\n");
105	snprintf(buf, PAGE_SIZE, "Error\n");
106	return -ENOMEM;
107	}
108	result = sierra_get_swoc_info(udev, swocInfo);
109	if (result < 0) {
110	US_DEBUGP("SWIMS: failed SWoC query\n");
111	kfree(swocInfo);
112	snprintf(buf, PAGE_SIZE, "Error\n");
113	return -EIO;
114	}
115	debug_swoc(swocInfo);
116	result = snprintf(buf, PAGE_SIZE,
117	"REV=%02d SKU=%04X VER=%04X\n",
118	swocInfo->rev,
119	swocInfo->LinuxSKU,
120	swocInfo->LinuxVer);
121	kfree(swocInfo);
122	}
123	return result;
124	}
d9624e75	125	static DEVICE_ATTR(truinst, S_IRUGO, show_truinst, NULL);
32fe5e39 KL	126
	127	int sierra_ms_init(struct us_data *us)
	128	{
	129	int result, retries;
32fe5e39 KL	130	struct swoc_info *swocInfo;
	131	struct usb_device *udev;
	132	struct Scsi_Host *sh;
	133	struct scsi_device *sd;
	134
32fe5e39 KL	135	retries = 3;
	136	result = 0;
	137	udev = us->pusb_dev;
	138
	139	sh = us_to_host(us);
	140	sd = scsi_get_host_dev(sh);
	141
	142	US_DEBUGP("SWIMS: sierra_ms_init called\n");
	143
	144	/* Force Modem mode */
	145	if (swi_tru_install == TRU_FORCE_MODEM) {
	146	US_DEBUGP("SWIMS: %s", "Forcing Modem Mode\n");
	147	result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
	148	if (result < 0)
	149	US_DEBUGP("SWIMS: Failed to switch to modem mode.\n");
	150	return -EIO;
	151	}
	152	/* Force Mass Storage mode (keep CD-Rom) */
	153	else if (swi_tru_install == TRU_FORCE_MS) {
	154	US_DEBUGP("SWIMS: %s", "Forcing Mass Storage Mode\n");
	155	goto complete;
	156	}
	157	/* Normal TRU-Install Logic */
	158	else {
	159	US_DEBUGP("SWIMS: %s", "Normal SWoC Logic\n");
	160
	161	swocInfo = kmalloc(sizeof(struct swoc_info),
	162	GFP_KERNEL);
	163	if (!swocInfo) {
	164	US_DEBUGP("SWIMS: %s", "Allocation failure\n");
	165	return -ENOMEM;
	166	}
	167
	168	retries = 3;
	169	do {
	170	retries--;
	171	result = sierra_get_swoc_info(udev, swocInfo);
	172	if (result < 0) {
	173	US_DEBUGP("SWIMS: %s", "Failed SWoC query\n");
	174	schedule_timeout_uninterruptible(2*HZ);
	175	}
	176	} while (retries && result < 0);
	177
	178	if (result < 0) {
	179	US_DEBUGP("SWIMS: %s",
	180	"Completely failed SWoC query\n");
	181	kfree(swocInfo);
	182	return -EIO;
	183	}
	184
	185	debug_swoc(swocInfo);
	186
	187	/* If there is not Linux software on the TRU-Install device
	188	* then switch to modem mode
	189	*/
	190	if (!containsFullLinuxPackage(swocInfo)) {
	191	US_DEBUGP("SWIMS: %s",
	192	"Switching to Modem Mode\n");
	193	result = sierra_set_ms_mode(udev,
	194	SWIMS_SET_MODE_Modem);
	195	if (result < 0)
	196	US_DEBUGP("SWIMS: Failed to switch modem\n");
	197	kfree(swocInfo);
	198	return -EIO;
199	}
200	kfree(swocInfo);
201	}
202	complete:
203	result = device_create_file(&us->pusb_intf->dev, &dev_attr_truinst);
204
be475d90	205	return 0;
32fe5e39 KL	206	}
32fe5e39 KL	207