Radio Junk Box / Mbed 2 deprecated KAMUI_USBHOST_MIDI-CV_Example

KAMUI USB HOST MIDI-CV Example based on Peter Barrett's BlueUSB

Dependencies:   TextLCD mbed

MassStorage.cpp@0:3b4e3e2ec6a5, 2012-05-11 (annotated)

Committer:
radiojunkbox
Date:
Fri May 11 15:31:59 2012 +0000
Revision:
0:3b4e3e2ec6a5
Rev. 0.1 alfa

Who changed what in which revision?

UserRevisionLine numberNew contents of line
radiojunkbox 0:3b4e3e2ec6a5 1
radiojunkbox 0:3b4e3e2ec6a5 2 /*
radiojunkbox 0:3b4e3e2ec6a5 3 Copyright (c) 2010 Peter Barrett
radiojunkbox 0:3b4e3e2ec6a5 4
radiojunkbox 0:3b4e3e2ec6a5 5 Permission is hereby granted, free of charge, to any person obtaining a copy
radiojunkbox 0:3b4e3e2ec6a5 6 of this software and associated documentation files (the "Software"), to deal
radiojunkbox 0:3b4e3e2ec6a5 7 in the Software without restriction, including without limitation the rights
radiojunkbox 0:3b4e3e2ec6a5 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
radiojunkbox 0:3b4e3e2ec6a5 9 copies of the Software, and to permit persons to whom the Software is
radiojunkbox 0:3b4e3e2ec6a5 10 furnished to do so, subject to the following conditions:
radiojunkbox 0:3b4e3e2ec6a5 11
radiojunkbox 0:3b4e3e2ec6a5 12 The above copyright notice and this permission notice shall be included in
radiojunkbox 0:3b4e3e2ec6a5 13 all copies or substantial portions of the Software.
radiojunkbox 0:3b4e3e2ec6a5 14
radiojunkbox 0:3b4e3e2ec6a5 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
radiojunkbox 0:3b4e3e2ec6a5 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
radiojunkbox 0:3b4e3e2ec6a5 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
radiojunkbox 0:3b4e3e2ec6a5 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
radiojunkbox 0:3b4e3e2ec6a5 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
radiojunkbox 0:3b4e3e2ec6a5 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
radiojunkbox 0:3b4e3e2ec6a5 21 THE SOFTWARE.
radiojunkbox 0:3b4e3e2ec6a5 22 */
radiojunkbox 0:3b4e3e2ec6a5 23
radiojunkbox 0:3b4e3e2ec6a5 24 #include "stdlib.h"
radiojunkbox 0:3b4e3e2ec6a5 25 #include "stdio.h"
radiojunkbox 0:3b4e3e2ec6a5 26 #include "string.h"
radiojunkbox 0:3b4e3e2ec6a5 27
radiojunkbox 0:3b4e3e2ec6a5 28 #include "Utils.h"
radiojunkbox 0:3b4e3e2ec6a5 29 #include "USBHost.h"
radiojunkbox 0:3b4e3e2ec6a5 30
radiojunkbox 0:3b4e3e2ec6a5 31
radiojunkbox 0:3b4e3e2ec6a5 32 int MassStorage_ReadCapacity(int device, u32* blockCount, u32* blockSize);
radiojunkbox 0:3b4e3e2ec6a5 33 int MassStorage_ReadBlock(int device, u32 block, u8* dst);
radiojunkbox 0:3b4e3e2ec6a5 34 int MassStorage_WriteBlock(int device, u32 block, const u8* dst);
radiojunkbox 0:3b4e3e2ec6a5 35
radiojunkbox 0:3b4e3e2ec6a5 36
radiojunkbox 0:3b4e3e2ec6a5 37 #define ERR_BAD_CSW_SIGNATURE -200
radiojunkbox 0:3b4e3e2ec6a5 38
radiojunkbox 0:3b4e3e2ec6a5 39 #define CBW_SIGNATURE 0x43425355
radiojunkbox 0:3b4e3e2ec6a5 40 #define CSW_SIGNATURE 0x53425355
radiojunkbox 0:3b4e3e2ec6a5 41
radiojunkbox 0:3b4e3e2ec6a5 42 // Command Block
radiojunkbox 0:3b4e3e2ec6a5 43 typedef struct
radiojunkbox 0:3b4e3e2ec6a5 44 {
radiojunkbox 0:3b4e3e2ec6a5 45 u32 Signature;
radiojunkbox 0:3b4e3e2ec6a5 46 u32 Tag;
radiojunkbox 0:3b4e3e2ec6a5 47 u32 TransferLength;
radiojunkbox 0:3b4e3e2ec6a5 48 u8 Flags;
radiojunkbox 0:3b4e3e2ec6a5 49 u8 LUN;
radiojunkbox 0:3b4e3e2ec6a5 50 u8 CBLength;
radiojunkbox 0:3b4e3e2ec6a5 51 u8 CB[16]; // only 6 really
radiojunkbox 0:3b4e3e2ec6a5 52 } CBW;
radiojunkbox 0:3b4e3e2ec6a5 53
radiojunkbox 0:3b4e3e2ec6a5 54 // Status block
radiojunkbox 0:3b4e3e2ec6a5 55 typedef struct
radiojunkbox 0:3b4e3e2ec6a5 56 {
radiojunkbox 0:3b4e3e2ec6a5 57 u32 Signature;
radiojunkbox 0:3b4e3e2ec6a5 58 u32 Tag;
radiojunkbox 0:3b4e3e2ec6a5 59 u32 DataResidue;
radiojunkbox 0:3b4e3e2ec6a5 60 u8 Status;
radiojunkbox 0:3b4e3e2ec6a5 61 } CSW;
radiojunkbox 0:3b4e3e2ec6a5 62
radiojunkbox 0:3b4e3e2ec6a5 63 int SCSIRequestSense(int device);
radiojunkbox 0:3b4e3e2ec6a5 64
radiojunkbox 0:3b4e3e2ec6a5 65 int DoSCSI(int device, const u8* cmd, int cmdLen, int flags, u8* data, u32 transferLen)
radiojunkbox 0:3b4e3e2ec6a5 66 {
radiojunkbox 0:3b4e3e2ec6a5 67 CBW cbw;
radiojunkbox 0:3b4e3e2ec6a5 68 cbw.Signature = CBW_SIGNATURE;
radiojunkbox 0:3b4e3e2ec6a5 69 cbw.Tag = 0;
radiojunkbox 0:3b4e3e2ec6a5 70 cbw.TransferLength = transferLen;
radiojunkbox 0:3b4e3e2ec6a5 71 cbw.Flags = flags;
radiojunkbox 0:3b4e3e2ec6a5 72 cbw.LUN = 0;
radiojunkbox 0:3b4e3e2ec6a5 73 cbw.CBLength = cmdLen;
radiojunkbox 0:3b4e3e2ec6a5 74 memset(cbw.CB,0,sizeof(cbw.CB));
radiojunkbox 0:3b4e3e2ec6a5 75 memcpy(cbw.CB,cmd,cmdLen);
radiojunkbox 0:3b4e3e2ec6a5 76
radiojunkbox 0:3b4e3e2ec6a5 77 int r;
radiojunkbox 0:3b4e3e2ec6a5 78 r = USBBulkTransfer(device,0x01,(u8*)&cbw,31); // Send the command
radiojunkbox 0:3b4e3e2ec6a5 79 if (r < 0)
radiojunkbox 0:3b4e3e2ec6a5 80 return r;
radiojunkbox 0:3b4e3e2ec6a5 81
radiojunkbox 0:3b4e3e2ec6a5 82 if (data)
radiojunkbox 0:3b4e3e2ec6a5 83 {
radiojunkbox 0:3b4e3e2ec6a5 84 r = USBBulkTransfer(device,flags | 1,data,transferLen);
radiojunkbox 0:3b4e3e2ec6a5 85 if (r < 0)
radiojunkbox 0:3b4e3e2ec6a5 86 return r;
radiojunkbox 0:3b4e3e2ec6a5 87 }
radiojunkbox 0:3b4e3e2ec6a5 88
radiojunkbox 0:3b4e3e2ec6a5 89 CSW csw;
radiojunkbox 0:3b4e3e2ec6a5 90 csw.Signature = 0;
radiojunkbox 0:3b4e3e2ec6a5 91 r = USBBulkTransfer(device,0x81,(u8*)&csw,13);
radiojunkbox 0:3b4e3e2ec6a5 92 if (r < 0)
radiojunkbox 0:3b4e3e2ec6a5 93 return r;
radiojunkbox 0:3b4e3e2ec6a5 94
radiojunkbox 0:3b4e3e2ec6a5 95 if (csw.Signature != CSW_SIGNATURE)
radiojunkbox 0:3b4e3e2ec6a5 96 return ERR_BAD_CSW_SIGNATURE;
radiojunkbox 0:3b4e3e2ec6a5 97
radiojunkbox 0:3b4e3e2ec6a5 98 // ModeSense?
radiojunkbox 0:3b4e3e2ec6a5 99 if (csw.Status == 1 && cmd[0] != 3)
radiojunkbox 0:3b4e3e2ec6a5 100 return SCSIRequestSense(device);
radiojunkbox 0:3b4e3e2ec6a5 101
radiojunkbox 0:3b4e3e2ec6a5 102 return csw.Status;
radiojunkbox 0:3b4e3e2ec6a5 103 }
radiojunkbox 0:3b4e3e2ec6a5 104
radiojunkbox 0:3b4e3e2ec6a5 105 int SCSITestUnitReady(int device)
radiojunkbox 0:3b4e3e2ec6a5 106 {
radiojunkbox 0:3b4e3e2ec6a5 107 u8 cmd[6];
radiojunkbox 0:3b4e3e2ec6a5 108 memset(cmd,0,6);
radiojunkbox 0:3b4e3e2ec6a5 109 return DoSCSI(device,cmd,6,DEVICE_TO_HOST,0,0);
radiojunkbox 0:3b4e3e2ec6a5 110 }
radiojunkbox 0:3b4e3e2ec6a5 111
radiojunkbox 0:3b4e3e2ec6a5 112 int SCSIRequestSense(int device)
radiojunkbox 0:3b4e3e2ec6a5 113 {
radiojunkbox 0:3b4e3e2ec6a5 114 u8 cmd[6] = {0x03,0,0,0,18,0};
radiojunkbox 0:3b4e3e2ec6a5 115 u8 result[18];
radiojunkbox 0:3b4e3e2ec6a5 116 int r = DoSCSI(device,cmd,6,DEVICE_TO_HOST,result,18);
radiojunkbox 0:3b4e3e2ec6a5 117 return r;
radiojunkbox 0:3b4e3e2ec6a5 118 }
radiojunkbox 0:3b4e3e2ec6a5 119
radiojunkbox 0:3b4e3e2ec6a5 120 int SCSIInquiry(int device)
radiojunkbox 0:3b4e3e2ec6a5 121 {
radiojunkbox 0:3b4e3e2ec6a5 122 u8 cmd[6] = {0x12,0,0,0,36,0};
radiojunkbox 0:3b4e3e2ec6a5 123 u8 result[36+2];
radiojunkbox 0:3b4e3e2ec6a5 124 result[36] = '\n';
radiojunkbox 0:3b4e3e2ec6a5 125 result[37] = 0;
radiojunkbox 0:3b4e3e2ec6a5 126 int r = DoSCSI(device,cmd,6,DEVICE_TO_HOST,result,36);
radiojunkbox 0:3b4e3e2ec6a5 127 if (r == 0)
radiojunkbox 0:3b4e3e2ec6a5 128 printf((const char*)result + 8);
radiojunkbox 0:3b4e3e2ec6a5 129 return r;
radiojunkbox 0:3b4e3e2ec6a5 130 }
radiojunkbox 0:3b4e3e2ec6a5 131
radiojunkbox 0:3b4e3e2ec6a5 132 int SCSIReadCapacity(int device, u32* blockCount, u32* blockSize)
radiojunkbox 0:3b4e3e2ec6a5 133 {
radiojunkbox 0:3b4e3e2ec6a5 134 u8 cmd[10] = {0x25,0,0,0,8,0,0,0,0,0};
radiojunkbox 0:3b4e3e2ec6a5 135 u8 result[8];
radiojunkbox 0:3b4e3e2ec6a5 136 *blockSize = 0;
radiojunkbox 0:3b4e3e2ec6a5 137 *blockCount = 0;
radiojunkbox 0:3b4e3e2ec6a5 138 int r = DoSCSI(device,cmd,10,DEVICE_TO_HOST,result,8);
radiojunkbox 0:3b4e3e2ec6a5 139 if (r == 0)
radiojunkbox 0:3b4e3e2ec6a5 140 {
radiojunkbox 0:3b4e3e2ec6a5 141 *blockCount = BE32(result);
radiojunkbox 0:3b4e3e2ec6a5 142 *blockSize = BE32(result+4);
radiojunkbox 0:3b4e3e2ec6a5 143 }
radiojunkbox 0:3b4e3e2ec6a5 144 return r;
radiojunkbox 0:3b4e3e2ec6a5 145 }
radiojunkbox 0:3b4e3e2ec6a5 146
radiojunkbox 0:3b4e3e2ec6a5 147 int SCSITransfer(int device, u32 blockAddr, u32 blockCount, u8* dst, u32 blockSize, int direction)
radiojunkbox 0:3b4e3e2ec6a5 148 {
radiojunkbox 0:3b4e3e2ec6a5 149 // USB hardware will only do 4k per transfer
radiojunkbox 0:3b4e3e2ec6a5 150 while (blockCount*blockSize > 4096)
radiojunkbox 0:3b4e3e2ec6a5 151 {
radiojunkbox 0:3b4e3e2ec6a5 152 int count = 4096/blockSize;
radiojunkbox 0:3b4e3e2ec6a5 153 int r = SCSITransfer(device,blockAddr,count,dst,blockSize,direction);
radiojunkbox 0:3b4e3e2ec6a5 154 dst += count*blockSize;
radiojunkbox 0:3b4e3e2ec6a5 155 blockAddr += count;
radiojunkbox 0:3b4e3e2ec6a5 156 blockCount -= count;
radiojunkbox 0:3b4e3e2ec6a5 157 }
radiojunkbox 0:3b4e3e2ec6a5 158
radiojunkbox 0:3b4e3e2ec6a5 159 u8 cmd[10];
radiojunkbox 0:3b4e3e2ec6a5 160 memset(cmd,0,10);
radiojunkbox 0:3b4e3e2ec6a5 161 cmd[0] = (direction == DEVICE_TO_HOST) ? 0x28 : 0x2A;
radiojunkbox 0:3b4e3e2ec6a5 162 BE32(blockAddr,cmd+2);
radiojunkbox 0:3b4e3e2ec6a5 163 BE16(blockCount,cmd+7);
radiojunkbox 0:3b4e3e2ec6a5 164 return DoSCSI(device,cmd,10,direction,dst,blockSize*blockCount);
radiojunkbox 0:3b4e3e2ec6a5 165 }
radiojunkbox 0:3b4e3e2ec6a5 166
radiojunkbox 0:3b4e3e2ec6a5 167 int MassStorage_ReadCapacity(int device, u32* blockCount, u32* blockSize)
radiojunkbox 0:3b4e3e2ec6a5 168 {
radiojunkbox 0:3b4e3e2ec6a5 169 return SCSIReadCapacity(device,blockCount,blockSize);
radiojunkbox 0:3b4e3e2ec6a5 170 }
radiojunkbox 0:3b4e3e2ec6a5 171
radiojunkbox 0:3b4e3e2ec6a5 172 int MassStorage_Read(int device, u32 blockAddr, u32 blockCount, u8* dst, u32 blockSize = 512)
radiojunkbox 0:3b4e3e2ec6a5 173 {
radiojunkbox 0:3b4e3e2ec6a5 174 return SCSITransfer(device,blockAddr,blockCount,dst,blockSize,DEVICE_TO_HOST);
radiojunkbox 0:3b4e3e2ec6a5 175 }
radiojunkbox 0:3b4e3e2ec6a5 176
radiojunkbox 0:3b4e3e2ec6a5 177 int MassStorage_Write(int device, u32 blockAddr, u32 blockCount, u8* dst, u32 blockSize = 512)
radiojunkbox 0:3b4e3e2ec6a5 178 {
radiojunkbox 0:3b4e3e2ec6a5 179 return SCSITransfer(device,blockAddr,blockCount,dst,blockSize,HOST_TO_DEVICE);
radiojunkbox 0:3b4e3e2ec6a5 180 }