Chris Styles / Mbed 2 deprecated m3pi_WiiRacing

Simons Wii controlled m3pi program

Dependencies:   mbed m3pi ID12RFIDIRQ

blueusb/MassStorage.cpp@0:0ab65a1aef12, 2011-05-18 (annotated)

Committer:
chris
Date:
Wed May 18 14:50:46 2011 +0000
Revision:
0:0ab65a1aef12
Added some printing to the m3pi screen

Who changed what in which revision?

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