2 #include <scsi/scsi_host.h>
3 #include <scsi/scsi_cmnd.h>
4 #include <scsi/scsi_device.h>
6 #include <linux/module.h>
7 #include <linux/slab.h>
10 #include "transport.h"
13 #include "sierra_ms.h"
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
21 #define TRU_NORMAL 0x01
22 #define TRU_FORCE_MS 0x02
23 #define TRU_FORCE_MODEM 0x03
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)");
36 } __attribute__((__packed__));
38 static bool containsFullLinuxPackage(struct swoc_info *swocInfo)
40 if ((swocInfo->LinuxSKU >= 0x2100 && swocInfo->LinuxSKU <= 0x2FFF) ||
41 (swocInfo->LinuxSKU >= 0x7100 && swocInfo->LinuxSKU <= 0x7FFF))
47 static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
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 */
58 USB_CTRL_SET_TIMEOUT); /* int timeout */
63 static int sierra_get_swoc_info(struct usb_device *udev,
64 struct swoc_info *swocInfo)
68 US_DEBUGP("SWIMS: Attempting to get TRU-Install info.\n");
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 */
75 (void *) swocInfo, /* void *data */
76 sizeof(struct swoc_info), /* __u16 size */
77 USB_CTRL_SET_TIMEOUT); /* int timeout */
79 swocInfo->LinuxSKU = le16_to_cpu(swocInfo->LinuxSKU);
80 swocInfo->LinuxVer = le16_to_cpu(swocInfo->LinuxVer);
84 static void debug_swoc(struct swoc_info *swocInfo)
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);
92 static ssize_t show_truinst(struct device *dev, struct device_attribute *attr,
95 struct swoc_info *swocInfo;
96 struct usb_interface *intf = to_usb_interface(dev);
97 struct usb_device *udev = interface_to_usbdev(intf);
99 if (swi_tru_install == TRU_FORCE_MS) {
100 result = snprintf(buf, PAGE_SIZE, "Forced Mass Storage\n");
102 swocInfo = kmalloc(sizeof(struct swoc_info), GFP_KERNEL);
104 US_DEBUGP("SWIMS: Allocation failure\n");
105 snprintf(buf, PAGE_SIZE, "Error\n");
108 result = sierra_get_swoc_info(udev, swocInfo);
110 US_DEBUGP("SWIMS: failed SWoC query\n");
112 snprintf(buf, PAGE_SIZE, "Error\n");
115 debug_swoc(swocInfo);
116 result = snprintf(buf, PAGE_SIZE,
117 "REV=%02d SKU=%04X VER=%04X\n",
125 static DEVICE_ATTR(truinst, S_IRUGO, show_truinst, NULL);
127 int sierra_ms_init(struct us_data *us)
130 struct swoc_info *swocInfo;
131 struct usb_device *udev;
132 struct Scsi_Host *sh;
133 struct scsi_device *sd;
140 sd = scsi_get_host_dev(sh);
142 US_DEBUGP("SWIMS: sierra_ms_init called\n");
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);
149 US_DEBUGP("SWIMS: Failed to switch to modem mode.\n");
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");
157 /* Normal TRU-Install Logic */
159 US_DEBUGP("SWIMS: %s", "Normal SWoC Logic\n");
161 swocInfo = kmalloc(sizeof(struct swoc_info),
164 US_DEBUGP("SWIMS: %s", "Allocation failure\n");
171 result = sierra_get_swoc_info(udev, swocInfo);
173 US_DEBUGP("SWIMS: %s", "Failed SWoC query\n");
174 schedule_timeout_uninterruptible(2*HZ);
176 } while (retries && result < 0);
179 US_DEBUGP("SWIMS: %s",
180 "Completely failed SWoC query\n");
185 debug_swoc(swocInfo);
187 /* If there is not Linux software on the TRU-Install device
188 * then switch to modem mode
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);
196 US_DEBUGP("SWIMS: Failed to switch modem\n");
203 result = device_create_file(&us->pusb_intf->dev, &dev_attr_truinst);