Branch data Line data Source code
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>
6 : : #include <linux/module.h>
7 : : #include <linux/slab.h>
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 [ # # ]: 0 : 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 : 0 : static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
48 : : {
49 : : int result;
50 : : dev_dbg(&udev->dev, "SWIMS: %s", "DEVICE MODE SWITCH\n");
51 : 0 : 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 : 0 : return result;
60 : : }
61 : :
62 : :
63 : 0 : static int sierra_get_swoc_info(struct usb_device *udev,
64 : : struct swoc_info *swocInfo)
65 : : {
66 : : int result;
67 : :
68 : : dev_dbg(&udev->dev, "SWIMS: Attempting to get TRU-Install info\n");
69 : :
70 : 0 : 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 : 0 : return result;
82 : : }
83 : :
84 : : static void debug_swoc(const struct device *dev, struct swoc_info *swocInfo)
85 : : {
86 : : dev_dbg(dev, "SWIMS: SWoC Rev: %02d\n", swocInfo->rev);
87 : : dev_dbg(dev, "SWIMS: Linux SKU: %04X\n", swocInfo->LinuxSKU);
88 : : dev_dbg(dev, "SWIMS: Linux Version: %04X\n", swocInfo->LinuxVer);
89 : : }
90 : :
91 : :
92 : 0 : static ssize_t show_truinst(struct device *dev, struct device_attribute *attr,
93 : : char *buf)
94 : : {
95 : : struct swoc_info *swocInfo;
96 : 0 : struct usb_interface *intf = to_usb_interface(dev);
97 : 0 : struct usb_device *udev = interface_to_usbdev(intf);
98 : : int result;
99 [ # # ]: 0 : if (swi_tru_install == TRU_FORCE_MS) {
100 : 0 : result = snprintf(buf, PAGE_SIZE, "Forced Mass Storage\n");
101 : : } else {
102 : : swocInfo = kmalloc(sizeof(struct swoc_info), GFP_KERNEL);
103 [ # # ]: 0 : if (!swocInfo) {
104 : 0 : snprintf(buf, PAGE_SIZE, "Error\n");
105 : 0 : return -ENOMEM;
106 : : }
107 : 0 : result = sierra_get_swoc_info(udev, swocInfo);
108 [ # # ]: 0 : if (result < 0) {
109 : : dev_dbg(dev, "SWIMS: failed SWoC query\n");
110 : 0 : kfree(swocInfo);
111 : 0 : snprintf(buf, PAGE_SIZE, "Error\n");
112 : 0 : return -EIO;
113 : : }
114 : : debug_swoc(dev, swocInfo);
115 : 0 : result = snprintf(buf, PAGE_SIZE,
116 : : "REV=%02d SKU=%04X VER=%04X\n",
117 : 0 : swocInfo->rev,
118 : 0 : swocInfo->LinuxSKU,
119 : 0 : swocInfo->LinuxVer);
120 : 0 : kfree(swocInfo);
121 : : }
122 : 0 : return result;
123 : : }
124 : : static DEVICE_ATTR(truinst, S_IRUGO, show_truinst, NULL);
125 : :
126 : 0 : int sierra_ms_init(struct us_data *us)
127 : : {
128 : : int result, retries;
129 : : struct swoc_info *swocInfo;
130 : : struct usb_device *udev;
131 : : struct Scsi_Host *sh;
132 : :
133 : : retries = 3;
134 : : result = 0;
135 : 0 : udev = us->pusb_dev;
136 : :
137 : 0 : sh = us_to_host(us);
138 : 0 : scsi_get_host_dev(sh);
139 : :
140 : : /* Force Modem mode */
141 [ # # ]: 0 : if (swi_tru_install == TRU_FORCE_MODEM) {
142 : : usb_stor_dbg(us, "SWIMS: Forcing Modem Mode\n");
143 : 0 : result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
144 : : if (result < 0)
145 : : usb_stor_dbg(us, "SWIMS: Failed to switch to modem mode\n");
146 : 0 : return -EIO;
147 : : }
148 : : /* Force Mass Storage mode (keep CD-Rom) */
149 [ # # ]: 0 : else if (swi_tru_install == TRU_FORCE_MS) {
150 : : usb_stor_dbg(us, "SWIMS: Forcing Mass Storage Mode\n");
151 : : goto complete;
152 : : }
153 : : /* Normal TRU-Install Logic */
154 : : else {
155 : : usb_stor_dbg(us, "SWIMS: Normal SWoC Logic\n");
156 : :
157 : : swocInfo = kmalloc(sizeof(struct swoc_info),
158 : : GFP_KERNEL);
159 [ # # ]: 0 : if (!swocInfo)
160 : : return -ENOMEM;
161 : :
162 : : retries = 3;
163 : : do {
164 : 0 : retries--;
165 : 0 : result = sierra_get_swoc_info(udev, swocInfo);
166 [ # # ]: 0 : if (result < 0) {
167 : : usb_stor_dbg(us, "SWIMS: Failed SWoC query\n");
168 : 0 : schedule_timeout_uninterruptible(2*HZ);
169 : : }
170 [ # # ]: 0 : } while (retries && result < 0);
171 : :
172 [ # # ]: 0 : if (result < 0) {
173 : : usb_stor_dbg(us, "SWIMS: Completely failed SWoC query\n");
174 : 0 : kfree(swocInfo);
175 : 0 : return -EIO;
176 : : }
177 : :
178 : : debug_swoc(&us->pusb_dev->dev, swocInfo);
179 : :
180 : : /* If there is not Linux software on the TRU-Install device
181 : : * then switch to modem mode
182 : : */
183 [ # # ]: 0 : if (!containsFullLinuxPackage(swocInfo)) {
184 : : usb_stor_dbg(us, "SWIMS: Switching to Modem Mode\n");
185 : 0 : result = sierra_set_ms_mode(udev,
186 : : SWIMS_SET_MODE_Modem);
187 : : if (result < 0)
188 : : usb_stor_dbg(us, "SWIMS: Failed to switch modem\n");
189 : 0 : kfree(swocInfo);
190 : 0 : return -EIO;
191 : : }
192 : 0 : kfree(swocInfo);
193 : : }
194 : : complete:
195 : 0 : result = device_create_file(&us->pusb_intf->dev, &dev_attr_truinst);
196 : :
197 : 0 : return 0;
198 : : }
199 : :
|
