Ad van der Weiden / Mbed 2 deprecated ftusbClass

class library to access fischertechnik interfaces via USB

Dependencies:   FatFileSystem mbed myBlueUSB neigbourhood rfcomm sdp

myUSBHost/MassStorage.cpp@1:4676e8b9b357, 2013-03-11 (annotated)

Committer:
networker
Date:
Mon Mar 11 08:04:37 2013 +0000
Revision:
1:4676e8b9b357
Parent:
0:7da612835693 
first publication of this experimental class, just for sharing wip

Who changed what in which revision?

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