1
/* usbms.c - USB Mass Storage Support. */
3
* GRUB -- GRand Unified Bootloader
4
* Copyright (C) 2008 Free Software Foundation, Inc.
6
* GRUB is free software: you can redistribute it and/or modify
7
* it under the terms of the GNU General Public License as published by
8
* the Free Software Foundation, either version 3 of the License, or
9
* (at your option) any later version.
11
* GRUB is distributed in the hope that it will be useful,
12
* but WITHOUT ANY WARRANTY; without even the implied warranty of
13
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14
* GNU General Public License for more details.
16
* You should have received a copy of the GNU General Public License
17
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
23
#include <grub/scsi.h>
24
#include <grub/scsicmd.h>
25
#include <grub/misc.h>
27
#define GRUB_USBMS_DIRECTION_BIT 7
29
/* The USB Mass Storage Command Block Wrapper. */
32
grub_uint32_t signature;
34
grub_uint32_t transfer_length;
38
grub_uint8_t cbwcb[16];
39
} __attribute__ ((packed));
43
grub_uint32_t signature;
45
grub_uint32_t residue;
47
} __attribute__ ((packed));
51
struct grub_usb_device *dev;
56
struct grub_usb_desc_endp *in;
57
struct grub_usb_desc_endp *out;
62
struct grub_usbms_dev *next;
64
typedef struct grub_usbms_dev *grub_usbms_dev_t;
66
static grub_usbms_dev_t grub_usbms_dev_list;
71
grub_usbms_reset (grub_usb_device_t dev, int interface)
73
return grub_usb_control_msg (dev, 0x21, 255, 0, interface, 0, 0);
77
grub_usbms_finddevs (void)
79
auto int usb_iterate (grub_usb_device_t dev);
81
int usb_iterate (grub_usb_device_t usbdev)
84
struct grub_usb_desc_device *descdev = &usbdev->descdev;
87
if (descdev->class != 0 || descdev->subclass || descdev->protocol != 0)
90
/* XXX: Just check configuration 0 for now. */
91
for (i = 0; i < usbdev->config[0].descconf->numif; i++)
93
struct grub_usbms_dev *usbms;
94
struct grub_usb_desc_if *interf;
98
interf = usbdev->config[0].interf[i].descif;
100
/* If this is not a USB Mass Storage device with a supported
101
protocol, just skip it. */
102
if (interf->class != GRUB_USB_CLASS_MASS_STORAGE
103
|| interf->subclass != GRUB_USBMS_SUBCLASS_BULK
104
|| interf->protocol != GRUB_USBMS_PROTOCOL_BULK)
110
usbms = grub_zalloc (sizeof (struct grub_usbms_dev));
115
usbms->interface = i;
117
/* Iterate over all endpoints of this interface, at least a
118
IN and OUT bulk endpoint are required. */
119
for (j = 0; j < interf->endpointcnt; j++)
121
struct grub_usb_desc_endp *endp;
122
endp = &usbdev->config[0].interf[i].descendp[j];
124
if ((endp->endp_addr & 128) && (endp->attrib & 3) == 2)
126
/* Bulk IN endpoint. */
128
grub_usb_clear_halt (usbdev, endp->endp_addr & 128);
129
usbms->in_maxsz = endp->maxpacket;
131
else if (!(endp->endp_addr & 128) && (endp->attrib & 3) == 2)
133
/* Bulk OUT endpoint. */
135
grub_usb_clear_halt (usbdev, endp->endp_addr & 128);
136
usbms->out_maxsz = endp->maxpacket;
140
if (!usbms->in || !usbms->out)
146
/* Query the amount of LUNs. */
147
err = grub_usb_control_msg (usbdev, 0xA1, 254,
148
0, i, 1, (char *) &luns);
151
/* In case of a stall, clear the stall. */
152
if (err == GRUB_USB_ERR_STALL)
154
grub_usb_clear_halt (usbdev, usbms->in->endp_addr & 3);
155
grub_usb_clear_halt (usbdev, usbms->out->endp_addr & 3);
158
/* Just set the amount of LUNs to one. */
159
grub_errno = GRUB_ERR_NONE;
165
/* XXX: Check the magic values, does this really make
167
grub_usb_control_msg (usbdev, (1 << 6) | 1, 255,
170
/* XXX: To make Qemu work? */
171
if (usbms->luns == 0)
174
usbms->next = grub_usbms_dev_list;
175
grub_usbms_dev_list = usbms;
177
/* XXX: Activate the first configuration. */
178
grub_usb_set_configuration (usbdev, 1);
180
/* Bulk-Only Mass Storage Reset, after the reset commands
182
grub_usbms_reset (usbdev, i);
190
grub_usb_iterate (usb_iterate);
196
grub_usbms_iterate (int (*hook) (const char *name, int luns))
201
for (p = grub_usbms_dev_list; p; p = p->next)
204
devname = grub_xasprintf ("usb%d", cnt);
206
if (hook (devname, p->luns))
219
grub_usbms_transfer (struct grub_scsi *scsi, grub_size_t cmdsize, char *cmd,
220
grub_size_t size, char *buf, int read_write)
222
struct grub_usbms_cbw cbw;
223
grub_usbms_dev_t dev = (grub_usbms_dev_t) scsi->data;
224
struct grub_usbms_csw status;
225
static grub_uint32_t tag = 0;
226
grub_usb_err_t err = GRUB_USB_ERR_NONE;
227
int retrycnt = 3 + 1;
232
return grub_error (GRUB_ERR_IO, "USB Mass Storage stalled");
234
/* Setup the request. */
235
grub_memset (&cbw, 0, sizeof (cbw));
236
cbw.signature = grub_cpu_to_le32 (0x43425355);
238
cbw.transfer_length = grub_cpu_to_le32 (size);
239
cbw.flags = (!read_write) << GRUB_USBMS_DIRECTION_BIT;
240
cbw.lun = scsi->lun << GRUB_SCSI_LUN_SHIFT;
241
cbw.length = cmdsize;
242
grub_memcpy (cbw.cbwcb, cmd, cmdsize);
244
/* Write the request. */
245
err = grub_usb_bulk_write (dev->dev, dev->out->endp_addr & 15,
246
sizeof (cbw), (char *) &cbw);
249
if (err == GRUB_USB_ERR_STALL)
251
grub_usb_clear_halt (dev->dev, dev->out->endp_addr);
254
return grub_error (GRUB_ERR_IO, "USB Mass Storage request failed");
257
/* Read/write the data. */
260
err = grub_usb_bulk_read (dev->dev, dev->in->endp_addr & 15, size, buf);
261
grub_dprintf ("usb", "read: %d %d\n", err, GRUB_USB_ERR_STALL);
264
if (err == GRUB_USB_ERR_STALL)
266
grub_usb_clear_halt (dev->dev, dev->in->endp_addr);
269
return grub_error (GRUB_ERR_READ_ERROR,
270
"can't read from USB Mass Storage device");
275
err = grub_usb_bulk_write (dev->dev, dev->in->endp_addr & 15, size, buf);
276
grub_dprintf ("usb", "write: %d %d\n", err, GRUB_USB_ERR_STALL);
279
if (err == GRUB_USB_ERR_STALL)
281
grub_usb_clear_halt (dev->dev, dev->out->endp_addr);
284
return grub_error (GRUB_ERR_WRITE_ERROR,
285
"can't write to USB Mass Storage device");
289
/* Read the status. */
290
err = grub_usb_bulk_read (dev->dev, dev->in->endp_addr & 15,
291
sizeof (status), (char *) &status);
294
if (err == GRUB_USB_ERR_STALL)
296
grub_usb_clear_halt (dev->dev, dev->in->endp_addr);
299
return grub_error (GRUB_ERR_READ_ERROR,
300
"can't read status from USB Mass Storage device");
303
/* XXX: Magic and check this code. */
304
if (status.status == 2)
306
/* XXX: Phase error, reset device. */
307
grub_usbms_reset (dev->dev, dev->interface);
308
grub_usb_clear_halt (dev->dev, dev->in->endp_addr);
309
grub_usb_clear_halt (dev->dev, dev->out->endp_addr);
315
return grub_error (GRUB_ERR_READ_ERROR,
316
"error communication with USB Mass Storage device");
318
return GRUB_ERR_NONE;
323
grub_usbms_read (struct grub_scsi *scsi, grub_size_t cmdsize, char *cmd,
324
grub_size_t size, char *buf)
326
return grub_usbms_transfer (scsi, cmdsize, cmd, size, buf, 0);
330
grub_usbms_write (struct grub_scsi *scsi, grub_size_t cmdsize, char *cmd,
331
grub_size_t size, char *buf)
333
return grub_usbms_transfer (scsi, cmdsize, cmd, size, buf, 1);
337
grub_usbms_open (const char *name, struct grub_scsi *scsi)
343
if (grub_strncmp (name, "usb", 3))
344
return grub_error (GRUB_ERR_UNKNOWN_DEVICE,
345
"not a USB Mass Storage device");
347
devnum = grub_strtoul (name + 3, NULL, 10);
348
for (p = grub_usbms_dev_list; p; p = p->next)
350
/* Check if this is the devnumth device. */
354
scsi->name = grub_strdup (name);
355
scsi->luns = p->luns;
359
return GRUB_ERR_NONE;
365
return grub_error (GRUB_ERR_UNKNOWN_DEVICE,
366
"not a USB Mass Storage device");
370
grub_usbms_close (struct grub_scsi *scsi)
372
grub_free (scsi->name);
375
static struct grub_scsi_dev grub_usbms_dev =
378
.iterate = grub_usbms_iterate,
379
.open = grub_usbms_open,
380
.close = grub_usbms_close,
381
.read = grub_usbms_read,
382
.write = grub_usbms_write
387
grub_usbms_finddevs ();
388
grub_scsi_dev_register (&grub_usbms_dev);
393
grub_scsi_dev_unregister (&grub_usbms_dev);