Peter Cooper / Mbed 2 deprecated LazySusan

A USB/360deg Rotational device, communicating via blue-tooth, test code

Dependencies:   FatFileSystem mbed

MassStorage.cpp@0:87da38093be9, 2012-12-21 (annotated)

Committer:
lolpcc
Date:
Fri Dec 21 11:37:38 2012 +0000
Revision:
0:87da38093be9
Used to test the Lazy Susan at work, hence the A2D code in Utils.cpp

Who changed what in which revision?

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