with Downstream project. Also fixed a couple of things in upstream_spi.c and upstream_interface_msc.c but due to file rename the diff is not obvious...pull/7/head
Robert Fisk
10 years ago
parent
7b4e4b3c14
commit
4350666330
@ -1,39 +0,0 @@
|
||||
/*
|
||||
* downstream_interface_msc.h
|
||||
*
|
||||
* Created on: 4/07/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
#ifndef INC_DOWNSTREAM_INTERFACE_MSC_H_
|
||||
#define INC_DOWNSTREAM_INTERFACE_MSC_H_
|
||||
|
||||
|
||||
#include "downstream_spi.h"
|
||||
|
||||
|
||||
typedef void (*DownstreamInterfaceMSCCallbackTypeDef)(HAL_StatusTypeDef result);
|
||||
typedef void (*DownstreamInterfaceMSCCallbackPacketTypeDef)(HAL_StatusTypeDef result,
|
||||
DownstreamPacketTypeDef* downstreamPacket,
|
||||
uint16_t dataLength);
|
||||
typedef void (*DownstreamInterfaceMSCCallbackUintPacketTypeDef)(HAL_StatusTypeDef result,
|
||||
uint32_t result_uint[],
|
||||
DownstreamPacketTypeDef* downstreamPacket);
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_TestReady(DownstreamInterfaceMSCCallbackTypeDef callback);
|
||||
HAL_StatusTypeDef DownstreamInterface_GetCapacity(DownstreamInterfaceMSCCallbackUintPacketTypeDef callback);
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginRead(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount);
|
||||
HAL_StatusTypeDef DownstreamInterface_GetStreamDataPacket(DownstreamInterfaceMSCCallbackPacketTypeDef callback);
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginWrite(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount);
|
||||
HAL_StatusTypeDef DownstreamInterface_PutStreamDataPacket(DownstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength);
|
||||
|
||||
|
||||
|
||||
#endif /* INC_DOWNSTREAM_INTERFACE_MSC_H_ */
|
||||
@ -1,89 +0,0 @@
|
||||
/*
|
||||
* downstream_spi.h
|
||||
*
|
||||
* Created on: 21/06/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
#ifndef INC_DOWNSTREAM_SPI_H_
|
||||
#define INC_DOWNSTREAM_SPI_H_
|
||||
|
||||
|
||||
#include "usbd_config.h"
|
||||
|
||||
|
||||
#define DOWNSTREAM_PACKET_HEADER_LEN (2) //Min length = CommandClass & Command bytes
|
||||
#define DOWNSTREAM_PACKET_LEN (DOWNSTREAM_PACKET_HEADER_LEN + MSC_MEDIA_PACKET)
|
||||
#define DOWNSTREAM_PACKET_LEN_MIN (DOWNSTREAM_PACKET_HEADER_LEN)
|
||||
|
||||
|
||||
#define SPI_INTERFACE_FREAKOUT_VOID \
|
||||
do { \
|
||||
while (1); \
|
||||
/*DownstreamInterfaceState = INTERFACE_STATE_ERROR;*/ \
|
||||
/*return;*/ \
|
||||
} while (0);
|
||||
|
||||
#define SPI_INTERFACE_FREAKOUT_HAL_ERROR \
|
||||
do { \
|
||||
while (1); \
|
||||
/*DownstreamInterfaceState = INTERFACE_STATE_ERROR;*/ \
|
||||
/*return HAL_ERROR;*/ \
|
||||
} while (0);
|
||||
|
||||
|
||||
|
||||
typedef enum
|
||||
{
|
||||
INTERFACE_STATE_RESET = 0,
|
||||
INTERFACE_STATE_WAITING_CLIENT = 1,
|
||||
INTERFACE_STATE_IDLE = 2,
|
||||
INTERFACE_STATE_TX_SIZE_WAIT = 3,
|
||||
INTERFACE_STATE_TX_SIZE = 4,
|
||||
INTERFACE_STATE_TX_PACKET_WAIT = 5,
|
||||
INTERFACE_STATE_TX_PACKET = 6,
|
||||
INTERFACE_STATE_RX_SIZE_WAIT = 7,
|
||||
INTERFACE_STATE_RX_SIZE = 8,
|
||||
INTERFACE_STATE_RX_PACKET_WAIT = 9,
|
||||
INTERFACE_STATE_RX_PACKET = 10,
|
||||
INTERFACE_STATE_ERROR = 11
|
||||
} InterfaceStateTypeDef;
|
||||
|
||||
|
||||
typedef enum
|
||||
{
|
||||
NOT_BUSY = 0,
|
||||
BUSY = 1
|
||||
} PacketBusyTypeDef;
|
||||
|
||||
|
||||
typedef struct
|
||||
{
|
||||
PacketBusyTypeDef Busy; //Everything after Busy should be word-aligned
|
||||
uint16_t Length __ALIGN_END; //Packet length includes CommandClass, Command, and Data
|
||||
uint8_t CommandClass;
|
||||
uint8_t Command;
|
||||
uint8_t Data[MSC_MEDIA_PACKET]; //Should (must?) be word-aligned, for USB copy routine
|
||||
uint8_t RxCrc;
|
||||
}
|
||||
DownstreamPacketTypeDef;
|
||||
|
||||
|
||||
|
||||
typedef void (*FreePacketCallbackTypeDef)(DownstreamPacketTypeDef* freePacket);
|
||||
typedef void (*SpiPacketReceivedCallbackTypeDef)(DownstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
void Downstream_InitInterface(void);
|
||||
HAL_StatusTypeDef Downstream_GetFreePacket(FreePacketCallbackTypeDef callback);
|
||||
DownstreamPacketTypeDef* Downstream_GetFreePacketImmediately(void);
|
||||
void Downstream_ReleasePacket(DownstreamPacketTypeDef* packetToRelease);
|
||||
HAL_StatusTypeDef Downstream_SendPacket(DownstreamPacketTypeDef* packetToWrite);
|
||||
HAL_StatusTypeDef Downstream_GetPacket(SpiPacketReceivedCallbackTypeDef callback);
|
||||
void Downstream_TxOkInterrupt(void);
|
||||
void HAL_SPI_TxCpltCallback(SPI_HandleTypeDef *hspi);
|
||||
void HAL_SPI_RxCpltCallback(SPI_HandleTypeDef *hspi);
|
||||
void HAL_SPI_ErrorCallback(SPI_HandleTypeDef *hspi);
|
||||
|
||||
|
||||
#endif /* INC_DOWNSTREAM_SPI_H_ */
|
||||
@ -0,0 +1,39 @@
|
||||
/*
|
||||
* upstream_interface_msc.h
|
||||
*
|
||||
* Created on: 4/07/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
#ifndef INC_UPSTREAM_INTERFACE_MSC_H_
|
||||
#define INC_UPSTREAM_INTERFACE_MSC_H_
|
||||
|
||||
|
||||
#include <upstream_spi.h>
|
||||
|
||||
|
||||
typedef void (*UpstreamInterfaceMSCCallbackTypeDef)(HAL_StatusTypeDef result);
|
||||
typedef void (*UpstreamInterfaceMSCCallbackPacketTypeDef)(HAL_StatusTypeDef result,
|
||||
UpstreamPacketTypeDef* upstreamPacket,
|
||||
uint16_t dataLength);
|
||||
typedef void (*UpstreamInterfaceMSCCallbackUintPacketTypeDef)(HAL_StatusTypeDef result,
|
||||
uint32_t result_uint[],
|
||||
UpstreamPacketTypeDef* upstreamPacket);
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_TestReady(UpstreamInterfaceMSCCallbackTypeDef callback);
|
||||
HAL_StatusTypeDef UpstreamInterface_GetCapacity(UpstreamInterfaceMSCCallbackUintPacketTypeDef callback);
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginRead(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount);
|
||||
HAL_StatusTypeDef UpstreamInterface_GetStreamDataPacket(UpstreamInterfaceMSCCallbackPacketTypeDef callback);
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginWrite(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount);
|
||||
HAL_StatusTypeDef UpstreamInterface_PutStreamDataPacket(UpstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength);
|
||||
|
||||
|
||||
|
||||
#endif /* INC_UPSTREAM_INTERFACE_MSC_H_ */
|
||||
@ -0,0 +1,89 @@
|
||||
/*
|
||||
* upstream_spi.h
|
||||
*
|
||||
* Created on: 21/06/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
#ifndef INC_UPSTREAM_SPI_H_
|
||||
#define INC_UPSTREAM_SPI_H_
|
||||
|
||||
|
||||
#include "usbd_config.h"
|
||||
|
||||
|
||||
#define UPSTREAM_PACKET_HEADER_LEN (2) //Min length = CommandClass & Command bytes
|
||||
#define UPSTREAM_PACKET_LEN (UPSTREAM_PACKET_HEADER_LEN + MSC_MEDIA_PACKET)
|
||||
#define UPSTREAM_PACKET_LEN_MIN (UPSTREAM_PACKET_HEADER_LEN)
|
||||
|
||||
|
||||
#define SPI_INTERFACE_FREAKOUT_VOID \
|
||||
do { \
|
||||
while (1); \
|
||||
/*UpstreamInterfaceState = INTERFACE_STATE_ERROR;*/ \
|
||||
/*return;*/ \
|
||||
} while (0);
|
||||
|
||||
#define SPI_INTERFACE_FREAKOUT_HAL_ERROR \
|
||||
do { \
|
||||
while (1); \
|
||||
/*UpstreamInterfaceState = INTERFACE_STATE_ERROR;*/ \
|
||||
/*return HAL_ERROR;*/ \
|
||||
} while (0);
|
||||
|
||||
|
||||
|
||||
typedef enum
|
||||
{
|
||||
UPSTREAM_INTERFACE_RESET,
|
||||
UPSTREAM_INTERFACE_WAITING_CLIENT,
|
||||
UPSTREAM_INTERFACE_IDLE,
|
||||
UPSTREAM_INTERFACE_TX_SIZE_WAIT,
|
||||
UPSTREAM_INTERFACE_TX_SIZE,
|
||||
UPSTREAM_INTERFACE_TX_PACKET_WAIT,
|
||||
UPSTREAM_INTERFACE_TX_PACKET,
|
||||
UPSTREAM_INTERFACE_RX_SIZE_WAIT,
|
||||
UPSTREAM_INTERFACE_RX_SIZE,
|
||||
UPSTREAM_INTERFACE_RX_PACKET_WAIT,
|
||||
UPSTREAM_INTERFACE_RX_PACKET,
|
||||
UPSTREAM_INTERFACE_ERROR
|
||||
} InterfaceStateTypeDef;
|
||||
|
||||
|
||||
typedef enum
|
||||
{
|
||||
NOT_BUSY,
|
||||
BUSY
|
||||
} PacketBusyTypeDef;
|
||||
|
||||
|
||||
typedef struct
|
||||
{
|
||||
PacketBusyTypeDef Busy; //Everything after Busy should be word-aligned
|
||||
uint16_t Length __ALIGN_END; //Packet length includes CommandClass, Command, and Data
|
||||
uint8_t CommandClass;
|
||||
uint8_t Command;
|
||||
uint8_t Data[MSC_MEDIA_PACKET]; //Should (must?) be word-aligned, for USB copy routine
|
||||
uint8_t RxCrc;
|
||||
}
|
||||
UpstreamPacketTypeDef;
|
||||
|
||||
|
||||
|
||||
typedef void (*FreePacketCallbackTypeDef)(UpstreamPacketTypeDef* freePacket);
|
||||
typedef void (*SpiPacketReceivedCallbackTypeDef)(UpstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
void Upstream_InitSPI(void);
|
||||
HAL_StatusTypeDef Upstream_GetFreePacket(FreePacketCallbackTypeDef callback);
|
||||
UpstreamPacketTypeDef* Upstream_GetFreePacketImmediately(void);
|
||||
void Upstream_ReleasePacket(UpstreamPacketTypeDef* packetToRelease);
|
||||
HAL_StatusTypeDef Upstream_SendPacket(UpstreamPacketTypeDef* packetToWrite);
|
||||
HAL_StatusTypeDef Upstream_GetPacket(SpiPacketReceivedCallbackTypeDef callback);
|
||||
void Upstream_TxOkInterrupt(void);
|
||||
void HAL_SPI_TxCpltCallback(SPI_HandleTypeDef *hspi);
|
||||
void HAL_SPI_RxCpltCallback(SPI_HandleTypeDef *hspi);
|
||||
void HAL_SPI_ErrorCallback(SPI_HandleTypeDef *hspi);
|
||||
|
||||
|
||||
#endif /* INC_UPSTREAM_SPI_H_ */
|
||||
@ -1,105 +0,0 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file usbd_msc_storage.h
|
||||
* @author MCD Application Team
|
||||
* @version V2.3.0
|
||||
* @date 04-November-2014
|
||||
* @brief Header file for the usbd_msc_storage.c file
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* <h2><center>© COPYRIGHT 2014 STMicroelectronics</center></h2>
|
||||
*
|
||||
* Licensed under MCD-ST Liberty SW License Agreement V2, (the "License");
|
||||
* You may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at:
|
||||
*
|
||||
* http://www.st.com/software_license_agreement_liberty_v2
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/* Define to prevent recursive inclusion -------------------------------------*/
|
||||
#ifndef __USBD_MSC_STORAGE_H
|
||||
#define __USBD_MSC_STORAGE_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "usbd_msc.h"
|
||||
|
||||
/** @addtogroup STM32_USB_DEVICE_LIBRARY
|
||||
* @{
|
||||
*/
|
||||
|
||||
/** @defgroup USBD_STORAGE
|
||||
* @brief header file for the usbd_msc_storage.c file
|
||||
* @{
|
||||
*/
|
||||
|
||||
/** @defgroup USBD_STORAGE_Exported_Defines
|
||||
* @{
|
||||
*/
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
|
||||
/** @defgroup USBD_STORAGE_Exported_Types
|
||||
* @{
|
||||
*/
|
||||
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
|
||||
|
||||
/** @defgroup USBD_STORAGE_Exported_Macros
|
||||
* @{
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @defgroup USBD_STORAGE_Exported_Variables
|
||||
* @{
|
||||
*/
|
||||
extern USBD_StorageTypeDef USBD_MSC_Template_fops;
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/** @defgroup USBD_STORAGE_Exported_FunctionsPrototype
|
||||
* @{
|
||||
*/
|
||||
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* __USBD_MSC_STORAGE_H */
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
||||
@ -1,232 +0,0 @@
|
||||
/*
|
||||
* downstream_interface_msc.c
|
||||
*
|
||||
* Created on: 4/07/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
|
||||
#include "stm32f4xx_hal.h"
|
||||
#include "downstream_interface_msc.h"
|
||||
#include "downstream_interface_def.h"
|
||||
#include "downstream_spi.h"
|
||||
|
||||
|
||||
//Stuff we need to save for our callbacks to use:
|
||||
DownstreamInterfaceMSCCallbackTypeDef TestReadyCallback;
|
||||
DownstreamInterfaceMSCCallbackUintPacketTypeDef GetCapacityCallback;
|
||||
DownstreamInterfaceMSCCallbackPacketTypeDef GetStreamDataCallback;
|
||||
uint32_t ByteCount;
|
||||
DownstreamPacketTypeDef* ReadStreamPacket;
|
||||
uint8_t ReadStreamBusy;
|
||||
|
||||
|
||||
static void DownstreamInterface_TestReadyReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_GetCapacityReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_GetStreamDataPacketCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_BeginWriteReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_TestReady(DownstreamInterfaceMSCCallbackTypeDef callback)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_TEST_UNIT_READY;
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
return Downstream_GetPacket(DownstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_TestReadyReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
(replyPacket->Data[0] != HAL_OK))
|
||||
{
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_ERROR);
|
||||
return;
|
||||
}
|
||||
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_GetCapacity(DownstreamInterfaceMSCCallbackUintPacketTypeDef callback)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
GetCapacityCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_GET_CAPACITY;
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
return Downstream_GetPacket(DownstreamInterface_GetCapacityReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_GetCapacityReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint32_t uint[2];
|
||||
|
||||
if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 8) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG)))
|
||||
{
|
||||
GetCapacityCallback(HAL_ERROR, NULL, NULL);
|
||||
return;
|
||||
}
|
||||
|
||||
uint[0] = *(uint32_t*)&(replyPacket->Data[0]);
|
||||
uint[1] = *(uint32_t*)&(replyPacket->Data[4]);
|
||||
GetCapacityCallback(HAL_OK, uint, replyPacket); //usb_msc_scsi will use this packet, so don't release now
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginRead(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
ReadStreamPacket = NULL; //Prepare for GetStreamDataPacket's use
|
||||
ReadStreamBusy = 0;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
ByteCount = readByteCount;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_READ;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
return Downstream_GetPacket(DownstreamInterface_TestReadyReplyCallback); //Re-use TestReadyReplyCallback because it does exactly what we want!
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_GetStreamDataPacket(DownstreamInterfaceMSCCallbackPacketTypeDef callback)
|
||||
{
|
||||
GetStreamDataCallback = callback;
|
||||
|
||||
if (ReadStreamBusy != 0)
|
||||
{
|
||||
return HAL_OK;
|
||||
}
|
||||
ReadStreamBusy = 1;
|
||||
|
||||
if (ReadStreamPacket && GetStreamDataCallback) //Do we have a stored packet and an address to send it?
|
||||
{
|
||||
DownstreamInterface_GetStreamDataPacketCallback(ReadStreamPacket); //Send it now!
|
||||
ReadStreamPacket = NULL;
|
||||
return HAL_OK; //Our callback will call us again, so we don't need to get a packet in this case.
|
||||
}
|
||||
return Downstream_GetPacket(DownstreamInterface_GetStreamDataPacketCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_GetStreamDataPacketCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint16_t dataLength;
|
||||
|
||||
ReadStreamBusy = 0;
|
||||
if (GetStreamDataCallback == NULL)
|
||||
{
|
||||
ReadStreamPacket = replyPacket; //We used up our callback already, so save this one for later.
|
||||
return;
|
||||
}
|
||||
|
||||
if (((replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) == 0) || //Any 'command' reply (as opposed to 'data' reply) is an automatic fail here
|
||||
(replyPacket->Length <= DOWNSTREAM_PACKET_HEADER_LEN) || //Should be at least one data byte in the reply.
|
||||
(replyPacket->Length > ByteCount))
|
||||
{
|
||||
GetStreamDataCallback(HAL_ERROR, NULL);
|
||||
return;
|
||||
}
|
||||
|
||||
dataLength = replyPacket->Length - DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
ByteCount -= dataLength;
|
||||
GetStreamDataCallback(HAL_OK, replyPacket, dataLength); //usb_msc_scsi will use this packet, so don't release now
|
||||
if (ByteCount > 0)
|
||||
{
|
||||
DownstreamInterface_GetStreamDataPacket(NULL); //Try to get the next packet now, before USB asks for it
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginWrite(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
return Downstream_GetPacket(DownstreamInterface_BeginWriteReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_BeginWriteReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
((replyPacket->Data[0] != HAL_OK) && (replyPacket->Data[0] != HAL_BUSY)))
|
||||
{
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_ERROR);
|
||||
return;
|
||||
}
|
||||
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(replyPacket->Data[0]);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_PutStreamDataPacket(DownstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength)
|
||||
{
|
||||
packetToSend->Length = dataLength + DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
packetToSend->CommandClass = COMMAND_CLASS_MASS_STORAGE | COMMAND_CLASS_DATA_FLAG;
|
||||
packetToSend->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
return Downstream_SendPacket(packetToSend);
|
||||
}
|
||||
@ -1,245 +0,0 @@
|
||||
/*
|
||||
* downstream_interface_msc_mock.c
|
||||
*
|
||||
* Created on: 17/07/2015
|
||||
* Author: Robert Fisk
|
||||
*
|
||||
* This file replaces downstream_interface_msc.c to allow operational
|
||||
* testing of Upstream, without Downstream in place and communicating
|
||||
* over SPI. It still attempts to write downstream packets out the SPI port.
|
||||
*/
|
||||
|
||||
|
||||
#include "stm32f4xx_hal.h"
|
||||
#include "downstream_interface_msc.h"
|
||||
#include "downstream_interface_def.h"
|
||||
#include "downstream_spi.h"
|
||||
|
||||
|
||||
//Stuff we need to save for our callbacks to use:
|
||||
DownstreamInterfaceMSCCallbackTypeDef TestReadyCallback;
|
||||
DownstreamInterfaceMSCCallbackUintPacketTypeDef GetCapacityCallback;
|
||||
DownstreamInterfaceMSCCallbackPacketTypeDef GetStreamDataCallback;
|
||||
uint32_t ByteCount;
|
||||
DownstreamPacketTypeDef* ReadStreamPacket;
|
||||
uint8_t ReadStreamBusy;
|
||||
|
||||
|
||||
static void DownstreamInterface_TestReadyReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_GetCapacityReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_GetStreamDataPacketCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
static void DownstreamInterface_BeginWriteReplyCallback(DownstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_TestReady(DownstreamInterfaceMSCCallbackTypeDef callback)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_TEST_UNIT_READY;
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
//return Downstream_GetPacket(DownstreamInterface_TestReadyReplyCallback);
|
||||
return Downstream_GetFreePacket(DownstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_TestReadyReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
// if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
// (replyPacket->Data[0] != HAL_OK))
|
||||
// {
|
||||
// Downstream_ReleasePacket(replyPacket);
|
||||
// TestReadyCallback(HAL_ERROR);
|
||||
// return;
|
||||
// }
|
||||
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_GetCapacity(DownstreamInterfaceMSCCallbackUintPacketTypeDef callback)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
GetCapacityCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_GET_CAPACITY;
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
//return Downstream_GetPacket(DownstreamInterface_GetCapacityReplyCallback);
|
||||
return Downstream_GetFreePacket(DownstreamInterface_GetCapacityReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_GetCapacityReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint32_t uint[2];
|
||||
|
||||
// if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 8) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG)))
|
||||
// {
|
||||
// GetCapacityCallback(HAL_ERROR, NULL, NULL);
|
||||
// }
|
||||
|
||||
*(uint32_t*)&(replyPacket->Data[0]) = 262144; //* 512B = 128MB
|
||||
*(uint32_t*)&(replyPacket->Data[4]) = 512;
|
||||
|
||||
uint[0] = *(uint32_t*)&(replyPacket->Data[0]);
|
||||
uint[1] = *(uint32_t*)&(replyPacket->Data[4]);
|
||||
GetCapacityCallback(HAL_OK, uint, replyPacket); //usb_msc_scsi will use this packet, so don't release now
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginRead(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
ReadStreamPacket = NULL; //Prepare for GetStreamDataPacket's use
|
||||
ReadStreamBusy = 0;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
ByteCount = readByteCount;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_READ;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
//return Downstream_GetPacket(DownstreamInterface_TestReadyReplyCallback); //Re-use TestReadyReplyCallback because it does exactly what we want!
|
||||
return Downstream_GetFreePacket(DownstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_GetStreamDataPacket(DownstreamInterfaceMSCCallbackPacketTypeDef callback)
|
||||
{
|
||||
GetStreamDataCallback = callback;
|
||||
|
||||
if (ReadStreamBusy != 0)
|
||||
{
|
||||
return HAL_OK;
|
||||
}
|
||||
ReadStreamBusy = 1;
|
||||
|
||||
if (ReadStreamPacket && GetStreamDataCallback) //Do we have a stored packet and an address to send it?
|
||||
{
|
||||
DownstreamInterface_GetStreamDataPacketCallback(ReadStreamPacket); //Send it now!
|
||||
ReadStreamPacket = NULL;
|
||||
return HAL_OK; //Our callback will call us again, so we don't need to get a packet in this case.
|
||||
}
|
||||
//return Downstream_GetPacket(DownstreamInterface_GetStreamDataPacketCallback);
|
||||
return Downstream_GetFreePacket(DownstreamInterface_GetStreamDataPacketCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_GetStreamDataPacketCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint16_t dataLength;
|
||||
|
||||
ReadStreamBusy = 0;
|
||||
if (GetStreamDataCallback == NULL)
|
||||
{
|
||||
ReadStreamPacket = replyPacket; //We used up our callback already, so save this one for later.
|
||||
return;
|
||||
}
|
||||
|
||||
// if (((replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) == 0) || //Any 'command' reply (as opposed to 'data' reply) is an automatic fail here
|
||||
// (replyPacket->Length <= DOWNSTREAM_PACKET_HEADER_LEN) || //Should be at least one data byte in the reply.
|
||||
// (replyPacket->Length > ByteCount))
|
||||
// {
|
||||
// GetStreamDataCallback(HAL_ERROR, NULL);
|
||||
// return;
|
||||
// }
|
||||
|
||||
replyPacket->Length = MIN((ByteCount + DOWNSTREAM_PACKET_HEADER_LEN), (MSC_MEDIA_PACKET + DOWNSTREAM_PACKET_HEADER_LEN));
|
||||
|
||||
dataLength = replyPacket->Length - DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
ByteCount -= dataLength;
|
||||
GetStreamDataCallback(HAL_OK, replyPacket, dataLength); //usb_msc_scsi will use this packet, so don't release now
|
||||
if (ByteCount > 0)
|
||||
{
|
||||
DownstreamInterface_GetStreamDataPacket(NULL); //Try to get the next packet now, before USB asks for it
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_BeginWrite(DownstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount)
|
||||
{
|
||||
DownstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Downstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = DOWNSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Downstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
//return Downstream_GetPacket(DownstreamInterface_BeginWriteReplyCallback);
|
||||
return Downstream_GetFreePacket(DownstreamInterface_BeginWriteReplyCallback);
|
||||
}
|
||||
|
||||
void DownstreamInterface_BeginWriteReplyCallback(DownstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
// if ((replyPacket->Length != (DOWNSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
// ((replyPacket->Data[0] != HAL_OK) && (replyPacket->Data[0] != HAL_BUSY)))
|
||||
// {
|
||||
// Downstream_ReleasePacket(replyPacket);
|
||||
// TestReadyCallback(HAL_ERROR);
|
||||
// return;
|
||||
// }
|
||||
|
||||
Downstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(replyPacket->Data[0]);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef DownstreamInterface_PutStreamDataPacket(DownstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength)
|
||||
{
|
||||
packetToSend->Length = dataLength + DOWNSTREAM_PACKET_HEADER_LEN;
|
||||
packetToSend->CommandClass = COMMAND_CLASS_MASS_STORAGE | COMMAND_CLASS_DATA_FLAG;
|
||||
packetToSend->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
return Downstream_SendPacket(packetToSend);
|
||||
}
|
||||
@ -0,0 +1,232 @@
|
||||
/*
|
||||
* upstream_interface_msc.c
|
||||
*
|
||||
* Created on: 4/07/2015
|
||||
* Author: Robert Fisk
|
||||
*/
|
||||
|
||||
|
||||
#include <upstream_interface_def.h>
|
||||
#include <upstream_interface_msc.h>
|
||||
#include <upstream_spi.h>
|
||||
#include "stm32f4xx_hal.h"
|
||||
|
||||
|
||||
//Stuff we need to save for our callbacks to use:
|
||||
UpstreamInterfaceMSCCallbackTypeDef TestReadyCallback;
|
||||
UpstreamInterfaceMSCCallbackUintPacketTypeDef GetCapacityCallback;
|
||||
UpstreamInterfaceMSCCallbackPacketTypeDef GetStreamDataCallback;
|
||||
uint32_t ByteCount;
|
||||
UpstreamPacketTypeDef* ReadStreamPacket;
|
||||
uint8_t ReadStreamBusy;
|
||||
|
||||
|
||||
static void UpstreamInterface_TestReadyReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_GetCapacityReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_GetStreamDataPacketCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_BeginWriteReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_TestReady(UpstreamInterfaceMSCCallbackTypeDef callback)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_TEST_UNIT_READY;
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
return Upstream_GetPacket(UpstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_TestReadyReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
(replyPacket->Data[0] != HAL_OK))
|
||||
{
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_ERROR);
|
||||
return;
|
||||
}
|
||||
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_GetCapacity(UpstreamInterfaceMSCCallbackUintPacketTypeDef callback)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
GetCapacityCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_GET_CAPACITY;
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
return Upstream_GetPacket(UpstreamInterface_GetCapacityReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_GetCapacityReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint32_t uint[2];
|
||||
|
||||
if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 8) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG)))
|
||||
{
|
||||
GetCapacityCallback(HAL_ERROR, NULL, NULL);
|
||||
return;
|
||||
}
|
||||
|
||||
uint[0] = *(uint32_t*)&(replyPacket->Data[0]);
|
||||
uint[1] = *(uint32_t*)&(replyPacket->Data[4]);
|
||||
GetCapacityCallback(HAL_OK, uint, replyPacket); //usb_msc_scsi will use this packet, so don't release now
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginRead(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
ReadStreamPacket = NULL; //Prepare for GetStreamDataPacket's use
|
||||
ReadStreamBusy = 0;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
ByteCount = readByteCount;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_READ;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
return Upstream_GetPacket(UpstreamInterface_TestReadyReplyCallback); //Re-use TestReadyReplyCallback because it does exactly what we want!
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_GetStreamDataPacket(UpstreamInterfaceMSCCallbackPacketTypeDef callback)
|
||||
{
|
||||
GetStreamDataCallback = callback;
|
||||
|
||||
if (ReadStreamBusy != 0)
|
||||
{
|
||||
return HAL_OK;
|
||||
}
|
||||
ReadStreamBusy = 1;
|
||||
|
||||
if (ReadStreamPacket && GetStreamDataCallback) //Do we have a stored packet and an address to send it?
|
||||
{
|
||||
UpstreamInterface_GetStreamDataPacketCallback(ReadStreamPacket); //Send it now!
|
||||
ReadStreamPacket = NULL;
|
||||
return HAL_OK; //Our callback will call us again, so we don't need to get a packet in this case.
|
||||
}
|
||||
return Upstream_GetPacket(UpstreamInterface_GetStreamDataPacketCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_GetStreamDataPacketCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint16_t dataLength;
|
||||
|
||||
ReadStreamBusy = 0;
|
||||
if (GetStreamDataCallback == NULL)
|
||||
{
|
||||
ReadStreamPacket = replyPacket; //We used up our callback already, so save this one for later.
|
||||
return;
|
||||
}
|
||||
|
||||
if (((replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) == 0) || //Any 'command' reply (as opposed to 'data' reply) is an automatic fail here
|
||||
(replyPacket->Length <= UPSTREAM_PACKET_HEADER_LEN) || //Should be at least one data byte in the reply.
|
||||
(replyPacket->Length > ByteCount))
|
||||
{
|
||||
GetStreamDataCallback(HAL_ERROR, NULL, NULL);
|
||||
return;
|
||||
}
|
||||
|
||||
dataLength = replyPacket->Length - UPSTREAM_PACKET_HEADER_LEN;
|
||||
ByteCount -= dataLength;
|
||||
GetStreamDataCallback(HAL_OK, replyPacket, dataLength); //usb_msc_scsi will use this packet, so don't release now
|
||||
if (ByteCount > 0)
|
||||
{
|
||||
UpstreamInterface_GetStreamDataPacket(NULL); //Try to get the next packet now, before USB asks for it
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginWrite(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
return Upstream_GetPacket(UpstreamInterface_BeginWriteReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_BeginWriteReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
(replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
((replyPacket->Data[0] != HAL_OK) && (replyPacket->Data[0] != HAL_BUSY)))
|
||||
{
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_ERROR);
|
||||
return;
|
||||
}
|
||||
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(replyPacket->Data[0]);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_PutStreamDataPacket(UpstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength)
|
||||
{
|
||||
packetToSend->Length = dataLength + UPSTREAM_PACKET_HEADER_LEN;
|
||||
packetToSend->CommandClass = COMMAND_CLASS_MASS_STORAGE | COMMAND_CLASS_DATA_FLAG;
|
||||
packetToSend->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
return Upstream_SendPacket(packetToSend);
|
||||
}
|
||||
@ -0,0 +1,245 @@
|
||||
/*
|
||||
* upstream_interface_msc_mock.c
|
||||
*
|
||||
* Created on: 17/07/2015
|
||||
* Author: Robert Fisk
|
||||
*
|
||||
* This file replaces upstream_interface_msc.c to allow operational
|
||||
* testing of Upstream, without Upstream in place and communicating
|
||||
* over SPI. It still attempts to write downstream packets out the SPI port.
|
||||
*/
|
||||
|
||||
|
||||
#include <upstream_interface_def.h>
|
||||
#include <upstream_interface_msc.h>
|
||||
#include <upstream_spi.h>
|
||||
#include "stm32f4xx_hal.h"
|
||||
|
||||
|
||||
//Stuff we need to save for our callbacks to use:
|
||||
UpstreamInterfaceMSCCallbackTypeDef TestReadyCallback;
|
||||
UpstreamInterfaceMSCCallbackUintPacketTypeDef GetCapacityCallback;
|
||||
UpstreamInterfaceMSCCallbackPacketTypeDef GetStreamDataCallback;
|
||||
uint32_t ByteCount;
|
||||
UpstreamPacketTypeDef* ReadStreamPacket;
|
||||
uint8_t ReadStreamBusy;
|
||||
|
||||
|
||||
static void UpstreamInterface_TestReadyReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_GetCapacityReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_GetStreamDataPacketCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
static void UpstreamInterface_BeginWriteReplyCallback(UpstreamPacketTypeDef* replyPacket);
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_TestReady(UpstreamInterfaceMSCCallbackTypeDef callback)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_TEST_UNIT_READY;
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
//return Upstream_GetPacket(UpstreamInterface_TestReadyReplyCallback);
|
||||
return Upstream_GetFreePacket(UpstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_TestReadyReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
// if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
// (replyPacket->Data[0] != HAL_OK))
|
||||
// {
|
||||
// Upstream_ReleasePacket(replyPacket);
|
||||
// TestReadyCallback(HAL_ERROR);
|
||||
// return;
|
||||
// }
|
||||
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(HAL_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_GetCapacity(UpstreamInterfaceMSCCallbackUintPacketTypeDef callback)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
GetCapacityCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN;
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_GET_CAPACITY;
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
return tempResult;
|
||||
}
|
||||
//return Upstream_GetPacket(UpstreamInterface_GetCapacityReplyCallback);
|
||||
return Upstream_GetFreePacket(UpstreamInterface_GetCapacityReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_GetCapacityReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint32_t uint[2];
|
||||
|
||||
// if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 8) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG)))
|
||||
// {
|
||||
// GetCapacityCallback(HAL_ERROR, NULL, NULL);
|
||||
// }
|
||||
|
||||
*(uint32_t*)&(replyPacket->Data[0]) = 262144; //* 512B = 128MB
|
||||
*(uint32_t*)&(replyPacket->Data[4]) = 512;
|
||||
|
||||
uint[0] = *(uint32_t*)&(replyPacket->Data[0]);
|
||||
uint[1] = *(uint32_t*)&(replyPacket->Data[4]);
|
||||
GetCapacityCallback(HAL_OK, uint, replyPacket); //usb_msc_scsi will use this packet, so don't release now
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginRead(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount,
|
||||
uint32_t readByteCount)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
ReadStreamPacket = NULL; //Prepare for GetStreamDataPacket's use
|
||||
ReadStreamBusy = 0;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
ByteCount = readByteCount;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_READ;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
//return Upstream_GetPacket(UpstreamInterface_TestReadyReplyCallback); //Re-use TestReadyReplyCallback because it does exactly what we want!
|
||||
return Upstream_GetFreePacket(UpstreamInterface_TestReadyReplyCallback);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_GetStreamDataPacket(UpstreamInterfaceMSCCallbackPacketTypeDef callback)
|
||||
{
|
||||
GetStreamDataCallback = callback;
|
||||
|
||||
if (ReadStreamBusy != 0)
|
||||
{
|
||||
return HAL_OK;
|
||||
}
|
||||
ReadStreamBusy = 1;
|
||||
|
||||
if (ReadStreamPacket && GetStreamDataCallback) //Do we have a stored packet and an address to send it?
|
||||
{
|
||||
UpstreamInterface_GetStreamDataPacketCallback(ReadStreamPacket); //Send it now!
|
||||
ReadStreamPacket = NULL;
|
||||
return HAL_OK; //Our callback will call us again, so we don't need to get a packet in this case.
|
||||
}
|
||||
//return Upstream_GetPacket(UpstreamInterface_GetStreamDataPacketCallback);
|
||||
return Upstream_GetFreePacket(UpstreamInterface_GetStreamDataPacketCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_GetStreamDataPacketCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
uint16_t dataLength;
|
||||
|
||||
ReadStreamBusy = 0;
|
||||
if (GetStreamDataCallback == NULL)
|
||||
{
|
||||
ReadStreamPacket = replyPacket; //We used up our callback already, so save this one for later.
|
||||
return;
|
||||
}
|
||||
|
||||
// if (((replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) == 0) || //Any 'command' reply (as opposed to 'data' reply) is an automatic fail here
|
||||
// (replyPacket->Length <= UPSTREAM_PACKET_HEADER_LEN) || //Should be at least one data byte in the reply.
|
||||
// (replyPacket->Length > ByteCount))
|
||||
// {
|
||||
// GetStreamDataCallback(HAL_ERROR, NULL);
|
||||
// return;
|
||||
// }
|
||||
|
||||
replyPacket->Length = MIN((ByteCount + UPSTREAM_PACKET_HEADER_LEN), (MSC_MEDIA_PACKET + UPSTREAM_PACKET_HEADER_LEN));
|
||||
|
||||
dataLength = replyPacket->Length - UPSTREAM_PACKET_HEADER_LEN;
|
||||
ByteCount -= dataLength;
|
||||
GetStreamDataCallback(HAL_OK, replyPacket, dataLength); //usb_msc_scsi will use this packet, so don't release now
|
||||
if (ByteCount > 0)
|
||||
{
|
||||
UpstreamInterface_GetStreamDataPacket(NULL); //Try to get the next packet now, before USB asks for it
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_BeginWrite(UpstreamInterfaceMSCCallbackTypeDef callback,
|
||||
uint64_t readBlockStart,
|
||||
uint32_t readBlockCount)
|
||||
{
|
||||
UpstreamPacketTypeDef* freePacket;
|
||||
HAL_StatusTypeDef tempResult;
|
||||
|
||||
TestReadyCallback = callback;
|
||||
freePacket = Upstream_GetFreePacketImmediately();
|
||||
|
||||
freePacket->Length = UPSTREAM_PACKET_HEADER_LEN + (4 * 3);
|
||||
freePacket->CommandClass = COMMAND_CLASS_MASS_STORAGE;
|
||||
freePacket->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
*(uint64_t*)&(freePacket->Data[0]) = readBlockStart;
|
||||
*(uint32_t*)&(freePacket->Data[8]) = readBlockCount;
|
||||
|
||||
tempResult = Upstream_SendPacket(freePacket);
|
||||
if (tempResult != HAL_OK)
|
||||
{
|
||||
TestReadyCallback(tempResult);
|
||||
}
|
||||
//return Upstream_GetPacket(UpstreamInterface_BeginWriteReplyCallback);
|
||||
return Upstream_GetFreePacket(UpstreamInterface_BeginWriteReplyCallback);
|
||||
}
|
||||
|
||||
void UpstreamInterface_BeginWriteReplyCallback(UpstreamPacketTypeDef* replyPacket)
|
||||
{
|
||||
// if ((replyPacket->Length != (UPSTREAM_PACKET_HEADER_LEN + 1)) ||
|
||||
// (replyPacket->CommandClass & COMMAND_CLASS_DATA_FLAG) ||
|
||||
// ((replyPacket->Data[0] != HAL_OK) && (replyPacket->Data[0] != HAL_BUSY)))
|
||||
// {
|
||||
// Upstream_ReleasePacket(replyPacket);
|
||||
// TestReadyCallback(HAL_ERROR);
|
||||
// return;
|
||||
// }
|
||||
|
||||
Upstream_ReleasePacket(replyPacket);
|
||||
TestReadyCallback(replyPacket->Data[0]);
|
||||
}
|
||||
|
||||
|
||||
|
||||
HAL_StatusTypeDef UpstreamInterface_PutStreamDataPacket(UpstreamPacketTypeDef* packetToSend,
|
||||
uint32_t dataLength)
|
||||
{
|
||||
packetToSend->Length = dataLength + UPSTREAM_PACKET_HEADER_LEN;
|
||||
packetToSend->CommandClass = COMMAND_CLASS_MASS_STORAGE | COMMAND_CLASS_DATA_FLAG;
|
||||
packetToSend->Command = COMMAND_MSC_BEGIN_WRITE;
|
||||
return Upstream_SendPacket(packetToSend);
|
||||
}
|
||||
Loading…
Reference in new issue