diff options
Diffstat (limited to 'FamicomDumperBootloader/USB_DEVICE/App/usbd_storage_if.c')
| -rw-r--r-- | FamicomDumperBootloader/USB_DEVICE/App/usbd_storage_if.c | 317 |
1 files changed, 317 insertions, 0 deletions
diff --git a/FamicomDumperBootloader/USB_DEVICE/App/usbd_storage_if.c b/FamicomDumperBootloader/USB_DEVICE/App/usbd_storage_if.c new file mode 100644 index 0000000..caee9d9 --- /dev/null +++ b/FamicomDumperBootloader/USB_DEVICE/App/usbd_storage_if.c @@ -0,0 +1,317 @@ +/* USER CODE BEGIN Header */
+/**
+ ******************************************************************************
+ * @file : usbd_storage_if.c
+ * @version : v2.0_Cube
+ * @brief : Memory management layer.
+ ******************************************************************************
+ * @attention
+ *
+ * <h2><center>© Copyright (c) 2022 STMicroelectronics.
+ * All rights reserved.</center></h2>
+ *
+ * This software component is licensed by ST under Ultimate Liberty license
+ * SLA0044, the "License"; You may not use this file except in compliance with
+ * the License. You may obtain a copy of the License at:
+ * www.st.com/SLA0044
+ *
+ ******************************************************************************
+ */
+/* USER CODE END Header */
+
+/* Includes ------------------------------------------------------------------*/
+#include "usbd_storage_if.h"
+
+/* USER CODE BEGIN INCLUDE */
+#include "bootloader.h"
+/* USER CODE END INCLUDE */
+
+/* Private typedef -----------------------------------------------------------*/
+/* Private define ------------------------------------------------------------*/
+/* Private macro -------------------------------------------------------------*/
+
+/* USER CODE BEGIN PV */
+/* Private variables ---------------------------------------------------------*/
+extern uint32_t last_write_ts;
+/* USER CODE END PV */
+
+/** @addtogroup STM32_USB_OTG_DEVICE_LIBRARY
+ * @brief Usb device.
+ * @{
+ */
+
+/** @defgroup USBD_STORAGE
+ * @brief Usb mass storage device module
+ * @{
+ */
+
+/** @defgroup USBD_STORAGE_Private_TypesDefinitions
+ * @brief Private types.
+ * @{
+ */
+
+/* USER CODE BEGIN PRIVATE_TYPES */
+
+/* USER CODE END PRIVATE_TYPES */
+
+/**
+ * @}
+ */
+
+/** @defgroup USBD_STORAGE_Private_Defines
+ * @brief Private defines.
+ * @{
+ */
+
+#define STORAGE_LUN_NBR 1
+#define STORAGE_BLK_NBR 0x10000
+#define STORAGE_BLK_SIZ 0x200
+
+/* USER CODE BEGIN PRIVATE_DEFINES */
+
+/* USER CODE END PRIVATE_DEFINES */
+
+/**
+ * @}
+ */
+
+/** @defgroup USBD_STORAGE_Private_Macros
+ * @brief Private macros.
+ * @{
+ */
+
+/* USER CODE BEGIN PRIVATE_MACRO */
+
+/* USER CODE END PRIVATE_MACRO */
+
+/**
+ * @}
+ */
+
+/** @defgroup USBD_STORAGE_Private_Variables
+ * @brief Private variables.
+ * @{
+ */
+
+/* USER CODE BEGIN INQUIRY_DATA_FS */
+/** USB Mass storage Standard Inquiry Data. */
+const int8_t STORAGE_Inquirydata_FS[] = {/* 36 */
+
+ /* LUN 0 */
+ 0x00,
+ 0x80,
+ 0x02,
+ 0x02,
+ (STANDARD_INQUIRY_DATA_LEN - 5),
+ 0x00,
+ 0x00,
+ 0x00,
+ 'S', 'T', 'M', ' ', ' ', ' ', ' ', ' ', /* Manufacturer : 8 bytes */
+ 'P', 'r', 'o', 'd', 'u', 'c', 't', ' ', /* Product : 16 Bytes */
+ ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ',
+ '0', '.', '0' ,'1' /* Version : 4 Bytes */
+};
+/* USER CODE END INQUIRY_DATA_FS */
+
+/* USER CODE BEGIN PRIVATE_VARIABLES */
+
+/* USER CODE END PRIVATE_VARIABLES */
+
+/**
+ * @}
+ */
+
+/** @defgroup USBD_STORAGE_Exported_Variables
+ * @brief Public variables.
+ * @{
+ */
+
+extern USBD_HandleTypeDef hUsbDeviceFS;
+
+/* USER CODE BEGIN EXPORTED_VARIABLES */
+
+/* USER CODE END EXPORTED_VARIABLES */
+
+/**
+ * @}
+ */
+
+/** @defgroup USBD_STORAGE_Private_FunctionPrototypes
+ * @brief Private functions declaration.
+ * @{
+ */
+
+static int8_t STORAGE_Init_FS(uint8_t lun);
+static int8_t STORAGE_GetCapacity_FS(uint8_t lun, uint32_t *block_num, uint16_t *block_size);
+static int8_t STORAGE_IsReady_FS(uint8_t lun);
+static int8_t STORAGE_IsWriteProtected_FS(uint8_t lun);
+static int8_t STORAGE_Read_FS(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len);
+static int8_t STORAGE_Write_FS(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len);
+static int8_t STORAGE_GetMaxLun_FS(void);
+
+/* USER CODE BEGIN PRIVATE_FUNCTIONS_DECLARATION */
+
+/* USER CODE END PRIVATE_FUNCTIONS_DECLARATION */
+
+/**
+ * @}
+ */
+
+USBD_StorageTypeDef USBD_Storage_Interface_fops_FS =
+{
+ STORAGE_Init_FS,
+ STORAGE_GetCapacity_FS,
+ STORAGE_IsReady_FS,
+ STORAGE_IsWriteProtected_FS,
+ STORAGE_Read_FS,
+ STORAGE_Write_FS,
+ STORAGE_GetMaxLun_FS,
+ (int8_t *)STORAGE_Inquirydata_FS
+};
+
+/* Private functions ---------------------------------------------------------*/
+/**
+ * @brief Initializes over USB FS IP
+ * @param lun:
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_Init_FS(uint8_t lun)
+{
+ /* USER CODE BEGIN 2 */
+ return (USBD_OK);
+ /* USER CODE END 2 */
+}
+
+/**
+ * @brief .
+ * @param lun: .
+ * @param block_num: .
+ * @param block_size: .
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_GetCapacity_FS(uint8_t lun, uint32_t *block_num, uint16_t *block_size)
+{
+ /* USER CODE BEGIN 3 */
+ *block_num = MSD_BLOCK_COUNT;
+ *block_size = MSD_BLOCK_SIZE;
+ return (USBD_OK);
+ /* USER CODE END 3 */
+}
+
+/**
+ * @brief .
+ * @param lun: .
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_IsReady_FS(uint8_t lun)
+{
+ /* USER CODE BEGIN 4 */
+ return (USBD_OK);
+ /* USER CODE END 4 */
+}
+
+/**
+ * @brief .
+ * @param lun: .
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_IsWriteProtected_FS(uint8_t lun)
+{
+ /* USER CODE BEGIN 5 */
+ return (USBD_OK);
+ /* USER CODE END 5 */
+}
+
+/**
+ * @brief .
+ * @param lun: .
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_Read_FS(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len)
+{
+ /* USER CODE BEGIN 6 */
+ int i;
+ uint32_t address = MSD_ADDRESS + blk_addr * MSD_BLOCK_SIZE;
+
+ for (; blk_len > 0; blk_len--) {
+ for (i = 0; i < MSD_BLOCK_SIZE; i++) {
+ *buf = *((volatile uint8_t*) address);
+ buf++;
+ address++;
+ }
+ }
+ return (USBD_OK);
+ /* USER CODE END 6 */
+}
+
+/**
+ * @brief .
+ * @param lun: .
+ * @retval USBD_OK if all operations are OK else USBD_FAIL
+ */
+int8_t STORAGE_Write_FS(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len)
+{
+ /* USER CODE BEGIN 7 */
+ int res, i;
+ uint16_t value;
+ uint32_t address = MSD_ADDRESS + blk_addr * MSD_BLOCK_SIZE;
+
+ res = HAL_FLASH_Unlock();
+ if (res != HAL_OK) return USBD_FAIL;
+
+ FLASH_EraseInitTypeDef erase_init_struct;
+ uint32_t sector_error = 0;
+ erase_init_struct.TypeErase = FLASH_TYPEERASE_PAGES;
+ erase_init_struct.PageAddress = address;
+ erase_init_struct.NbPages = blk_len;
+ res = HAL_FLASHEx_Erase(&erase_init_struct, §or_error);
+ if (res != HAL_OK) {
+ HAL_FLASH_Lock();
+ return USBD_FAIL;
+ }
+
+ for (; blk_len > 0; blk_len--) {
+ for (i = 0; i < MSD_BLOCK_SIZE; i += 2) {
+ value = *(volatile uint16_t*) buf;
+ res = HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD, address, value);
+ if (res != HAL_OK) {
+ HAL_FLASH_Lock();
+ return USBD_FAIL;
+ }
+ buf += 2;
+ address += 2;
+ }
+ }
+
+ HAL_FLASH_Lock();
+
+ last_write_ts = HAL_GetTick();
+
+ return (USBD_OK);
+ /* USER CODE END 7 */
+}
+
+/**
+ * @brief .
+ * @param None
+ * @retval .
+ */
+int8_t STORAGE_GetMaxLun_FS(void)
+{
+ /* USER CODE BEGIN 8 */
+ return (STORAGE_LUN_NBR - 1);
+ /* USER CODE END 8 */
+}
+
+/* USER CODE BEGIN PRIVATE_FUNCTIONS_IMPLEMENTATION */
+
+/* USER CODE END PRIVATE_FUNCTIONS_IMPLEMENTATION */
+
+/**
+ * @}
+ */
+
+/**
+ * @}
+ */
+
|