春ロボ1班(元F3RC4班+) / Mbed 2 deprecated harurobo_PS3_3_5

3/5

Dependencies:   mbed

MassStorage.cpp@1:530908de68c6, 2019-03-05 (annotated)

Committer:
yuki0701
Date:
Tue Mar 05 04:30:35 2019 +0000
Revision:
1:530908de68c6
Parent:
0:a56be39653d0 
a

Who changed what in which revision?

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