hokuto Abe / Mbed 2 deprecated nisiBlutooth

MassStorage.cpp@0:db1ba09e8bfa, 2012-07-10 (annotated)

Committer:
hosei2
Date:
Tue Jul 10 11:36:47 2012 +0000
Revision:
0:db1ba09e8bfa
zzz

Who changed what in which revision?

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