mirror of
https://github.com/eried/portapack-mayhem.git
synced 2024-12-28 08:49:45 -05:00
887 lines
25 KiB
C
Executable File
887 lines
25 KiB
C
Executable File
/*
|
|
ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
|
|
2011,2012,2013 Giovanni Di Sirio.
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
ChibiOS/RT 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.
|
|
|
|
ChibiOS/RT 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/>.
|
|
|
|
---
|
|
|
|
A special exception to the GPL can be applied should you wish to distribute
|
|
a combined work that includes ChibiOS/RT, without being obliged to provide
|
|
the source code for any proprietary components. See the file exception.txt
|
|
for full details of how and when the exception can be applied.
|
|
*/
|
|
/*
|
|
Parts of this file have been contributed by Matthias Blaicher.
|
|
*/
|
|
|
|
/**
|
|
* @file mmc_spi.c
|
|
* @brief MMC over SPI driver code.
|
|
*
|
|
* @addtogroup MMC_SPI
|
|
* @{
|
|
*/
|
|
|
|
#include <string.h>
|
|
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
|
|
#if HAL_USE_MMC_SPI || defined(__DOXYGEN__)
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local definitions. */
|
|
/*===========================================================================*/
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported variables. */
|
|
/*===========================================================================*/
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local variables and types. */
|
|
/*===========================================================================*/
|
|
|
|
/* Forward declarations required by mmc_vmt.*/
|
|
static bool_t mmc_read(void *instance, uint32_t startblk,
|
|
uint8_t *buffer, uint32_t n);
|
|
static bool_t mmc_write(void *instance, uint32_t startblk,
|
|
const uint8_t *buffer, uint32_t n);
|
|
|
|
/**
|
|
* @brief Virtual methods table.
|
|
*/
|
|
static const struct MMCDriverVMT mmc_vmt = {
|
|
(bool_t (*)(void *))mmc_lld_is_card_inserted,
|
|
(bool_t (*)(void *))mmc_lld_is_write_protected,
|
|
(bool_t (*)(void *))mmcConnect,
|
|
(bool_t (*)(void *))mmcDisconnect,
|
|
mmc_read,
|
|
mmc_write,
|
|
(bool_t (*)(void *))mmcSync,
|
|
(bool_t (*)(void *, BlockDeviceInfo *))mmcGetInfo
|
|
};
|
|
|
|
/**
|
|
* @brief Lookup table for CRC-7 ( based on polynomial x^7 + x^3 + 1).
|
|
*/
|
|
static const uint8_t crc7_lookup_table[256] = {
|
|
0x00, 0x09, 0x12, 0x1b, 0x24, 0x2d, 0x36, 0x3f, 0x48, 0x41, 0x5a, 0x53,
|
|
0x6c, 0x65, 0x7e, 0x77, 0x19, 0x10, 0x0b, 0x02, 0x3d, 0x34, 0x2f, 0x26,
|
|
0x51, 0x58, 0x43, 0x4a, 0x75, 0x7c, 0x67, 0x6e, 0x32, 0x3b, 0x20, 0x29,
|
|
0x16, 0x1f, 0x04, 0x0d, 0x7a, 0x73, 0x68, 0x61, 0x5e, 0x57, 0x4c, 0x45,
|
|
0x2b, 0x22, 0x39, 0x30, 0x0f, 0x06, 0x1d, 0x14, 0x63, 0x6a, 0x71, 0x78,
|
|
0x47, 0x4e, 0x55, 0x5c, 0x64, 0x6d, 0x76, 0x7f, 0x40, 0x49, 0x52, 0x5b,
|
|
0x2c, 0x25, 0x3e, 0x37, 0x08, 0x01, 0x1a, 0x13, 0x7d, 0x74, 0x6f, 0x66,
|
|
0x59, 0x50, 0x4b, 0x42, 0x35, 0x3c, 0x27, 0x2e, 0x11, 0x18, 0x03, 0x0a,
|
|
0x56, 0x5f, 0x44, 0x4d, 0x72, 0x7b, 0x60, 0x69, 0x1e, 0x17, 0x0c, 0x05,
|
|
0x3a, 0x33, 0x28, 0x21, 0x4f, 0x46, 0x5d, 0x54, 0x6b, 0x62, 0x79, 0x70,
|
|
0x07, 0x0e, 0x15, 0x1c, 0x23, 0x2a, 0x31, 0x38, 0x41, 0x48, 0x53, 0x5a,
|
|
0x65, 0x6c, 0x77, 0x7e, 0x09, 0x00, 0x1b, 0x12, 0x2d, 0x24, 0x3f, 0x36,
|
|
0x58, 0x51, 0x4a, 0x43, 0x7c, 0x75, 0x6e, 0x67, 0x10, 0x19, 0x02, 0x0b,
|
|
0x34, 0x3d, 0x26, 0x2f, 0x73, 0x7a, 0x61, 0x68, 0x57, 0x5e, 0x45, 0x4c,
|
|
0x3b, 0x32, 0x29, 0x20, 0x1f, 0x16, 0x0d, 0x04, 0x6a, 0x63, 0x78, 0x71,
|
|
0x4e, 0x47, 0x5c, 0x55, 0x22, 0x2b, 0x30, 0x39, 0x06, 0x0f, 0x14, 0x1d,
|
|
0x25, 0x2c, 0x37, 0x3e, 0x01, 0x08, 0x13, 0x1a, 0x6d, 0x64, 0x7f, 0x76,
|
|
0x49, 0x40, 0x5b, 0x52, 0x3c, 0x35, 0x2e, 0x27, 0x18, 0x11, 0x0a, 0x03,
|
|
0x74, 0x7d, 0x66, 0x6f, 0x50, 0x59, 0x42, 0x4b, 0x17, 0x1e, 0x05, 0x0c,
|
|
0x33, 0x3a, 0x21, 0x28, 0x5f, 0x56, 0x4d, 0x44, 0x7b, 0x72, 0x69, 0x60,
|
|
0x0e, 0x07, 0x1c, 0x15, 0x2a, 0x23, 0x38, 0x31, 0x46, 0x4f, 0x54, 0x5d,
|
|
0x62, 0x6b, 0x70, 0x79
|
|
};
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local functions. */
|
|
/*===========================================================================*/
|
|
|
|
static bool_t mmc_read(void *instance, uint32_t startblk,
|
|
uint8_t *buffer, uint32_t n) {
|
|
|
|
if (mmcStartSequentialRead((MMCDriver *)instance, startblk))
|
|
return CH_FAILED;
|
|
while (n > 0) {
|
|
if (mmcSequentialRead((MMCDriver *)instance, buffer))
|
|
return CH_FAILED;
|
|
buffer += MMCSD_BLOCK_SIZE;
|
|
n--;
|
|
}
|
|
if (mmcStopSequentialRead((MMCDriver *)instance))
|
|
return CH_FAILED;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
static bool_t mmc_write(void *instance, uint32_t startblk,
|
|
const uint8_t *buffer, uint32_t n) {
|
|
|
|
if (mmcStartSequentialWrite((MMCDriver *)instance, startblk))
|
|
return CH_FAILED;
|
|
while (n > 0) {
|
|
if (mmcSequentialWrite((MMCDriver *)instance, buffer))
|
|
return CH_FAILED;
|
|
buffer += MMCSD_BLOCK_SIZE;
|
|
n--;
|
|
}
|
|
if (mmcStopSequentialWrite((MMCDriver *)instance))
|
|
return CH_FAILED;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Calculate the MMC standard CRC-7 based on a lookup table.
|
|
*
|
|
* @param[in] crc start value for CRC
|
|
* @param[in] buffer pointer to data buffer
|
|
* @param[in] len length of data
|
|
* @return Calculated CRC
|
|
*/
|
|
static uint8_t crc7(uint8_t crc, const uint8_t *buffer, size_t len) {
|
|
|
|
while (len--)
|
|
crc = crc7_lookup_table[(crc << 1) ^ (*buffer++)];
|
|
return crc;
|
|
}
|
|
|
|
/**
|
|
* @brief Waits an idle condition.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @notapi
|
|
*/
|
|
static void wait(MMCDriver *mmcp) {
|
|
int i;
|
|
uint8_t buf[4];
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
spiReceive(mmcp->config->spip, 1, buf);
|
|
if (buf[0] == 0xFF)
|
|
return;
|
|
}
|
|
/* Looks like it is a long wait.*/
|
|
while (TRUE) {
|
|
spiReceive(mmcp->config->spip, 1, buf);
|
|
if (buf[0] == 0xFF)
|
|
break;
|
|
#if MMC_NICE_WAITING
|
|
/* Trying to be nice with the other threads.*/
|
|
chThdSleep(1);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Sends a command header.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] cmd the command id
|
|
* @param[in] arg the command argument
|
|
*
|
|
* @notapi
|
|
*/
|
|
static void send_hdr(MMCDriver *mmcp, uint8_t cmd, uint32_t arg) {
|
|
uint8_t buf[6];
|
|
|
|
/* Wait for the bus to become idle if a write operation was in progress.*/
|
|
wait(mmcp);
|
|
|
|
buf[0] = 0x40 | cmd;
|
|
buf[1] = arg >> 24;
|
|
buf[2] = arg >> 16;
|
|
buf[3] = arg >> 8;
|
|
buf[4] = arg;
|
|
/* Calculate CRC for command header, shift to right position, add stop bit.*/
|
|
buf[5] = ((crc7(0, buf, 5) & 0x7F) << 1) | 0x01;
|
|
|
|
spiSend(mmcp->config->spip, 6, buf);
|
|
}
|
|
|
|
/**
|
|
* @brief Receives a single byte response.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @return The response as an @p uint8_t value.
|
|
* @retval 0xFF timed out.
|
|
*
|
|
* @notapi
|
|
*/
|
|
static uint8_t recvr1(MMCDriver *mmcp) {
|
|
int i;
|
|
uint8_t r1[1];
|
|
|
|
for (i = 0; i < 9; i++) {
|
|
spiReceive(mmcp->config->spip, 1, r1);
|
|
if (r1[0] != 0xFF)
|
|
return r1[0];
|
|
}
|
|
return 0xFF;
|
|
}
|
|
|
|
/**
|
|
* @brief Receives a three byte response.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[out] buffer pointer to four bytes wide buffer
|
|
* @return First response byte as an @p uint8_t value.
|
|
* @retval 0xFF timed out.
|
|
*
|
|
* @notapi
|
|
*/
|
|
static uint8_t recvr3(MMCDriver *mmcp, uint8_t* buffer) {
|
|
uint8_t r1;
|
|
|
|
r1 = recvr1(mmcp);
|
|
spiReceive(mmcp->config->spip, 4, buffer);
|
|
|
|
return r1;
|
|
}
|
|
|
|
/**
|
|
* @brief Sends a command an returns a single byte response.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] cmd the command id
|
|
* @param[in] arg the command argument
|
|
* @return The response as an @p uint8_t value.
|
|
* @retval 0xFF timed out.
|
|
*
|
|
* @notapi
|
|
*/
|
|
static uint8_t send_command_R1(MMCDriver *mmcp, uint8_t cmd, uint32_t arg) {
|
|
uint8_t r1;
|
|
|
|
spiSelect(mmcp->config->spip);
|
|
send_hdr(mmcp, cmd, arg);
|
|
r1 = recvr1(mmcp);
|
|
spiUnselect(mmcp->config->spip);
|
|
return r1;
|
|
}
|
|
|
|
/**
|
|
* @brief Sends a command which returns a five bytes response (R3).
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] cmd the command id
|
|
* @param[in] arg the command argument
|
|
* @param[out] response pointer to four bytes wide uint8_t buffer
|
|
* @return The first byte of the response (R1) as an @p
|
|
* uint8_t value.
|
|
* @retval 0xFF timed out.
|
|
*
|
|
* @notapi
|
|
*/
|
|
static uint8_t send_command_R3(MMCDriver *mmcp, uint8_t cmd, uint32_t arg,
|
|
uint8_t *response) {
|
|
uint8_t r1;
|
|
|
|
spiSelect(mmcp->config->spip);
|
|
send_hdr(mmcp, cmd, arg);
|
|
r1 = recvr3(mmcp, response);
|
|
spiUnselect(mmcp->config->spip);
|
|
return r1;
|
|
}
|
|
|
|
/**
|
|
* @brief Reads the CSD.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[out] csd pointer to the CSD buffer
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @notapi
|
|
*/
|
|
static bool_t read_CxD(MMCDriver *mmcp, uint8_t cmd, uint32_t cxd[4]) {
|
|
unsigned i;
|
|
uint8_t *bp, buf[16];
|
|
|
|
spiSelect(mmcp->config->spip);
|
|
send_hdr(mmcp, cmd, 0);
|
|
if (recvr1(mmcp) != 0x00) {
|
|
spiUnselect(mmcp->config->spip);
|
|
return CH_FAILED;
|
|
}
|
|
|
|
/* Wait for data availability.*/
|
|
for (i = 0; i < MMC_WAIT_DATA; i++) {
|
|
spiReceive(mmcp->config->spip, 1, buf);
|
|
if (buf[0] == 0xFE) {
|
|
uint32_t *wp;
|
|
|
|
spiReceive(mmcp->config->spip, 16, buf);
|
|
bp = buf;
|
|
for (wp = &cxd[3]; wp >= cxd; wp--) {
|
|
*wp = ((uint32_t)bp[0] << 24) | ((uint32_t)bp[1] << 16) |
|
|
((uint32_t)bp[2] << 8) | (uint32_t)bp[3];
|
|
bp += 4;
|
|
}
|
|
|
|
/* CRC ignored then end of transaction. */
|
|
spiIgnore(mmcp->config->spip, 2);
|
|
spiUnselect(mmcp->config->spip);
|
|
|
|
return CH_SUCCESS;
|
|
}
|
|
}
|
|
return CH_FAILED;
|
|
}
|
|
|
|
/**
|
|
* @brief Waits that the card reaches an idle state.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @notapi
|
|
*/
|
|
static void sync(MMCDriver *mmcp) {
|
|
uint8_t buf[1];
|
|
|
|
spiSelect(mmcp->config->spip);
|
|
while (TRUE) {
|
|
spiReceive(mmcp->config->spip, 1, buf);
|
|
if (buf[0] == 0xFF)
|
|
break;
|
|
#if MMC_NICE_WAITING
|
|
chThdSleep(1); /* Trying to be nice with the other threads.*/
|
|
#endif
|
|
}
|
|
spiUnselect(mmcp->config->spip);
|
|
}
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported functions. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief MMC over SPI driver initialization.
|
|
* @note This function is implicitly invoked by @p halInit(), there is
|
|
* no need to explicitly initialize the driver.
|
|
*
|
|
* @init
|
|
*/
|
|
void mmcInit(void) {
|
|
|
|
}
|
|
|
|
/**
|
|
* @brief Initializes an instance.
|
|
*
|
|
* @param[out] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @init
|
|
*/
|
|
void mmcObjectInit(MMCDriver *mmcp) {
|
|
|
|
mmcp->vmt = &mmc_vmt;
|
|
mmcp->state = BLK_STOP;
|
|
mmcp->config = NULL;
|
|
mmcp->block_addresses = FALSE;
|
|
}
|
|
|
|
/**
|
|
* @brief Configures and activates the MMC peripheral.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] config pointer to the @p MMCConfig object.
|
|
*
|
|
* @api
|
|
*/
|
|
void mmcStart(MMCDriver *mmcp, const MMCConfig *config) {
|
|
|
|
chDbgCheck((mmcp != NULL) && (config != NULL), "mmcStart");
|
|
chDbgAssert((mmcp->state == BLK_STOP) || (mmcp->state == BLK_ACTIVE),
|
|
"mmcStart(), #1", "invalid state");
|
|
|
|
mmcp->config = config;
|
|
mmcp->state = BLK_ACTIVE;
|
|
}
|
|
|
|
/**
|
|
* @brief Disables the MMC peripheral.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @api
|
|
*/
|
|
void mmcStop(MMCDriver *mmcp) {
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcStop");
|
|
chDbgAssert((mmcp->state == BLK_STOP) || (mmcp->state == BLK_ACTIVE),
|
|
"mmcStop(), #1", "invalid state");
|
|
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_STOP;
|
|
}
|
|
|
|
/**
|
|
* @brief Performs the initialization procedure on the inserted card.
|
|
* @details This function should be invoked when a card is inserted and
|
|
* brings the driver in the @p MMC_READY state where it is possible
|
|
* to perform read and write operations.
|
|
* @note It is possible to invoke this function from the insertion event
|
|
* handler.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded and the driver is now
|
|
* in the @p MMC_READY state.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcConnect(MMCDriver *mmcp) {
|
|
unsigned i;
|
|
uint8_t r3[4];
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcConnect");
|
|
|
|
chDbgAssert((mmcp->state == BLK_ACTIVE) || (mmcp->state == BLK_READY),
|
|
"mmcConnect(), #1", "invalid state");
|
|
|
|
/* Connection procedure in progress.*/
|
|
mmcp->state = BLK_CONNECTING;
|
|
mmcp->block_addresses = FALSE;
|
|
|
|
/* Slow clock mode and 128 clock pulses.*/
|
|
spiStart(mmcp->config->spip, mmcp->config->lscfg);
|
|
spiIgnore(mmcp->config->spip, 16);
|
|
|
|
/* SPI mode selection.*/
|
|
i = 0;
|
|
while (TRUE) {
|
|
if (send_command_R1(mmcp, MMCSD_CMD_GO_IDLE_STATE, 0) == 0x01)
|
|
break;
|
|
if (++i >= MMC_CMD0_RETRY)
|
|
goto failed;
|
|
chThdSleepMilliseconds(10);
|
|
}
|
|
|
|
/* Try to detect if this is a high capacity card and switch to block
|
|
addresses if possible.
|
|
This method is based on "How to support SDC Ver2 and high capacity cards"
|
|
by ElmChan.*/
|
|
if (send_command_R3(mmcp, MMCSD_CMD_SEND_IF_COND,
|
|
MMCSD_CMD8_PATTERN, r3) != 0x05) {
|
|
|
|
/* Switch to SDHC mode.*/
|
|
i = 0;
|
|
while (TRUE) {
|
|
if ((send_command_R1(mmcp, MMCSD_CMD_APP_CMD, 0) == 0x01) &&
|
|
(send_command_R3(mmcp, MMCSD_CMD_APP_OP_COND,
|
|
0x400001aa, r3) == 0x00))
|
|
break;
|
|
|
|
if (++i >= MMC_ACMD41_RETRY)
|
|
goto failed;
|
|
chThdSleepMilliseconds(10);
|
|
}
|
|
|
|
/* Execute dedicated read on OCR register */
|
|
send_command_R3(mmcp, MMCSD_CMD_READ_OCR, 0, r3);
|
|
|
|
/* Check if CCS is set in response. Card operates in block mode if set.*/
|
|
if (r3[0] & 0x40)
|
|
mmcp->block_addresses = TRUE;
|
|
}
|
|
|
|
/* Initialization.*/
|
|
i = 0;
|
|
while (TRUE) {
|
|
uint8_t b = send_command_R1(mmcp, MMCSD_CMD_INIT, 0);
|
|
if (b == 0x00)
|
|
break;
|
|
if (b != 0x01)
|
|
goto failed;
|
|
if (++i >= MMC_CMD1_RETRY)
|
|
goto failed;
|
|
chThdSleepMilliseconds(10);
|
|
}
|
|
|
|
/* Initialization complete, full speed.*/
|
|
spiStart(mmcp->config->spip, mmcp->config->hscfg);
|
|
|
|
/* Setting block size.*/
|
|
if (send_command_R1(mmcp, MMCSD_CMD_SET_BLOCKLEN,
|
|
MMCSD_BLOCK_SIZE) != 0x00)
|
|
goto failed;
|
|
|
|
/* Determine capacity.*/
|
|
if (read_CxD(mmcp, MMCSD_CMD_SEND_CSD, mmcp->csd))
|
|
goto failed;
|
|
mmcp->capacity = mmcsdGetCapacity(mmcp->csd);
|
|
if (mmcp->capacity == 0)
|
|
goto failed;
|
|
|
|
if (read_CxD(mmcp, MMCSD_CMD_SEND_CID, mmcp->cid))
|
|
goto failed;
|
|
|
|
mmcp->state = BLK_READY;
|
|
return CH_SUCCESS;
|
|
|
|
/* Connection failed, state reset to BLK_ACTIVE.*/
|
|
failed:
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_ACTIVE;
|
|
return CH_FAILED;
|
|
}
|
|
|
|
/**
|
|
* @brief Brings the driver in a state safe for card removal.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @return The operation status.
|
|
*
|
|
* @retval CH_SUCCESS the operation succeeded and the driver is now
|
|
* in the @p MMC_INSERTED state.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcDisconnect(MMCDriver *mmcp) {
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcDisconnect");
|
|
|
|
chSysLock();
|
|
chDbgAssert((mmcp->state == BLK_ACTIVE) || (mmcp->state == BLK_READY),
|
|
"mmcDisconnect(), #1", "invalid state");
|
|
if (mmcp->state == BLK_ACTIVE) {
|
|
chSysUnlock();
|
|
return CH_SUCCESS;
|
|
}
|
|
mmcp->state = BLK_DISCONNECTING;
|
|
chSysUnlock();
|
|
|
|
/* Wait for the pending write operations to complete.*/
|
|
spiStart(mmcp->config->spip, mmcp->config->hscfg);
|
|
sync(mmcp);
|
|
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_ACTIVE;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Starts a sequential read.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] startblk first block to read
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcStartSequentialRead(MMCDriver *mmcp, uint32_t startblk) {
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcStartSequentialRead");
|
|
chDbgAssert(mmcp->state == BLK_READY,
|
|
"mmcStartSequentialRead(), #1", "invalid state");
|
|
|
|
/* Read operation in progress.*/
|
|
mmcp->state = BLK_READING;
|
|
|
|
/* (Re)starting the SPI in case it has been reprogrammed externally, it can
|
|
happen if the SPI bus is shared among multiple peripherals.*/
|
|
spiStart(mmcp->config->spip, mmcp->config->hscfg);
|
|
spiSelect(mmcp->config->spip);
|
|
|
|
if (mmcp->block_addresses)
|
|
send_hdr(mmcp, MMCSD_CMD_READ_MULTIPLE_BLOCK, startblk);
|
|
else
|
|
send_hdr(mmcp, MMCSD_CMD_READ_MULTIPLE_BLOCK, startblk * MMCSD_BLOCK_SIZE);
|
|
|
|
if (recvr1(mmcp) != 0x00) {
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_FAILED;
|
|
}
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Reads a block within a sequential read operation.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[out] buffer pointer to the read buffer
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcSequentialRead(MMCDriver *mmcp, uint8_t *buffer) {
|
|
int i;
|
|
|
|
chDbgCheck((mmcp != NULL) && (buffer != NULL), "mmcSequentialRead");
|
|
|
|
if (mmcp->state != BLK_READING)
|
|
return CH_FAILED;
|
|
|
|
for (i = 0; i < MMC_WAIT_DATA; i++) {
|
|
spiReceive(mmcp->config->spip, 1, buffer);
|
|
if (buffer[0] == 0xFE) {
|
|
spiReceive(mmcp->config->spip, MMCSD_BLOCK_SIZE, buffer);
|
|
/* CRC ignored. */
|
|
spiIgnore(mmcp->config->spip, 2);
|
|
return CH_SUCCESS;
|
|
}
|
|
}
|
|
/* Timeout.*/
|
|
spiUnselect(mmcp->config->spip);
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_FAILED;
|
|
}
|
|
|
|
/**
|
|
* @brief Stops a sequential read gracefully.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcStopSequentialRead(MMCDriver *mmcp) {
|
|
static const uint8_t stopcmd[] = {0x40 | MMCSD_CMD_STOP_TRANSMISSION,
|
|
0, 0, 0, 0, 1, 0xFF};
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcStopSequentialRead");
|
|
|
|
if (mmcp->state != BLK_READING)
|
|
return CH_FAILED;
|
|
|
|
spiSend(mmcp->config->spip, sizeof(stopcmd), stopcmd);
|
|
/* result = recvr1(mmcp) != 0x00;*/
|
|
/* Note, ignored r1 response, it can be not zero, unknown issue.*/
|
|
(void) recvr1(mmcp);
|
|
|
|
/* Read operation finished.*/
|
|
spiUnselect(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Starts a sequential write.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] startblk first block to write
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcStartSequentialWrite(MMCDriver *mmcp, uint32_t startblk) {
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcStartSequentialWrite");
|
|
chDbgAssert(mmcp->state == BLK_READY,
|
|
"mmcStartSequentialWrite(), #1", "invalid state");
|
|
|
|
/* Write operation in progress.*/
|
|
mmcp->state = BLK_WRITING;
|
|
|
|
spiStart(mmcp->config->spip, mmcp->config->hscfg);
|
|
spiSelect(mmcp->config->spip);
|
|
if (mmcp->block_addresses)
|
|
send_hdr(mmcp, MMCSD_CMD_WRITE_MULTIPLE_BLOCK, startblk);
|
|
else
|
|
send_hdr(mmcp, MMCSD_CMD_WRITE_MULTIPLE_BLOCK,
|
|
startblk * MMCSD_BLOCK_SIZE);
|
|
|
|
if (recvr1(mmcp) != 0x00) {
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_FAILED;
|
|
}
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Writes a block within a sequential write operation.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[out] buffer pointer to the write buffer
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcSequentialWrite(MMCDriver *mmcp, const uint8_t *buffer) {
|
|
static const uint8_t start[] = {0xFF, 0xFC};
|
|
uint8_t b[1];
|
|
|
|
chDbgCheck((mmcp != NULL) && (buffer != NULL), "mmcSequentialWrite");
|
|
|
|
if (mmcp->state != BLK_WRITING)
|
|
return CH_FAILED;
|
|
|
|
spiSend(mmcp->config->spip, sizeof(start), start); /* Data prologue. */
|
|
spiSend(mmcp->config->spip, MMCSD_BLOCK_SIZE, buffer);/* Data. */
|
|
spiIgnore(mmcp->config->spip, 2); /* CRC ignored. */
|
|
spiReceive(mmcp->config->spip, 1, b);
|
|
if ((b[0] & 0x1F) == 0x05) {
|
|
wait(mmcp);
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/* Error.*/
|
|
spiUnselect(mmcp->config->spip);
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_FAILED;
|
|
}
|
|
|
|
/**
|
|
* @brief Stops a sequential write gracefully.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcStopSequentialWrite(MMCDriver *mmcp) {
|
|
static const uint8_t stop[] = {0xFD, 0xFF};
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcStopSequentialWrite");
|
|
|
|
if (mmcp->state != BLK_WRITING)
|
|
return CH_FAILED;
|
|
|
|
spiSend(mmcp->config->spip, sizeof(stop), stop);
|
|
spiUnselect(mmcp->config->spip);
|
|
|
|
/* Write operation finished.*/
|
|
mmcp->state = BLK_READY;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Waits for card idle condition.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcSync(MMCDriver *mmcp) {
|
|
|
|
chDbgCheck(mmcp != NULL, "mmcSync");
|
|
|
|
if (mmcp->state != BLK_READY)
|
|
return CH_FAILED;
|
|
|
|
/* Synchronization operation in progress.*/
|
|
mmcp->state = BLK_SYNCING;
|
|
|
|
spiStart(mmcp->config->spip, mmcp->config->hscfg);
|
|
sync(mmcp);
|
|
|
|
/* Synchronization operation finished.*/
|
|
mmcp->state = BLK_READY;
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Returns the media info.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[out] bdip pointer to a @p BlockDeviceInfo structure
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcGetInfo(MMCDriver *mmcp, BlockDeviceInfo *bdip) {
|
|
|
|
chDbgCheck((mmcp != NULL) && (bdip != NULL), "mmcGetInfo");
|
|
|
|
if (mmcp->state != BLK_READY)
|
|
return CH_FAILED;
|
|
|
|
bdip->blk_num = mmcp->capacity;
|
|
bdip->blk_size = MMCSD_BLOCK_SIZE;
|
|
|
|
return CH_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* @brief Erases blocks.
|
|
*
|
|
* @param[in] mmcp pointer to the @p MMCDriver object
|
|
* @param[in] startblk starting block number
|
|
* @param[in] endblk ending block number
|
|
*
|
|
* @return The operation status.
|
|
* @retval CH_SUCCESS the operation succeeded.
|
|
* @retval CH_FAILED the operation failed.
|
|
*
|
|
* @api
|
|
*/
|
|
bool_t mmcErase(MMCDriver *mmcp, uint32_t startblk, uint32_t endblk) {
|
|
|
|
chDbgCheck((mmcp != NULL), "mmcErase");
|
|
|
|
/* Erase operation in progress.*/
|
|
mmcp->state = BLK_WRITING;
|
|
|
|
/* Handling command differences between HC and normal cards.*/
|
|
if (!mmcp->block_addresses) {
|
|
startblk *= MMCSD_BLOCK_SIZE;
|
|
endblk *= MMCSD_BLOCK_SIZE;
|
|
}
|
|
|
|
if (send_command_R1(mmcp, MMCSD_CMD_ERASE_RW_BLK_START, startblk))
|
|
goto failed;
|
|
|
|
if (send_command_R1(mmcp, MMCSD_CMD_ERASE_RW_BLK_END, endblk))
|
|
goto failed;
|
|
|
|
if (send_command_R1(mmcp, MMCSD_CMD_ERASE, 0))
|
|
goto failed;
|
|
|
|
mmcp->state = BLK_READY;
|
|
return CH_SUCCESS;
|
|
|
|
/* Command failed, state reset to BLK_ACTIVE.*/
|
|
failed:
|
|
spiStop(mmcp->config->spip);
|
|
mmcp->state = BLK_READY;
|
|
return CH_FAILED;
|
|
}
|
|
|
|
#endif /* HAL_USE_MMC_SPI */
|
|
|
|
/** @} */
|