1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59#define FSG_VENDOR_ID 0x0525
60#define FSG_PRODUCT_ID 0xa4a5
61
62
63
64#ifndef DEBUG
65#undef VERBOSE_DEBUG
66#undef DUMP_MSGS
67#endif
68
69#ifdef VERBOSE_DEBUG
70#define VLDBG LDBG
71#else
72#define VLDBG(lun, fmt, args...) do { } while (0)
73#endif
74
75
76
77
78
79
80
81
82#define LDBG(lun, fmt, args...) do { } while (0)
83#define LERROR(lun, fmt, args...) do { } while (0)
84#define LWARN(lun, fmt, args...) do { } while (0)
85#define LINFO(lun, fmt, args...) do { } while (0)
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109#define DBG(d, fmt, args...) debug(fmt , ## args)
110#define VDBG(d, fmt, args...) debug(fmt , ## args)
111
112
113
114
115
116
117#define ERROR(d, fmt, args...) do { } while (0)
118#define WARNING(d, fmt, args...) do { } while (0)
119#define INFO(d, fmt, args...) do { } while (0)
120
121#ifdef DUMP_MSGS
122
123
124# define dump_msg(fsg, label, buf, length) do { \
125 if (length < 512) { \
126 DBG(fsg, "%s, length %u:\n", label, length); \
127 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, \
128 16, 1, buf, length, 0); \
129 } \
130} while (0)
131
132# define dump_cdb(fsg) do { } while (0)
133
134#else
135
136# define dump_msg(fsg, label, \
137 buf, length) do { } while (0)
138
139# ifdef VERBOSE_DEBUG
140
141# define dump_cdb(fsg) \
142 print_hex_dump(KERN_DEBUG, "SCSI CDB: ", DUMP_PREFIX_NONE, \
143 16, 1, (fsg)->cmnd, (fsg)->cmnd_size, 0) \
144
145# else
146
147# define dump_cdb(fsg) do { } while (0)
148
149# endif
150
151#endif
152
153
154
155
156#define TYPE_DISK 0x00
157#define TYPE_CDROM 0x05
158
159
160#define USB_PR_CBI 0x00
161#define USB_PR_CB 0x01
162#define USB_PR_BULK 0x50
163
164
165#define USB_SC_RBC 0x01
166#define USB_SC_8020 0x02
167#define USB_SC_QIC 0x03
168#define USB_SC_UFI 0x04
169#define USB_SC_8070 0x05
170#define USB_SC_SCSI 0x06
171
172
173
174
175struct fsg_bulk_cb_wrap {
176 __le32 Signature;
177 u32 Tag;
178 __le32 DataTransferLength;
179 u8 Flags;
180 u8 Lun;
181 u8 Length;
182 u8 CDB[16];
183};
184
185#define USB_BULK_CB_WRAP_LEN 31
186#define USB_BULK_CB_SIG 0x43425355
187#define USB_BULK_IN_FLAG 0x80
188
189
190struct bulk_cs_wrap {
191 __le32 Signature;
192 u32 Tag;
193 __le32 Residue;
194 u8 Status;
195};
196
197#define USB_BULK_CS_WRAP_LEN 13
198#define USB_BULK_CS_SIG 0x53425355
199#define USB_STATUS_PASS 0
200#define USB_STATUS_FAIL 1
201#define USB_STATUS_PHASE_ERROR 2
202
203
204#define USB_BULK_RESET_REQUEST 0xff
205#define USB_BULK_GET_MAX_LUN_REQUEST 0xfe
206
207
208struct interrupt_data {
209 u8 bType;
210 u8 bValue;
211};
212
213#define CBI_INTERRUPT_DATA_LEN 2
214
215
216#define USB_CBI_ADSC_REQUEST 0x00
217
218
219#define MAX_COMMAND_SIZE 16
220
221
222#define SC_FORMAT_UNIT 0x04
223#define SC_INQUIRY 0x12
224#define SC_MODE_SELECT_6 0x15
225#define SC_MODE_SELECT_10 0x55
226#define SC_MODE_SENSE_6 0x1a
227#define SC_MODE_SENSE_10 0x5a
228#define SC_PREVENT_ALLOW_MEDIUM_REMOVAL 0x1e
229#define SC_READ_6 0x08
230#define SC_READ_10 0x28
231#define SC_READ_12 0xa8
232#define SC_READ_CAPACITY 0x25
233#define SC_READ_FORMAT_CAPACITIES 0x23
234#define SC_READ_HEADER 0x44
235#define SC_READ_TOC 0x43
236#define SC_RELEASE 0x17
237#define SC_REQUEST_SENSE 0x03
238#define SC_RESERVE 0x16
239#define SC_SEND_DIAGNOSTIC 0x1d
240#define SC_START_STOP_UNIT 0x1b
241#define SC_SYNCHRONIZE_CACHE 0x35
242#define SC_TEST_UNIT_READY 0x00
243#define SC_VERIFY 0x2f
244#define SC_WRITE_6 0x0a
245#define SC_WRITE_10 0x2a
246#define SC_WRITE_12 0xaa
247
248
249#define SS_NO_SENSE 0
250#define SS_COMMUNICATION_FAILURE 0x040800
251#define SS_INVALID_COMMAND 0x052000
252#define SS_INVALID_FIELD_IN_CDB 0x052400
253#define SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE 0x052100
254#define SS_LOGICAL_UNIT_NOT_SUPPORTED 0x052500
255#define SS_MEDIUM_NOT_PRESENT 0x023a00
256#define SS_MEDIUM_REMOVAL_PREVENTED 0x055302
257#define SS_NOT_READY_TO_READY_TRANSITION 0x062800
258#define SS_RESET_OCCURRED 0x062900
259#define SS_SAVING_PARAMETERS_NOT_SUPPORTED 0x053900
260#define SS_UNRECOVERED_READ_ERROR 0x031100
261#define SS_WRITE_ERROR 0x030c02
262#define SS_WRITE_PROTECTED 0x072700
263
264#define SK(x) ((u8) ((x) >> 16))
265#define ASC(x) ((u8) ((x) >> 8))
266#define ASCQ(x) ((u8) (x))
267
268struct device_attribute { int i; };
269#define ETOOSMALL 525
270
271#include <usb_mass_storage.h>
272
273
274
275struct fsg_lun {
276 loff_t file_length;
277 loff_t num_sectors;
278
279 unsigned int initially_ro:1;
280 unsigned int ro:1;
281 unsigned int removable:1;
282 unsigned int cdrom:1;
283 unsigned int prevent_medium_removal:1;
284 unsigned int registered:1;
285 unsigned int info_valid:1;
286 unsigned int nofua:1;
287
288 u32 sense_data;
289 u32 sense_data_info;
290 u32 unit_attention_data;
291
292 struct device dev;
293};
294
295#define fsg_lun_is_open(curlun) ((curlun)->filp != NULL)
296#if 0
297static struct fsg_lun *fsg_lun_from_dev(struct device *dev)
298{
299 return container_of(dev, struct fsg_lun, dev);
300}
301#endif
302
303
304#define EP0_BUFSIZE 256
305#define DELAYED_STATUS (EP0_BUFSIZE + 999)
306
307
308#define FSG_NUM_BUFFERS 2
309
310
311#define FSG_BUFLEN ((u32)131072)
312
313
314#define FSG_MAX_LUNS 8
315
316enum fsg_buffer_state {
317 BUF_STATE_EMPTY = 0,
318 BUF_STATE_FULL,
319 BUF_STATE_BUSY
320};
321
322struct fsg_buffhd {
323#ifdef FSG_BUFFHD_STATIC_BUFFER
324 char buf[FSG_BUFLEN];
325#else
326 void *buf;
327#endif
328 enum fsg_buffer_state state;
329 struct fsg_buffhd *next;
330
331
332
333
334
335
336 unsigned int bulk_out_intended_length;
337
338 struct usb_request *inreq;
339 int inreq_busy;
340 struct usb_request *outreq;
341 int outreq_busy;
342};
343
344enum fsg_state {
345
346 FSG_STATE_COMMAND_PHASE = -10,
347 FSG_STATE_DATA_PHASE,
348 FSG_STATE_STATUS_PHASE,
349
350 FSG_STATE_IDLE = 0,
351 FSG_STATE_ABORT_BULK_OUT,
352 FSG_STATE_RESET,
353 FSG_STATE_INTERFACE_CHANGE,
354 FSG_STATE_CONFIG_CHANGE,
355 FSG_STATE_DISCONNECT,
356 FSG_STATE_EXIT,
357 FSG_STATE_TERMINATED
358};
359
360enum data_direction {
361 DATA_DIR_UNKNOWN = 0,
362 DATA_DIR_FROM_HOST,
363 DATA_DIR_TO_HOST,
364 DATA_DIR_NONE
365};
366
367
368
369static inline u32 get_unaligned_be24(u8 *buf)
370{
371 return 0xffffff & (u32) get_unaligned_be32(buf - 1);
372}
373
374
375
376enum {
377#ifndef FSG_NO_DEVICE_STRINGS
378 FSG_STRING_MANUFACTURER = 1,
379 FSG_STRING_PRODUCT,
380 FSG_STRING_SERIAL,
381 FSG_STRING_CONFIG,
382#endif
383 FSG_STRING_INTERFACE
384};
385
386#ifndef FSG_NO_OTG
387static struct usb_otg_descriptor
388fsg_otg_desc = {
389 .bLength = sizeof fsg_otg_desc,
390 .bDescriptorType = USB_DT_OTG,
391
392 .bmAttributes = USB_OTG_SRP,
393};
394#endif
395
396
397
398static struct usb_interface_descriptor
399fsg_intf_desc = {
400 .bLength = sizeof fsg_intf_desc,
401 .bDescriptorType = USB_DT_INTERFACE,
402
403 .bNumEndpoints = 2,
404 .bInterfaceClass = USB_CLASS_MASS_STORAGE,
405 .bInterfaceSubClass = USB_SC_SCSI,
406 .bInterfaceProtocol = USB_PR_BULK,
407 .iInterface = FSG_STRING_INTERFACE,
408};
409
410
411
412
413
414
415static struct usb_endpoint_descriptor
416fsg_fs_bulk_in_desc = {
417 .bLength = USB_DT_ENDPOINT_SIZE,
418 .bDescriptorType = USB_DT_ENDPOINT,
419
420 .bEndpointAddress = USB_DIR_IN,
421 .bmAttributes = USB_ENDPOINT_XFER_BULK,
422
423};
424
425static struct usb_endpoint_descriptor
426fsg_fs_bulk_out_desc = {
427 .bLength = USB_DT_ENDPOINT_SIZE,
428 .bDescriptorType = USB_DT_ENDPOINT,
429
430 .bEndpointAddress = USB_DIR_OUT,
431 .bmAttributes = USB_ENDPOINT_XFER_BULK,
432
433};
434
435#ifndef FSG_NO_INTR_EP
436
437static struct usb_endpoint_descriptor
438fsg_fs_intr_in_desc = {
439 .bLength = USB_DT_ENDPOINT_SIZE,
440 .bDescriptorType = USB_DT_ENDPOINT,
441
442 .bEndpointAddress = USB_DIR_IN,
443 .bmAttributes = USB_ENDPOINT_XFER_INT,
444 .wMaxPacketSize = cpu_to_le16(2),
445 .bInterval = 32,
446};
447
448#ifndef FSG_NO_OTG
449# define FSG_FS_FUNCTION_PRE_EP_ENTRIES 2
450#else
451# define FSG_FS_FUNCTION_PRE_EP_ENTRIES 1
452#endif
453
454#endif
455
456static struct usb_descriptor_header *fsg_fs_function[] = {
457#ifndef FSG_NO_OTG
458 (struct usb_descriptor_header *) &fsg_otg_desc,
459#endif
460 (struct usb_descriptor_header *) &fsg_intf_desc,
461 (struct usb_descriptor_header *) &fsg_fs_bulk_in_desc,
462 (struct usb_descriptor_header *) &fsg_fs_bulk_out_desc,
463#ifndef FSG_NO_INTR_EP
464 (struct usb_descriptor_header *) &fsg_fs_intr_in_desc,
465#endif
466 NULL,
467};
468
469
470
471
472
473
474
475
476
477static struct usb_endpoint_descriptor
478fsg_hs_bulk_in_desc = {
479 .bLength = USB_DT_ENDPOINT_SIZE,
480 .bDescriptorType = USB_DT_ENDPOINT,
481
482
483 .bmAttributes = USB_ENDPOINT_XFER_BULK,
484 .wMaxPacketSize = cpu_to_le16(512),
485};
486
487static struct usb_endpoint_descriptor
488fsg_hs_bulk_out_desc = {
489 .bLength = USB_DT_ENDPOINT_SIZE,
490 .bDescriptorType = USB_DT_ENDPOINT,
491
492
493 .bmAttributes = USB_ENDPOINT_XFER_BULK,
494 .wMaxPacketSize = cpu_to_le16(512),
495 .bInterval = 1,
496};
497
498#ifndef FSG_NO_INTR_EP
499
500static struct usb_endpoint_descriptor
501fsg_hs_intr_in_desc = {
502 .bLength = USB_DT_ENDPOINT_SIZE,
503 .bDescriptorType = USB_DT_ENDPOINT,
504
505
506 .bmAttributes = USB_ENDPOINT_XFER_INT,
507 .wMaxPacketSize = cpu_to_le16(2),
508 .bInterval = 9,
509};
510
511#ifndef FSG_NO_OTG
512# define FSG_HS_FUNCTION_PRE_EP_ENTRIES 2
513#else
514# define FSG_HS_FUNCTION_PRE_EP_ENTRIES 1
515#endif
516
517#endif
518
519static struct usb_descriptor_header *fsg_hs_function[] = {
520#ifndef FSG_NO_OTG
521 (struct usb_descriptor_header *) &fsg_otg_desc,
522#endif
523 (struct usb_descriptor_header *) &fsg_intf_desc,
524 (struct usb_descriptor_header *) &fsg_hs_bulk_in_desc,
525 (struct usb_descriptor_header *) &fsg_hs_bulk_out_desc,
526#ifndef FSG_NO_INTR_EP
527 (struct usb_descriptor_header *) &fsg_hs_intr_in_desc,
528#endif
529 NULL,
530};
531
532
533static struct usb_endpoint_descriptor *
534fsg_ep_desc(struct usb_gadget *g, struct usb_endpoint_descriptor *fs,
535 struct usb_endpoint_descriptor *hs)
536{
537 if (gadget_is_dualspeed(g) && g->speed == USB_SPEED_HIGH)
538 return hs;
539 return fs;
540}
541
542
543static struct usb_string fsg_strings[] = {
544#ifndef FSG_NO_DEVICE_STRINGS
545 {FSG_STRING_MANUFACTURER, fsg_string_manufacturer},
546 {FSG_STRING_PRODUCT, fsg_string_product},
547 {FSG_STRING_SERIAL, fsg_string_serial},
548 {FSG_STRING_CONFIG, fsg_string_config},
549#endif
550 {FSG_STRING_INTERFACE, fsg_string_interface},
551 {}
552};
553
554static struct usb_gadget_strings fsg_stringtab = {
555 .language = 0x0409,
556 .strings = fsg_strings,
557};
558
559
560
561
562
563
564
565
566static int fsg_lun_open(struct fsg_lun *curlun, unsigned int num_sectors,
567 const char *filename)
568{
569 int ro;
570
571
572 ro = curlun->initially_ro;
573
574 curlun->ro = ro;
575 curlun->file_length = num_sectors << 9;
576 curlun->num_sectors = num_sectors;
577 debug("open backing file: %s\n", filename);
578
579 return 0;
580}
581
582static void fsg_lun_close(struct fsg_lun *curlun)
583{
584}
585
586
587
588
589
590
591
592static int fsg_lun_fsync_sub(struct fsg_lun *curlun)
593{
594 return 0;
595}
596
597static void store_cdrom_address(u8 *dest, int msf, u32 addr)
598{
599 if (msf) {
600
601 addr >>= 2;
602 addr += 2*75;
603 dest[3] = addr % 75;
604 addr /= 75;
605 dest[2] = addr % 60;
606 addr /= 60;
607 dest[1] = addr;
608 dest[0] = 0;
609 } else {
610
611 put_unaligned_be32(addr, dest);
612 }
613}
614
615
616