yoka konishi / Mbed 2 deprecated a1_SPI_master_arm_shudouki

手動機アーム、mbed基盤のspiをおくるだけのプログラムです（9/4）

Dependencies:   SPI_master_arm_shudouki mbed

Fork of SPI_master_arm_shudouki２ by F^3 RC 2班

MassStorage.cpp@0:76d1c7f13415, 2017-08-21 (annotated)

Committer:
yoka06
Date:
Mon Aug 21 08:49:06 2017 +0000
Revision:
0:76d1c7f13415
a

Who changed what in which revision?

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