Junichi Katsu / Mbed 2 deprecated WallbotR4

Test Ver

Dependencies:   mbed FatFileSystem

BlueUSB/MassStorage.cpp@0:269589d8d2c2, 2012-11-17 (annotated)

Committer:
jksoft
Date:
Sat Nov 17 13:22:00 2012 +0000
Revision:
0:269589d8d2c2
Test Program

Who changed what in which revision?

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