| [3f08fd2b] | 1 | /* | 
|---|
|  | 2 | * Copyright (c) 2011 Vojtech Horky | 
|---|
|  | 3 | * All rights reserved. | 
|---|
|  | 4 | * | 
|---|
|  | 5 | * Redistribution and use in source and binary forms, with or without | 
|---|
|  | 6 | * modification, are permitted provided that the following conditions | 
|---|
|  | 7 | * are met: | 
|---|
|  | 8 | * | 
|---|
|  | 9 | * - Redistributions of source code must retain the above copyright | 
|---|
|  | 10 | *   notice, this list of conditions and the following disclaimer. | 
|---|
|  | 11 | * - Redistributions in binary form must reproduce the above copyright | 
|---|
|  | 12 | *   notice, this list of conditions and the following disclaimer in the | 
|---|
|  | 13 | *   documentation and/or other materials provided with the distribution. | 
|---|
|  | 14 | * - The name of the author may not be used to endorse or promote products | 
|---|
|  | 15 | *   derived from this software without specific prior written permission. | 
|---|
|  | 16 | * | 
|---|
|  | 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR | 
|---|
|  | 18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | 
|---|
|  | 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. | 
|---|
|  | 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, | 
|---|
|  | 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | 
|---|
|  | 22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | 
|---|
|  | 23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | 
|---|
|  | 24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | 
|---|
|  | 25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | 
|---|
|  | 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
|---|
|  | 27 | */ | 
|---|
|  | 28 |  | 
|---|
|  | 29 | /** @addtogroup drvusbmast | 
|---|
|  | 30 | * @{ | 
|---|
|  | 31 | */ | 
|---|
|  | 32 | /** @file | 
|---|
|  | 33 | * USB mass storage commands. | 
|---|
|  | 34 | */ | 
|---|
|  | 35 |  | 
|---|
|  | 36 | #include <byteorder.h> | 
|---|
|  | 37 | #include <mem.h> | 
|---|
|  | 38 | #include <sys/types.h> | 
|---|
|  | 39 | #include <usb/usb.h> | 
|---|
| [89d3f3c7] | 40 | #include "cmdw.h" | 
|---|
| [3f08fd2b] | 41 |  | 
|---|
|  | 42 | void usb_massstor_cbw_prepare(usb_massstor_cbw_t *cbw, | 
|---|
|  | 43 | uint32_t tag, uint32_t transfer_length, usb_direction_t dir, | 
|---|
| [38c9505] | 44 | uint8_t lun, uint8_t cmd_len, const uint8_t *cmd) | 
|---|
| [3f08fd2b] | 45 | { | 
|---|
|  | 46 | cbw->dCBWSignature = uint32_host2usb(0x43425355); | 
|---|
|  | 47 | cbw->dCBWTag = tag; | 
|---|
|  | 48 | cbw->dCBWDataTransferLength = transfer_length; | 
|---|
|  | 49 |  | 
|---|
|  | 50 | cbw->bmCBWFlags = 0; | 
|---|
|  | 51 | if (dir == USB_DIRECTION_IN) { | 
|---|
|  | 52 | cbw->bmCBWFlags |= (1 << 7); | 
|---|
|  | 53 | } | 
|---|
|  | 54 |  | 
|---|
|  | 55 | /* Only lowest 4 bits. */ | 
|---|
|  | 56 | cbw->bCBWLUN = lun & 0x0F; | 
|---|
|  | 57 |  | 
|---|
|  | 58 | /* Only lowest 5 bits. */ | 
|---|
|  | 59 | cbw->bCBWBLength = cmd_len & 0x1F; | 
|---|
|  | 60 |  | 
|---|
|  | 61 | memcpy(cbw->CBWCB, cmd, cbw->bCBWBLength); | 
|---|
|  | 62 | } | 
|---|
|  | 63 |  | 
|---|
|  | 64 | /** | 
|---|
|  | 65 | * @} | 
|---|
|  | 66 | */ | 
|---|