Roy Krikke / BD_SD_DISCO_F746NG

Dependencies:   BSP_DISCO_F746NG

Dependents:   DISCO-F746NG_BLOCK_DEVICE_SDCARD DISCO-F746NG_BLOCK_DEVICE_WITH_FAT_FILESYSTEM_ON_SDCARD SDReaderTest

BD_SD_DISCO_F746NG.cpp

Committer:
roykrikke
Date:
2018-03-24
Revision:
0:131c3e1d831e

File content as of revision 0:131c3e1d831e:

/* SD/MMC Block device Library for MBED-OS
 * Copyright 2017 Roy Krikke
 * 
 * Licensed under the Apache License, Version 2.0 (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.apache.org/licenses/LICENSE-2.0
 * 
 * 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.
 *
 */

#include "BD_SD_DISCO_F746NG.h"
#include "mbed_debug.h"

/* Required version: 5.5.0 and above */
#if defined(MBED_MAJOR_VERSION) && MBED_MAJOR_VERSION >= 5
#if (MBED_VERSION < MBED_ENCODE_VERSION(5,5,0))
#error "Incompatible mbed-os version detected! Required 5.5.0 and above"
#endif
#else
#warning "mbed-os version 5.5.0 or above required"
#endif

/* Required version: 5.5.0 and above */
#warning "Block device class BD_SD_DISCO_F746NG is depending on BSP_DISCO_F746NG libary (Revision 9:df2ea349c37a with date 06 Jul 2017)"

#define SD_DBG 0 /*!< 1 - Enable debugging */

/** Enum of standard error codes
 *
 *  @enum bd_sd_error
 */
enum bd_sd_error {
  BD_SD_ERROR_OK = 0, /*!< no error */
  BD_SD_ERROR_DEVICE_ERROR = -5000, /*!< device specific error */
  //BD_SD_BLOCK_DEVICE_ERROR_WOULD_BLOCK       = -5001,  /*!< operation would block */
  //BD_SD_BLOCK_DEVICE_ERROR_UNSUPPORTED       = -5002,  /*!< unsupported operation */
  BD_SD_BLOCK_DEVICE_ERROR_PARAMETER = -5003, /*!< invalid parameter */
  BD_SD_BLOCK_DEVICE_ERROR_NO_INIT = -5004, /*!< uninitialized */
  BD_SD_BLOCK_DEVICE_ERROR_NO_DEVICE = -5005, /*!< device is missing or not connected */
  //BD_SD_BLOCK_DEVICE_ERROR_WRITE_PROTECTED   = -5006,  /*!< write protected */
  //BD_SD_BLOCK_DEVICE_ERROR_UNUSABLE          = -5007,  /*!< unusable card */
  //BD_SD_BLOCK_DEVICE_ERROR_NO_RESPONSE       = -5008,  /*!< No response from device */
  //BD_SD_BLOCK_DEVICE_ERROR_CRC               = -5009,  /*!< CRC error */
  BD_SD_BLOCK_DEVICE_ERROR_ERASE = -5010, /*!< Erase error */
  BD_SD_BLOCK_DEVICE_ERROR_READ = -5011, /*!< Read error */
  BD_SD_BLOCK_DEVICE_ERROR_PROGRAM = -5012, /*!< Program error */
};

#define BLOCK_SIZE_HC 512 /*!< Block size supported for SD card is 512 bytes  */

BD_SD_DISCO_F746NG::BD_SD_DISCO_F746NG () :
    _read_size (BLOCK_SIZE_HC), _program_size (BLOCK_SIZE_HC), _erase_size (
    BLOCK_SIZE_HC), _block_size (BLOCK_SIZE_HC), _capacity_in_blocks (0) {
  _timeout = 1000;
}

BD_SD_DISCO_F746NG::~BD_SD_DISCO_F746NG () {
  if (_is_initialized) {
    deinit ();
  }
}

int
BD_SD_DISCO_F746NG::init () {
  lock ();
  _sd_state = BSP_SD_Init ();

  if (_sd_state != MSD_OK) {
    if (_sd_state == MSD_ERROR_SD_NOT_PRESENT) {
      debug_if (SD_DBG, "SD card is missing or not connected\n");
      unlock ();
      return BD_SD_BLOCK_DEVICE_ERROR_NO_DEVICE;
    }
    else {
      debug_if (SD_DBG, "SD card initialization failed\n");
      unlock ();
      return BD_SD_BLOCK_DEVICE_ERROR_NO_INIT;
    }
  }
  BSP_SD_GetCardInfo (&_current_card_info);

  _card_type = _current_card_info.CardType;
  _read_size = _current_card_info.BlockSize;
  _program_size = _current_card_info.BlockSize;
  _erase_size = _current_card_info.BlockSize;
  _block_size = _current_card_info.BlockSize;
  _capacity_in_blocks = _current_card_info.BlockNbr;

  debug_if (SD_DBG, "Card Type: %i\n", _current_card_info.CardType);
  debug_if (SD_DBG, "Card Version: %i\n", _current_card_info.CardVersion);
  debug_if (SD_DBG, "Class: %i\n", _current_card_info.Class);
  debug_if (SD_DBG, "Relative Card Address: %x\n",
            _current_card_info.RelCardAdd);
  debug_if (SD_DBG, "Card Capacity in blocks: %i\n",
            _current_card_info.BlockNbr);
  debug_if (SD_DBG, "One block size in bytes: %i\n",
            _current_card_info.BlockSize);
  debug_if (SD_DBG, "Card logical Capacity in blocks: %i\n",
            _current_card_info.LogBlockNbr);
  debug_if (SD_DBG, "Logical block size in bytes: %i\n",
            _current_card_info.LogBlockSize);
  debug_if (SD_DBG, "Timeout: %i\n", _timeout);

  _is_initialized = true;
  unlock ();
  return BD_SD_ERROR_OK;
}

int
BD_SD_DISCO_F746NG::deinit () {
  lock ();
  _sd_state = BSP_SD_DeInit ();
  if (_sd_state != MSD_OK) {
    debug_if (SD_DBG, "SD card deinitialization failed\n");
    return BD_SD_ERROR_DEVICE_ERROR;
  }
  _is_initialized = false;
  unlock ();
  return BD_ERROR_OK;
}

int
BD_SD_DISCO_F746NG::read (void *b, bd_addr_t addr, bd_size_t size) {
  if (!is_valid_read (addr, size)) {
    return BD_SD_BLOCK_DEVICE_ERROR_PARAMETER;
  }

  lock ();
  if (!_is_initialized) {
    unlock ();
    return BD_SD_BLOCK_DEVICE_ERROR_NO_INIT;
  }

  uint32_t *buffer = static_cast<uint32_t *> (b);
  int status = BD_SD_ERROR_OK;

  // Get block address
  uint32_t block_addr = addr / _block_size;
  // Get block count
  uint32_t block_cnt = size / _block_size;

  debug_if (
      SD_DBG,
      "BD_SD_DISCO_F746NG::read addr: 0x%x, block_addr: %i size: %lu block count: %i\n",
      addr, block_addr, size, block_cnt);

  if (BSP_SD_ReadBlocks (buffer, block_addr, block_cnt, _timeout) != MSD_OK) {
    status = BD_SD_BLOCK_DEVICE_ERROR_READ;
  }

  // Wait until SD card is ready to use for new operation
  while (BSP_SD_GetCardState () != SD_TRANSFER_OK) {
  }

  unlock ();
  return status;
}

int
BD_SD_DISCO_F746NG::program (const void *b, bd_addr_t addr, bd_size_t size) {
  if (!is_valid_program (addr, size)) {
    return BD_SD_BLOCK_DEVICE_ERROR_PARAMETER;
  }

  lock ();
  if (!_is_initialized) {
    unlock ();
    return BD_SD_BLOCK_DEVICE_ERROR_NO_INIT;
  }

  uint32_t* buffer =
      const_cast<uint32_t*> (reinterpret_cast<const uint32_t*> (b));
  int status = BD_SD_ERROR_OK;

  // Get block address
  uint32_t block_addr = addr / _block_size;
  // Get block count
  uint32_t block_cnt = size / _block_size;

  debug_if (
      SD_DBG,
      "BD_SD_DISCO_F746NG::program addr: 0x%x, block_addr: %i size: %lu block count: %i\n",
      addr, block_addr, size, block_cnt);

  if (BSP_SD_WriteBlocks (buffer, block_addr, block_cnt, _timeout) != MSD_OK) {
    status = BD_SD_BLOCK_DEVICE_ERROR_PROGRAM;
  }

  // Wait until SD card is ready to use for new operation
  while (BSP_SD_GetCardState () != SD_TRANSFER_OK) {
  }

  unlock ();
  return status;
}

int
BD_SD_DISCO_F746NG::erase (bd_addr_t addr, bd_size_t size) {
  if (!is_valid_erase (addr, size)) {
    return BD_SD_BLOCK_DEVICE_ERROR_PARAMETER;
  }

  lock ();
  if (!_is_initialized) {
    unlock ();
    return BD_SD_BLOCK_DEVICE_ERROR_NO_INIT;
  }

  int status = BD_SD_ERROR_OK;
  uint32_t start_addr = addr;
  uint32_t end_addr = start_addr + size;

  // Get block count
  uint32_t block_start_addr = start_addr / _block_size;
  // Get block address
  uint32_t block_end_addr = end_addr / _block_size;

  debug_if (
      SD_DBG,
      "BD_SD_DISCO_F746NG::erase start_addr: 0x%x, block_start_addr: %i | end_addr: 0x%x, block_end_addr: %i size: %lu\n",
      start_addr, block_start_addr, end_addr, block_end_addr, size);

  if (BSP_SD_Erase (block_start_addr, block_end_addr) != MSD_OK) {
    status = BD_SD_BLOCK_DEVICE_ERROR_ERASE;
  }

  /* Wait until SD card is ready to use for new operation */
  while (BSP_SD_GetCardState () != SD_TRANSFER_OK) {
  }

  unlock ();
  return status;
}

bd_size_t
BD_SD_DISCO_F746NG::get_read_size () const {
  return _read_size;
}

bd_size_t
BD_SD_DISCO_F746NG::get_program_size () const {
  return _program_size;
}

bd_size_t
BD_SD_DISCO_F746NG::get_erase_size () const {
  return _erase_size;
}

bd_size_t
BD_SD_DISCO_F746NG::size () const {
  return _block_size * _capacity_in_blocks;
}