2018-02-26 13:06:10 +00:00
|
|
|
/*
|
|
|
|
* This file is part of the TREZOR project, https://trezor.io/
|
|
|
|
*
|
|
|
|
* Copyright (c) SatoshiLabs
|
|
|
|
*
|
|
|
|
* This program is free software: you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
2017-04-24 13:04:19 +00:00
|
|
|
/*
|
|
|
|
* This file is part of the Micro Python project, http://micropython.org/
|
|
|
|
*
|
|
|
|
* The MIT License (MIT)
|
|
|
|
*
|
|
|
|
* Copyright (c) 2013, 2014 Damien P. George
|
|
|
|
*
|
|
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
|
|
* in the Software without restriction, including without limitation the rights
|
|
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
|
|
* furnished to do so, subject to the following conditions:
|
|
|
|
*
|
|
|
|
* The above copyright notice and this permission notice shall be included in
|
|
|
|
* all copies or substantial portions of the Software.
|
|
|
|
*
|
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
|
|
* THE SOFTWARE.
|
|
|
|
*/
|
|
|
|
|
2017-02-11 15:47:36 +00:00
|
|
|
#include STM32_HAL_H
|
|
|
|
|
|
|
|
#include <string.h>
|
|
|
|
|
|
|
|
#include "sdcard.h"
|
|
|
|
|
|
|
|
static SD_HandleTypeDef sd_handle;
|
|
|
|
|
2018-07-19 11:44:29 +00:00
|
|
|
static inline void sdcard_default_pin_state(void) {
|
2018-07-05 12:25:59 +00:00
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_0, GPIO_PIN_SET); // SD_ON/PC0
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_8, GPIO_PIN_RESET); // SD_DAT0/PC8
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_9, GPIO_PIN_RESET); // SD_DAT1/PC9
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_10, GPIO_PIN_RESET); // SD_DAT2/PC10
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_11, GPIO_PIN_RESET); // SD_DAT3/PC11
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_12, GPIO_PIN_RESET); // SD_CLK/PC12
|
|
|
|
HAL_GPIO_WritePin(GPIOD, GPIO_PIN_2, GPIO_PIN_RESET); // SD_CMD/PD2
|
2018-07-19 11:44:29 +00:00
|
|
|
|
|
|
|
GPIO_InitTypeDef GPIO_InitStructure;
|
|
|
|
|
2018-07-20 12:23:13 +00:00
|
|
|
// configure the SD card circuitry on/off pin
|
2018-07-19 11:44:29 +00:00
|
|
|
GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
|
|
|
|
GPIO_InitStructure.Pull = GPIO_NOPULL;
|
|
|
|
GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_LOW;
|
2018-07-20 12:23:13 +00:00
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_0;
|
|
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStructure);
|
|
|
|
|
|
|
|
// configure SD GPIO
|
|
|
|
#if 1
|
|
|
|
GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
|
|
|
|
GPIO_InitStructure.Pull = GPIO_NOPULL;
|
|
|
|
GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_LOW;
|
|
|
|
#else
|
|
|
|
GPIO_InitStructure.Mode = GPIO_MODE_AF_PP;
|
|
|
|
GPIO_InitStructure.Pull = GPIO_PULLUP;
|
|
|
|
GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
|
|
GPIO_InitStructure.Alternate = GPIO_AF12_SDIO;
|
|
|
|
#endif
|
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 | GPIO_PIN_11 | GPIO_PIN_12;
|
2018-07-19 11:44:29 +00:00
|
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStructure);
|
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_2;
|
|
|
|
HAL_GPIO_Init(GPIOD, &GPIO_InitStructure);
|
2018-07-19 13:01:34 +00:00
|
|
|
|
|
|
|
// configure the SD card detect pin
|
|
|
|
GPIO_InitStructure.Mode = GPIO_MODE_INPUT;
|
|
|
|
GPIO_InitStructure.Pull = GPIO_PULLUP;
|
|
|
|
GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_LOW;
|
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_13;
|
|
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStructure);
|
2018-07-05 12:25:59 +00:00
|
|
|
}
|
|
|
|
|
2018-07-19 11:44:29 +00:00
|
|
|
static inline void sdcard_active_pin_state(void) {
|
|
|
|
HAL_GPIO_WritePin(GPIOC, GPIO_PIN_0, GPIO_PIN_RESET); // SD_ON/PC0
|
2018-07-19 10:43:38 +00:00
|
|
|
|
2017-02-11 15:47:36 +00:00
|
|
|
GPIO_InitTypeDef GPIO_InitStructure;
|
|
|
|
|
|
|
|
// configure SD GPIO
|
|
|
|
GPIO_InitStructure.Mode = GPIO_MODE_AF_PP;
|
|
|
|
GPIO_InitStructure.Pull = GPIO_PULLUP;
|
2017-04-05 13:10:33 +00:00
|
|
|
GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
2017-02-11 15:47:36 +00:00
|
|
|
GPIO_InitStructure.Alternate = GPIO_AF12_SDIO;
|
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 | GPIO_PIN_11 | GPIO_PIN_12;
|
|
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStructure);
|
|
|
|
GPIO_InitStructure.Pin = GPIO_PIN_2;
|
|
|
|
HAL_GPIO_Init(GPIOD, &GPIO_InitStructure);
|
|
|
|
}
|
|
|
|
|
2018-07-19 11:44:29 +00:00
|
|
|
void sdcard_init(void) {
|
|
|
|
sdcard_default_pin_state();
|
|
|
|
}
|
|
|
|
|
2017-02-11 15:47:36 +00:00
|
|
|
void HAL_SD_MspInit(SD_HandleTypeDef *hsd) {
|
|
|
|
// enable SDIO clock
|
2017-04-05 13:10:33 +00:00
|
|
|
__HAL_RCC_SDIO_CLK_ENABLE();
|
2017-02-11 15:47:36 +00:00
|
|
|
// GPIO have already been initialised by sdcard_init
|
|
|
|
}
|
|
|
|
|
|
|
|
void HAL_SD_MspDeInit(SD_HandleTypeDef *hsd) {
|
2017-04-05 13:10:33 +00:00
|
|
|
__HAL_RCC_SDIO_CLK_DISABLE();
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
2017-10-26 21:51:39 +00:00
|
|
|
secbool sdcard_power_on(void) {
|
2017-10-27 01:32:26 +00:00
|
|
|
if (sectrue != sdcard_is_present()) {
|
2018-07-18 22:01:54 +00:00
|
|
|
return secfalse;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
if (sd_handle.Instance) {
|
2017-10-26 21:51:39 +00:00
|
|
|
return sectrue;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
2018-07-18 22:01:54 +00:00
|
|
|
// turn on SD card circuitry
|
2018-07-19 11:44:29 +00:00
|
|
|
sdcard_active_pin_state();
|
2018-07-18 22:01:54 +00:00
|
|
|
HAL_Delay(50);
|
2017-02-11 15:47:36 +00:00
|
|
|
|
|
|
|
// SD device interface configuration
|
|
|
|
sd_handle.Instance = SDIO;
|
|
|
|
sd_handle.Init.ClockEdge = SDIO_CLOCK_EDGE_RISING;
|
|
|
|
sd_handle.Init.ClockBypass = SDIO_CLOCK_BYPASS_DISABLE;
|
|
|
|
sd_handle.Init.ClockPowerSave = SDIO_CLOCK_POWER_SAVE_ENABLE;
|
|
|
|
sd_handle.Init.BusWide = SDIO_BUS_WIDE_1B;
|
|
|
|
sd_handle.Init.HardwareFlowControl = SDIO_HARDWARE_FLOW_CONTROL_DISABLE;
|
|
|
|
sd_handle.Init.ClockDiv = SDIO_TRANSFER_CLK_DIV;
|
|
|
|
|
|
|
|
// init the SD interface, with retry if it's not ready yet
|
2017-09-06 17:15:59 +00:00
|
|
|
for (int retry = 10; HAL_SD_Init(&sd_handle) != HAL_OK; retry--) {
|
2017-02-11 15:47:36 +00:00
|
|
|
if (retry == 0) {
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
HAL_Delay(50);
|
|
|
|
}
|
|
|
|
|
|
|
|
// configure the SD bus width for wide operation
|
2017-09-06 17:15:59 +00:00
|
|
|
if (HAL_SD_ConfigWideBusOperation(&sd_handle, SDIO_BUS_WIDE_4B) != HAL_OK) {
|
2017-02-11 15:47:36 +00:00
|
|
|
HAL_SD_DeInit(&sd_handle);
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
|
2017-10-26 21:51:39 +00:00
|
|
|
return sectrue;
|
2017-02-11 15:47:36 +00:00
|
|
|
|
|
|
|
error:
|
2018-07-15 02:36:23 +00:00
|
|
|
sdcard_power_off();
|
2017-10-26 21:51:39 +00:00
|
|
|
return secfalse;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
2017-12-16 16:54:04 +00:00
|
|
|
void sdcard_power_off(void) {
|
2018-07-19 16:38:38 +00:00
|
|
|
if (sd_handle.Instance) {
|
2018-07-15 02:36:23 +00:00
|
|
|
HAL_SD_DeInit(&sd_handle);
|
|
|
|
sd_handle.Instance = NULL;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
2018-07-05 12:25:59 +00:00
|
|
|
// turn off SD card circuitry
|
|
|
|
HAL_Delay(50);
|
|
|
|
sdcard_default_pin_state();
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
2018-07-18 22:01:54 +00:00
|
|
|
secbool sdcard_is_present(void) {
|
|
|
|
return sectrue * (GPIO_PIN_RESET == HAL_GPIO_ReadPin(GPIOC, GPIO_PIN_13));
|
|
|
|
}
|
|
|
|
|
2017-02-11 15:47:36 +00:00
|
|
|
uint64_t sdcard_get_capacity_in_bytes(void) {
|
|
|
|
if (sd_handle.Instance == NULL) {
|
|
|
|
return 0;
|
|
|
|
}
|
2017-09-06 17:15:59 +00:00
|
|
|
HAL_SD_CardInfoTypeDef cardinfo;
|
|
|
|
HAL_SD_GetCardInfo(&sd_handle, &cardinfo);
|
|
|
|
return (uint64_t)cardinfo.LogBlockNbr * (uint64_t)cardinfo.LogBlockSize;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
2017-09-06 17:15:59 +00:00
|
|
|
static HAL_StatusTypeDef sdcard_wait_finished(SD_HandleTypeDef *sd, uint32_t timeout) {
|
|
|
|
// Wait for HAL driver to be ready (eg for DMA to finish)
|
|
|
|
uint32_t start = HAL_GetTick();
|
|
|
|
while (sd->State == HAL_SD_STATE_BUSY) {
|
|
|
|
if (HAL_GetTick() - start >= timeout) {
|
|
|
|
return HAL_TIMEOUT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
// Wait for SD card to complete the operation
|
|
|
|
for (;;) {
|
|
|
|
HAL_SD_CardStateTypeDef state = HAL_SD_GetCardState(sd);
|
|
|
|
if (state == HAL_SD_CARD_TRANSFER) {
|
|
|
|
return HAL_OK;
|
|
|
|
}
|
|
|
|
if (!(state == HAL_SD_CARD_SENDING || state == HAL_SD_CARD_RECEIVING || state == HAL_SD_CARD_PROGRAMMING)) {
|
|
|
|
return HAL_ERROR;
|
|
|
|
}
|
|
|
|
if (HAL_GetTick() - start >= timeout) {
|
|
|
|
return HAL_TIMEOUT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return HAL_OK;
|
|
|
|
}
|
|
|
|
|
2017-10-29 15:34:09 +00:00
|
|
|
secbool sdcard_read_blocks(uint32_t *dest, uint32_t block_num, uint32_t num_blocks) {
|
2017-02-11 15:47:36 +00:00
|
|
|
// check that SD card is initialised
|
|
|
|
if (sd_handle.Instance == NULL) {
|
2017-10-26 21:51:39 +00:00
|
|
|
return secfalse;
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
// check that dest pointer is aligned on a 4-byte boundary
|
|
|
|
if (((uint32_t)dest & 3) != 0) {
|
2017-10-26 21:51:39 +00:00
|
|
|
return secfalse;
|
2017-09-06 17:15:59 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
HAL_StatusTypeDef err = HAL_OK;
|
|
|
|
|
2017-10-29 15:34:09 +00:00
|
|
|
err = HAL_SD_ReadBlocks(&sd_handle, (uint8_t *)dest, block_num, num_blocks, 60000);
|
2017-09-06 17:15:59 +00:00
|
|
|
if (err == HAL_OK) {
|
|
|
|
err = sdcard_wait_finished(&sd_handle, 60000);
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|
|
|
|
|
2017-10-26 21:51:39 +00:00
|
|
|
return sectrue * (err == HAL_OK);
|
2017-03-13 10:36:31 +00:00
|
|
|
}
|
|
|
|
|
2017-10-29 15:34:09 +00:00
|
|
|
secbool sdcard_write_blocks(const uint32_t *src, uint32_t block_num, uint32_t num_blocks) {
|
2017-03-13 10:36:31 +00:00
|
|
|
// check that SD card is initialised
|
|
|
|
if (sd_handle.Instance == NULL) {
|
2017-10-26 21:51:39 +00:00
|
|
|
return secfalse;
|
2017-03-13 10:36:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
// check that src pointer is aligned on a 4-byte boundary
|
|
|
|
if (((uint32_t)src & 3) != 0) {
|
2017-10-26 21:51:39 +00:00
|
|
|
return secfalse;
|
2017-09-06 17:15:59 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
HAL_StatusTypeDef err = HAL_OK;
|
|
|
|
|
2017-10-29 15:34:09 +00:00
|
|
|
err = HAL_SD_WriteBlocks(&sd_handle, (uint8_t *)src, block_num, num_blocks, 60000);
|
2017-09-06 17:15:59 +00:00
|
|
|
if (err == HAL_OK) {
|
|
|
|
err = sdcard_wait_finished(&sd_handle, 60000);
|
2017-03-13 10:36:31 +00:00
|
|
|
}
|
2017-02-11 15:47:36 +00:00
|
|
|
|
2017-10-26 21:51:39 +00:00
|
|
|
return sectrue * (err == HAL_OK);
|
2017-02-11 15:47:36 +00:00
|
|
|
}
|