|
@@ -1,951 +1,1691 @@
|
|
|
-/******************** (C) COPYRIGHT 2008 STMicroelectronics ********************
|
|
|
-* File Name : msd.c
|
|
|
-* Author : MCD Application Team
|
|
|
-* Version : V2.1
|
|
|
-* Date : 05/30/2008
|
|
|
-* Description : MSD card driver source file.
|
|
|
-* Pin assignment:
|
|
|
-* ----------------------------------------------
|
|
|
-* | STM32F10x | MSD Pin |
|
|
|
-* ----------------------------------------------
|
|
|
-* | P0.4 | ChipSelect 1 |
|
|
|
-* | P0.1 / MOSI | DataIn 2 |
|
|
|
-* | | GND 3 (0 V) |
|
|
|
-* | | VDD 4 (3.3 V) |
|
|
|
-* | P0.2 / SCLK | Clock 5 |
|
|
|
-* | | GND 6 (0 V) |
|
|
|
-* | P0.0 / MISO | DataOut 7 |
|
|
|
-* -----------------------------------------------
|
|
|
-********************************************************************************
|
|
|
-* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
|
|
|
-* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
|
|
|
-* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
|
|
|
-* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
|
|
|
-* CONTENT OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
|
|
|
-* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
|
|
|
-* FOR MORE INFORMATION PLEASE CAREFULLY READ THE LICENSE AGREEMENT FILE LOCATED
|
|
|
-* IN THE ROOT DIRECTORY OF THIS FIRMWARE PACKAGE.
|
|
|
-*******************************************************************************/
|
|
|
-
|
|
|
-/* Includes ------------------------------------------------------------------*/
|
|
|
+/*
|
|
|
+ * File : msd.c
|
|
|
+ * SPI mode SD Card Driver
|
|
|
+ * This file is part of RT-Thread RTOS
|
|
|
+ * COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
|
|
+ *
|
|
|
+ * The license and distribution terms for this file may be
|
|
|
+ * found in the file LICENSE in this distribution or at
|
|
|
+ * http://www.rt-thread.org/license/LICENSE
|
|
|
+ *
|
|
|
+ * Change Logs:
|
|
|
+ * Date Author Notes
|
|
|
+ * 2009-04-17 Bernard first version.
|
|
|
+ * 2010-07-15 aozima Modify read/write according new block driver interface.
|
|
|
+ * 2012-02-01 aozima use new RT-Thread SPI drivers.
|
|
|
+ * 2012-04-11 aozima get max. data transfer rate from CSD[TRAN_SPEED].
|
|
|
+ * 2012-05-21 aozima update MMC card support.
|
|
|
+ */
|
|
|
+
|
|
|
+#include <string.h>
|
|
|
#include "msd.h"
|
|
|
-#include <stm32f10x_spi.h>
|
|
|
-#include <rtthread.h>
|
|
|
-
|
|
|
-/* Private typedef -----------------------------------------------------------*/
|
|
|
-/* Private define ------------------------------------------------------------*/
|
|
|
-/* Private macro -------------------------------------------------------------*/
|
|
|
-/* Select MSD Card: ChipSelect pin low */
|
|
|
-#define MSD_CS_LOW() GPIO_ResetBits(GPIOA, GPIO_Pin_4)
|
|
|
-/* Deselect MSD Card: ChipSelect pin high */
|
|
|
-#define MSD_CS_HIGH() GPIO_SetBits(GPIOA, GPIO_Pin_4)
|
|
|
-#define MSD_SPI SPI1
|
|
|
-#define MSD_RCC_SPI RCC_APB2Periph_SPI1
|
|
|
-
|
|
|
-/* Private function prototypes -----------------------------------------------*/
|
|
|
-static void SPI_Config(void);
|
|
|
-/* Private functions ---------------------------------------------------------*/
|
|
|
-
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_Init
|
|
|
-* Description : Initializes the MSD/SD communication.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_Init(void)
|
|
|
+
|
|
|
+//#define MSD_TRACE
|
|
|
+
|
|
|
+#ifdef MSD_TRACE
|
|
|
+#define MSD_DEBUG(...) rt_kprintf("[MSD] %d ", rt_tick_get()); rt_kprintf(__VA_ARGS__);
|
|
|
+#else
|
|
|
+#define MSD_DEBUG(...)
|
|
|
+#endif /* #ifdef MSD_TRACE */
|
|
|
+
|
|
|
+#define DUMMY 0xFF
|
|
|
+
|
|
|
+#define CARD_NCR_MAX 8
|
|
|
+
|
|
|
+#define CARD_NRC 1
|
|
|
+#define CARD_NCR 1
|
|
|
+
|
|
|
+static struct msd_device _msd_device;
|
|
|
+
|
|
|
+/* function define */
|
|
|
+static rt_bool_t rt_tick_timeout(rt_tick_t tick_start, rt_tick_t tick_long);
|
|
|
+
|
|
|
+static rt_err_t MSD_take_owner(struct rt_spi_device* spi_device);
|
|
|
+static void MSD_take_cs(struct rt_spi_device* device);
|
|
|
+static void MSD_release_cs(struct rt_spi_device* device);
|
|
|
+
|
|
|
+static rt_err_t _wait_token(struct rt_spi_device* device, uint8_t token);
|
|
|
+static rt_err_t _wait_ready(struct rt_spi_device* device);
|
|
|
+static rt_size_t rt_msd_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size);
|
|
|
+static rt_size_t rt_msd_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size);
|
|
|
+static rt_size_t rt_msd_sdhc_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size);
|
|
|
+static rt_size_t rt_msd_sdhc_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size);
|
|
|
+
|
|
|
+static rt_err_t MSD_take_owner(struct rt_spi_device* spi_device)
|
|
|
{
|
|
|
- u32 i = 0;
|
|
|
-
|
|
|
- /* Initialize SPI */
|
|
|
- SPI_Config();
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte 0xFF, 10 times with CS high*/
|
|
|
- /* rise CS and MOSI for 80 clocks cycles */
|
|
|
- for (i = 0; i < 10; i++)
|
|
|
- {
|
|
|
- /* Send dummy byte 0xFF */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- }
|
|
|
- /*------------Put MSD in SPI mode--------------*/
|
|
|
- /* MSD initialized and set to SPI mode properly */
|
|
|
- return (MSD_GoIdleState());
|
|
|
+ rt_err_t result;
|
|
|
+
|
|
|
+ result = rt_mutex_take(&(spi_device->bus->lock), RT_WAITING_FOREVER);
|
|
|
+ if(result == RT_EOK)
|
|
|
+ {
|
|
|
+ if (spi_device->bus->owner != spi_device)
|
|
|
+ {
|
|
|
+ /* not the same owner as current, re-configure SPI bus */
|
|
|
+ result = spi_device->bus->ops->configure(spi_device, &spi_device->config);
|
|
|
+ if (result == RT_EOK)
|
|
|
+ {
|
|
|
+ /* set SPI bus owner */
|
|
|
+ spi_device->bus->owner = spi_device;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+static void MSD_take_cs(struct rt_spi_device* device)
|
|
|
+{
|
|
|
+ struct rt_spi_message message;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = 0;
|
|
|
+ message.cs_take = 1;
|
|
|
+ message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_WriteBlock
|
|
|
-* Description : Writes a block on the MSD
|
|
|
-* Input : - pBuffer : pointer to the buffer containing the data to be
|
|
|
-* written on the MSD.
|
|
|
-* - WriteAddr : address to write on.
|
|
|
-* - NumByteToWrite: number of data to write
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_WriteBlock(u8* pBuffer, u32 WriteAddr, u16 NumByteToWrite)
|
|
|
+static void MSD_release_cs(struct rt_spi_device* device)
|
|
|
{
|
|
|
- u32 i = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
-
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD24 (MSD_WRITE_BLOCK) to write multiple block */
|
|
|
- MSD_SendCmd(MSD_WRITE_BLOCK, WriteAddr, 0xFF);
|
|
|
-
|
|
|
- /* Check if the MSD acknowledged the write block command: R1 response (0x00: no errors) */
|
|
|
- if (!MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
- {
|
|
|
- /* Send a dummy byte */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Send the data token to signify the start of the data */
|
|
|
- MSD_WriteByte(0xFE);
|
|
|
- /* Write the block data to MSD : write count data by block */
|
|
|
- for (i = 0; i < NumByteToWrite; i++)
|
|
|
- {
|
|
|
- /* Send the pointed byte */
|
|
|
- MSD_WriteByte(*pBuffer);
|
|
|
- /* Point to the next location where the byte read will be saved */
|
|
|
- pBuffer++;
|
|
|
+ struct rt_spi_message message;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = 0;
|
|
|
+ message.cs_take = 0;
|
|
|
+ message.cs_release = 1;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+}
|
|
|
+
|
|
|
+static rt_bool_t rt_tick_timeout(rt_tick_t tick_start, rt_tick_t tick_long)
|
|
|
+{
|
|
|
+ rt_tick_t tick_end = tick_start + tick_long;
|
|
|
+ rt_tick_t tick_now = rt_tick_get();
|
|
|
+ rt_bool_t result = RT_FALSE;
|
|
|
+
|
|
|
+ if(tick_end >= tick_start)
|
|
|
+ {
|
|
|
+ if (tick_now >= tick_end)
|
|
|
+ {
|
|
|
+ result = RT_TRUE;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ result = RT_FALSE;
|
|
|
+ }
|
|
|
}
|
|
|
- /* Put CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_ReadByte();
|
|
|
- MSD_ReadByte();
|
|
|
- /* Read data response */
|
|
|
- if (MSD_GetDataResponse() == MSD_DATA_OK)
|
|
|
+ else
|
|
|
{
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
+ if ((tick_now < tick_start ) && (tick_now >= tick_end) )
|
|
|
+ {
|
|
|
+ result = RT_TRUE;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ result = RT_FALSE;
|
|
|
+ }
|
|
|
}
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Returns the reponse */
|
|
|
- return rvalue;
|
|
|
+
|
|
|
+ return result;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_ReadBlock
|
|
|
-* Description : Reads a block of data from the MSD.
|
|
|
-* Input : - pBuffer : pointer to the buffer that receives the data read
|
|
|
-* from the MSD.
|
|
|
-* - ReadAddr : MSD's internal address to read from.
|
|
|
-* - NumByteToRead : number of bytes to read from the MSD.
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_ReadBlock(u8* pBuffer, u32 ReadAddr, u16 NumByteToRead)
|
|
|
+static uint8_t crc7(const uint8_t *buf, int len)
|
|
|
{
|
|
|
- u32 i = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
-
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD17 (MSD_READ_SINGLE_BLOCK) to read one block */
|
|
|
- MSD_SendCmd(MSD_READ_SINGLE_BLOCK, ReadAddr, 0xFF);
|
|
|
-
|
|
|
- /* Check if the MSD acknowledged the read block command: R1 response (0x00: no errors) */
|
|
|
- if (!MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
- {
|
|
|
- /* Now look for the data token to signify the start of the data */
|
|
|
- if (!MSD_GetResponse(MSD_START_DATA_SINGLE_BLOCK_READ))
|
|
|
- {
|
|
|
- /* Read the MSD block data : read NumByteToRead data */
|
|
|
- for (i = 0; i < NumByteToRead; i++)
|
|
|
- {
|
|
|
- /* Save the received data */
|
|
|
- *pBuffer = MSD_ReadByte();
|
|
|
- /* Point to the next location where the byte read will be saved */
|
|
|
- pBuffer++;
|
|
|
- }
|
|
|
- /* Get CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_ReadByte();
|
|
|
- MSD_ReadByte();
|
|
|
- /* Set response value to success */
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
+ unsigned char i, j, crc, ch, ch2, ch3;
|
|
|
+
|
|
|
+ crc = 0;
|
|
|
+
|
|
|
+ for (i = 0; i < len; i ++)
|
|
|
+ {
|
|
|
+ ch = buf[i];
|
|
|
+
|
|
|
+ for (j = 0; j < 8; j ++, ch <<= 1)
|
|
|
+ {
|
|
|
+ ch2 = (crc & 0x40) ? 1 : 0;
|
|
|
+ ch3 = (ch & 0x80) ? 1 : 0;
|
|
|
+
|
|
|
+ if (ch2 ^ ch3)
|
|
|
+ {
|
|
|
+ crc ^= 0x04;
|
|
|
+ crc <<= 1;
|
|
|
+ crc |= 0x01;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ crc <<= 1;
|
|
|
+ }
|
|
|
+ }
|
|
|
}
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Returns the reponse */
|
|
|
- return rvalue;
|
|
|
+
|
|
|
+ return crc;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_WriteBuffer
|
|
|
-* Description : Writes many blocks on the MSD
|
|
|
-* Input : - pBuffer : pointer to the buffer containing the data to be
|
|
|
-* written on the MSD.
|
|
|
-* - WriteAddr : address to write on.
|
|
|
-* - NumByteToWrite: number of data to write
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_WriteBuffer(u8* pBuffer, u32 WriteAddr, u32 NumByteToWrite)
|
|
|
+static rt_err_t _send_cmd(
|
|
|
+ struct rt_spi_device* device,
|
|
|
+ uint8_t cmd,
|
|
|
+ uint32_t arg,
|
|
|
+ uint8_t crc,
|
|
|
+ response_type type,
|
|
|
+ uint8_t * response
|
|
|
+)
|
|
|
{
|
|
|
- u32 i = 0, NbrOfBlock = 0, Offset = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
+ struct rt_spi_message message;
|
|
|
+ uint8_t cmd_buffer[8];
|
|
|
+ uint8_t recv_buffer[sizeof(cmd_buffer)];
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ cmd_buffer[0] = DUMMY;
|
|
|
+ cmd_buffer[1] = (cmd | 0x40);
|
|
|
+ cmd_buffer[2] = (uint8_t)(arg >> 24);
|
|
|
+ cmd_buffer[3] = (uint8_t)(arg >> 16);
|
|
|
+ cmd_buffer[4] = (uint8_t)(arg >> 8);
|
|
|
+ cmd_buffer[5] = (uint8_t)(arg);
|
|
|
+
|
|
|
+ if(crc == 0x00)
|
|
|
+ {
|
|
|
+ crc = crc7(&cmd_buffer[1], 5);
|
|
|
+ crc = (crc<<1) | 0x01;
|
|
|
+ }
|
|
|
+ cmd_buffer[6] = (crc);
|
|
|
+
|
|
|
+ cmd_buffer[7] = DUMMY;
|
|
|
|
|
|
- /* Calculate number of blocks to write */
|
|
|
- NbrOfBlock = NumByteToWrite / BLOCK_SIZE;
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = cmd_buffer;
|
|
|
+ message.recv_buf = recv_buffer;
|
|
|
+ message.length = sizeof(cmd_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
|
|
|
- /* Data transfer */
|
|
|
- while (NbrOfBlock --)
|
|
|
- {
|
|
|
- /* Send CMD24 (MSD_WRITE_BLOCK) to write blocks */
|
|
|
- MSD_SendCmd(MSD_WRITE_BLOCK, WriteAddr + Offset, 0xFF);
|
|
|
+ _wait_ready(device);
|
|
|
|
|
|
- /* Check if the MSD acknowledged the write block command: R1 response (0x00: no errors) */
|
|
|
- if (MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+ for(i=CARD_NCR; i<(CARD_NCR_MAX+1); i++)
|
|
|
{
|
|
|
- return MSD_RESPONSE_FAILURE;
|
|
|
- }
|
|
|
- /* Send dummy byte */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Send the data token to signify the start of the data */
|
|
|
- MSD_WriteByte(MSD_START_DATA_SINGLE_BLOCK_WRITE);
|
|
|
- /* Write the block data to MSD : write count data by block */
|
|
|
- for (i = 0; i < BLOCK_SIZE; i++)
|
|
|
- {
|
|
|
- /* Send the pointed byte */
|
|
|
- MSD_WriteByte(*pBuffer);
|
|
|
- /* Point to the next location where the byte read will be saved */
|
|
|
- pBuffer++;
|
|
|
+ uint8_t send = DUMMY;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = &send;
|
|
|
+ message.recv_buf = response;
|
|
|
+ message.length = 1;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+ if(0 == (response[0] & 0x80))
|
|
|
+ {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ } /* wait response */
|
|
|
+
|
|
|
+ if((CARD_NCR_MAX+1) == i)
|
|
|
+ {
|
|
|
+ return RT_ERROR;//fail
|
|
|
}
|
|
|
- /* Set next write address */
|
|
|
- Offset += 512;
|
|
|
- /* Put CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_ReadByte();
|
|
|
- MSD_ReadByte();
|
|
|
- /* Read data response */
|
|
|
- if (MSD_GetDataResponse() == MSD_DATA_OK)
|
|
|
- {
|
|
|
- /* Set response value to success */
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
+
|
|
|
+ //recieve other byte
|
|
|
+ if(type == response_r1)
|
|
|
+ {
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
- else
|
|
|
+ else if(type == response_r1b)
|
|
|
{
|
|
|
- /* Set response value to failure */
|
|
|
- rvalue = MSD_RESPONSE_FAILURE;
|
|
|
+ rt_tick_t tick_start = rt_tick_get();
|
|
|
+ uint8_t recv;
|
|
|
+
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = &recv;
|
|
|
+ message.length = 1;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+ if(recv == DUMMY)
|
|
|
+ {
|
|
|
+ return RT_EOK;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(2000)))
|
|
|
+ {
|
|
|
+ return RT_ETIMEOUT;
|
|
|
+ }
|
|
|
+ }
|
|
|
}
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Returns the reponse */
|
|
|
- return rvalue;
|
|
|
-}
|
|
|
-
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_ReadBuffer
|
|
|
-* Description : Reads multiple block of data from the MSD.
|
|
|
-* Input : - pBuffer : pointer to the buffer that receives the data read
|
|
|
-* from the MSD.
|
|
|
-* - ReadAddr : MSD's internal address to read from.
|
|
|
-* - NumByteToRead : number of bytes to read from the MSD.
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_ReadBuffer(u8* pBuffer, u32 ReadAddr, u32 NumByteToRead)
|
|
|
-{
|
|
|
- u32 i = 0, NbrOfBlock = 0, Offset = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
-
|
|
|
- /* Calculate number of blocks to read */
|
|
|
- NbrOfBlock = NumByteToRead / BLOCK_SIZE;
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
-
|
|
|
- /* Data transfer */
|
|
|
- while (NbrOfBlock --)
|
|
|
- {
|
|
|
- /* Send CMD17 (MSD_READ_SINGLE_BLOCK) to read one block */
|
|
|
- MSD_SendCmd (MSD_READ_SINGLE_BLOCK, ReadAddr + Offset, 0xFF);
|
|
|
- /* Check if the MSD acknowledged the read block command: R1 response (0x00: no errors) */
|
|
|
- if (MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
- {
|
|
|
- return MSD_RESPONSE_FAILURE;
|
|
|
+ else if(type == response_r2)
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = response+1;
|
|
|
+ message.length = 1;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
}
|
|
|
- /* Now look for the data token to signify the start of the data */
|
|
|
- if (!MSD_GetResponse(MSD_START_DATA_SINGLE_BLOCK_READ))
|
|
|
- {
|
|
|
- /* Read the MSD block data : read NumByteToRead data */
|
|
|
- for (i = 0; i < BLOCK_SIZE; i++)
|
|
|
- {
|
|
|
- /* Read the pointed data */
|
|
|
- *pBuffer = MSD_ReadByte();
|
|
|
- /* Point to the next location where the byte read will be saved */
|
|
|
- pBuffer++;
|
|
|
- }
|
|
|
- /* Set next read address*/
|
|
|
- Offset += 512;
|
|
|
- /* get CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_ReadByte();
|
|
|
- MSD_ReadByte();
|
|
|
- /* Set response value to success */
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
+ else if((type == response_r3) || (type == response_r7))
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = response+1;
|
|
|
+ message.length = 4;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- /* Set response value to failure */
|
|
|
- rvalue = MSD_RESPONSE_FAILURE;
|
|
|
+ return RT_ERROR; // unknow type?
|
|
|
}
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Returns the reponse */
|
|
|
- return rvalue;
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GetCSDRegister
|
|
|
-* Description : Read the CSD card register.
|
|
|
-* Reading the contents of the CSD register in SPI mode
|
|
|
-* is a simple read-block transaction.
|
|
|
-* Input : - MSD_csd: pointer on an SCD register structure
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_GetCSDRegister(sMSD_CSD* MSD_csd)
|
|
|
+static rt_err_t _wait_token(struct rt_spi_device* device, uint8_t token)
|
|
|
{
|
|
|
- u32 i = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
- u8 CSD_Tab[16];
|
|
|
-
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD9 (CSD register) or CMD10(CSD register) */
|
|
|
- MSD_SendCmd(MSD_SEND_CSD, 0, 0xFF);
|
|
|
-
|
|
|
- /* Wait for response in the R1 format (0x00 is no errors) */
|
|
|
- if (!MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
- {
|
|
|
- if (!MSD_GetResponse(MSD_START_DATA_SINGLE_BLOCK_READ))
|
|
|
- {
|
|
|
- for (i = 0; i < 16; i++)
|
|
|
- {
|
|
|
- /* Store CSD register value on CSD_Tab */
|
|
|
- CSD_Tab[i] = MSD_ReadByte();
|
|
|
- }
|
|
|
- }
|
|
|
- /* Get CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Set response value to success */
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
-
|
|
|
- /* Byte 0 */
|
|
|
- MSD_csd->CSDStruct = (CSD_Tab[0] & 0xC0) >> 6;
|
|
|
- MSD_csd->SysSpecVersion = (CSD_Tab[0] & 0x3C) >> 2;
|
|
|
- MSD_csd->Reserved1 = CSD_Tab[0] & 0x03;
|
|
|
- /* Byte 1 */
|
|
|
- MSD_csd->TAAC = CSD_Tab[1] ;
|
|
|
- /* Byte 2 */
|
|
|
- MSD_csd->NSAC = CSD_Tab[2];
|
|
|
- /* Byte 3 */
|
|
|
- MSD_csd->MaxBusClkFrec = CSD_Tab[3];
|
|
|
- /* Byte 4 */
|
|
|
- MSD_csd->CardComdClasses = CSD_Tab[4] << 4;
|
|
|
- /* Byte 5 */
|
|
|
- MSD_csd->CardComdClasses |= (CSD_Tab[5] & 0xF0) >> 4;
|
|
|
- MSD_csd->RdBlockLen = CSD_Tab[5] & 0x0F;
|
|
|
- /* Byte 6 */
|
|
|
- MSD_csd->PartBlockRead = (CSD_Tab[6] & 0x80) >> 7;
|
|
|
- MSD_csd->WrBlockMisalign = (CSD_Tab[6] & 0x40) >> 6;
|
|
|
- MSD_csd->RdBlockMisalign = (CSD_Tab[6] & 0x20) >> 5;
|
|
|
- MSD_csd->DSRImpl = (CSD_Tab[6] & 0x10) >> 4;
|
|
|
- MSD_csd->Reserved2 = 0; /* Reserved */
|
|
|
- MSD_csd->DeviceSize = (CSD_Tab[6] & 0x03) << 10;
|
|
|
- /* Byte 7 */
|
|
|
- MSD_csd->DeviceSize |= (CSD_Tab[7]) << 2;
|
|
|
- /* Byte 8 */
|
|
|
- MSD_csd->DeviceSize |= (CSD_Tab[8] & 0xC0) >> 6;
|
|
|
- MSD_csd->MaxRdCurrentVDDMin = (CSD_Tab[8] & 0x38) >> 3;
|
|
|
- MSD_csd->MaxRdCurrentVDDMax = (CSD_Tab[8] & 0x07);
|
|
|
- /* Byte 9 */
|
|
|
- MSD_csd->MaxWrCurrentVDDMin = (CSD_Tab[9] & 0xE0) >> 5;
|
|
|
- MSD_csd->MaxWrCurrentVDDMax = (CSD_Tab[9] & 0x1C) >> 2;
|
|
|
- MSD_csd->DeviceSizeMul = (CSD_Tab[9] & 0x03) << 1;
|
|
|
- /* Byte 10 */
|
|
|
- MSD_csd->DeviceSizeMul |= (CSD_Tab[10] & 0x80) >> 7;
|
|
|
- MSD_csd->EraseGrSize = (CSD_Tab[10] & 0x7C) >> 2;
|
|
|
- MSD_csd->EraseGrMul = (CSD_Tab[10] & 0x03) << 3;
|
|
|
- /* Byte 11 */
|
|
|
- MSD_csd->EraseGrMul |= (CSD_Tab[11] & 0xE0) >> 5;
|
|
|
- MSD_csd->WrProtectGrSize = (CSD_Tab[11] & 0x1F);
|
|
|
- /* Byte 12 */
|
|
|
- MSD_csd->WrProtectGrEnable = (CSD_Tab[12] & 0x80) >> 7;
|
|
|
- MSD_csd->ManDeflECC = (CSD_Tab[12] & 0x60) >> 5;
|
|
|
- MSD_csd->WrSpeedFact = (CSD_Tab[12] & 0x1C) >> 2;
|
|
|
- MSD_csd->MaxWrBlockLen = (CSD_Tab[12] & 0x03) << 2;
|
|
|
- /* Byte 13 */
|
|
|
- MSD_csd->MaxWrBlockLen |= (CSD_Tab[13] & 0xc0) >> 6;
|
|
|
- MSD_csd->WriteBlockPaPartial = (CSD_Tab[13] & 0x20) >> 5;
|
|
|
- MSD_csd->Reserved3 = 0;
|
|
|
- MSD_csd->ContentProtectAppli = (CSD_Tab[13] & 0x01);
|
|
|
- /* Byte 14 */
|
|
|
- MSD_csd->FileFormatGrouop = (CSD_Tab[14] & 0x80) >> 7;
|
|
|
- MSD_csd->CopyFlag = (CSD_Tab[14] & 0x40) >> 6;
|
|
|
- MSD_csd->PermWrProtect = (CSD_Tab[14] & 0x20) >> 5;
|
|
|
- MSD_csd->TempWrProtect = (CSD_Tab[14] & 0x10) >> 4;
|
|
|
- MSD_csd->FileFormat = (CSD_Tab[14] & 0x0C) >> 2;
|
|
|
- MSD_csd->ECC = (CSD_Tab[14] & 0x03);
|
|
|
- /* Byte 15 */
|
|
|
- MSD_csd->msd_CRC = (CSD_Tab[15] & 0xFE) >> 1;
|
|
|
- MSD_csd->Reserved4 = 1;
|
|
|
-
|
|
|
- /* Return the reponse */
|
|
|
- return rvalue;
|
|
|
+ struct rt_spi_message message;
|
|
|
+ rt_tick_t tick_start;
|
|
|
+ uint8_t send, recv;
|
|
|
+
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ /* wati token */
|
|
|
+ /* initial message */
|
|
|
+ send = DUMMY;
|
|
|
+ message.send_buf = &send;
|
|
|
+ message.recv_buf = &recv;
|
|
|
+ message.length = 1;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+ if(recv == token)
|
|
|
+ {
|
|
|
+ return RT_EOK;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_WAIT_TOKEN_TIMES)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] wait data start token timeout!\r\n");
|
|
|
+ return RT_ETIMEOUT;
|
|
|
+ }
|
|
|
+ } /* wati token */
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GetCIDRegister
|
|
|
-* Description : Read the CID card register.
|
|
|
-* Reading the contents of the CID register in SPI mode
|
|
|
-* is a simple read-block transaction.
|
|
|
-* Input : - MSD_cid: pointer on an CID register structure
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_GetCIDRegister(sMSD_CID* MSD_cid)
|
|
|
+static rt_err_t _wait_ready(struct rt_spi_device* device)
|
|
|
{
|
|
|
- u32 i = 0;
|
|
|
- u8 rvalue = MSD_RESPONSE_FAILURE;
|
|
|
- u8 CID_Tab[16];
|
|
|
-
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD10 (CID register) */
|
|
|
- MSD_SendCmd(MSD_SEND_CID, 0, 0xFF);
|
|
|
-
|
|
|
- /* Wait for response in the R1 format (0x00 is no errors) */
|
|
|
- if (!MSD_GetResponse(MSD_RESPONSE_NO_ERROR))
|
|
|
- {
|
|
|
- if (!MSD_GetResponse(MSD_START_DATA_SINGLE_BLOCK_READ))
|
|
|
- {
|
|
|
- /* Store CID register value on CID_Tab */
|
|
|
- for (i = 0; i < 16; i++)
|
|
|
- {
|
|
|
- CID_Tab[i] = MSD_ReadByte();
|
|
|
- }
|
|
|
+ struct rt_spi_message message;
|
|
|
+ rt_tick_t tick_start;
|
|
|
+ uint8_t send, recv;
|
|
|
+
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ send = DUMMY;
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = &send;
|
|
|
+ message.recv_buf = &recv;
|
|
|
+ message.length = 1;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+ if(recv == DUMMY)
|
|
|
+ {
|
|
|
+ return RT_EOK;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(1000)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] wait ready timeout!\r\n");
|
|
|
+ return RT_ETIMEOUT;
|
|
|
+ }
|
|
|
}
|
|
|
- /* Get CRC bytes (not really needed by us, but required by MSD) */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- /* Set response value to success */
|
|
|
- rvalue = MSD_RESPONSE_NO_ERROR;
|
|
|
- }
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte: 8 Clock pulses of delay */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
-
|
|
|
- /* Byte 0 */
|
|
|
- MSD_cid->ManufacturerID = CID_Tab[0];
|
|
|
- /* Byte 1 */
|
|
|
- MSD_cid->OEM_AppliID = CID_Tab[1] << 8;
|
|
|
- /* Byte 2 */
|
|
|
- MSD_cid->OEM_AppliID |= CID_Tab[2];
|
|
|
- /* Byte 3 */
|
|
|
- MSD_cid->ProdName1 = CID_Tab[3] << 24;
|
|
|
- /* Byte 4 */
|
|
|
- MSD_cid->ProdName1 |= CID_Tab[4] << 16;
|
|
|
- /* Byte 5 */
|
|
|
- MSD_cid->ProdName1 |= CID_Tab[5] << 8;
|
|
|
- /* Byte 6 */
|
|
|
- MSD_cid->ProdName1 |= CID_Tab[6];
|
|
|
- /* Byte 7 */
|
|
|
- MSD_cid->ProdName2 = CID_Tab[7];
|
|
|
- /* Byte 8 */
|
|
|
- MSD_cid->ProdRev = CID_Tab[8];
|
|
|
- /* Byte 9 */
|
|
|
- MSD_cid->ProdSN = CID_Tab[9] << 24;
|
|
|
- /* Byte 10 */
|
|
|
- MSD_cid->ProdSN |= CID_Tab[10] << 16;
|
|
|
- /* Byte 11 */
|
|
|
- MSD_cid->ProdSN |= CID_Tab[11] << 8;
|
|
|
- /* Byte 12 */
|
|
|
- MSD_cid->ProdSN |= CID_Tab[12];
|
|
|
- /* Byte 13 */
|
|
|
- MSD_cid->Reserved1 |= (CID_Tab[13] & 0xF0) >> 4;
|
|
|
- /* Byte 14 */
|
|
|
- MSD_cid->ManufactDate = (CID_Tab[13] & 0x0F) << 8;
|
|
|
- /* Byte 15 */
|
|
|
- MSD_cid->ManufactDate |= CID_Tab[14];
|
|
|
- /* Byte 16 */
|
|
|
- MSD_cid->msd_CRC = (CID_Tab[15] & 0xFE) >> 1;
|
|
|
- MSD_cid->Reserved2 = 1;
|
|
|
-
|
|
|
- /* Return the reponse */
|
|
|
- return rvalue;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_SendCmd
|
|
|
-* Description : Send 5 bytes command to the MSD card.
|
|
|
-* Input : - Cmd: the user expected command to send to MSD card
|
|
|
-* - Arg: the command argument
|
|
|
-* - Crc: the CRC
|
|
|
-* Output : None
|
|
|
-* Return : None
|
|
|
-*******************************************************************************/
|
|
|
-void MSD_SendCmd(u8 Cmd, u32 Arg, u8 Crc)
|
|
|
+static rt_err_t _read_block(struct rt_spi_device* device, void * buffer, uint32_t block_size)
|
|
|
{
|
|
|
- u32 i = 0x00;
|
|
|
- u8 Frame[6];
|
|
|
-
|
|
|
- /* Construct byte1 */
|
|
|
- Frame[0] = (Cmd | 0x40);
|
|
|
- /* Construct byte2 */
|
|
|
- Frame[1] = (u8)(Arg >> 24);
|
|
|
- /* Construct byte3 */
|
|
|
- Frame[2] = (u8)(Arg >> 16);
|
|
|
- /* Construct byte4 */
|
|
|
- Frame[3] = (u8)(Arg >> 8);
|
|
|
- /* Construct byte5 */
|
|
|
- Frame[4] = (u8)(Arg);
|
|
|
- /* Construct CRC: byte6 */
|
|
|
- Frame[5] = (Crc);
|
|
|
-
|
|
|
- /* Send the Cmd bytes */
|
|
|
- for (i = 0; i < 6; i++)
|
|
|
- {
|
|
|
- MSD_WriteByte(Frame[i]);
|
|
|
- }
|
|
|
-}
|
|
|
+ struct rt_spi_message message;
|
|
|
+ rt_err_t result;
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GetDataResponse
|
|
|
-* Description : Get MSD card data response.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : The MSD status: Read data response xxx0<status>1
|
|
|
-* - status 010: Data accecpted
|
|
|
-* - status 101: Data rejected due to a crc error
|
|
|
-* - status 110: Data rejected due to a Write error.
|
|
|
-* - status 111: Data rejected due to other error.
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_GetDataResponse(void)
|
|
|
-{
|
|
|
- u32 i = 0;
|
|
|
- u8 response, rvalue;
|
|
|
-
|
|
|
- while (i <= 64)
|
|
|
- {
|
|
|
- /* Read resonse */
|
|
|
- response = MSD_ReadByte();
|
|
|
- /* Mask unused bits */
|
|
|
- response &= 0x1F;
|
|
|
-
|
|
|
- switch (response)
|
|
|
- {
|
|
|
- case MSD_DATA_OK:
|
|
|
- {
|
|
|
- rvalue = MSD_DATA_OK;
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- case MSD_DATA_CRC_ERROR:
|
|
|
- return MSD_DATA_CRC_ERROR;
|
|
|
-
|
|
|
- case MSD_DATA_WRITE_ERROR:
|
|
|
- return MSD_DATA_WRITE_ERROR;
|
|
|
-
|
|
|
- default:
|
|
|
- {
|
|
|
- rvalue = MSD_DATA_OTHER_ERROR;
|
|
|
- break;
|
|
|
- }
|
|
|
+ /* wati token */
|
|
|
+ result = _wait_token(device, MSD_TOKEN_READ_START);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ return result;
|
|
|
}
|
|
|
- /* Exit loop in case of data ok */
|
|
|
- if (rvalue == MSD_DATA_OK)
|
|
|
- break;
|
|
|
- /* Increment loop counter */
|
|
|
- i++;
|
|
|
- }
|
|
|
- /* Wait null data */
|
|
|
- while (MSD_ReadByte() == 0);
|
|
|
- /* Return response */
|
|
|
- return response;
|
|
|
+
|
|
|
+ /* read data */
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = buffer;
|
|
|
+ message.length = block_size;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+ } /* read data */
|
|
|
+
|
|
|
+ /* get crc */
|
|
|
+ {
|
|
|
+ uint8_t recv_buffer[2];
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = RT_NULL;
|
|
|
+ message.recv_buf = recv_buffer;
|
|
|
+ message.length = 2;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+ } /* get crc */
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GetResponse
|
|
|
-* Description : Returns the MSD response.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_GetResponse(u8 Response)
|
|
|
+static rt_err_t _write_block(struct rt_spi_device* device, const void * buffer, uint32_t block_size, uint8_t token)
|
|
|
{
|
|
|
- u32 Count = 0xFFF;
|
|
|
-
|
|
|
- /* Check if response is got or a timeout is happen */
|
|
|
- while ((MSD_ReadByte() != Response) && Count)
|
|
|
- {
|
|
|
- Count--;
|
|
|
- }
|
|
|
-
|
|
|
- if (Count == 0)
|
|
|
- {
|
|
|
- /* After time out */
|
|
|
- return MSD_RESPONSE_FAILURE;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- /* Right response got */
|
|
|
- return MSD_RESPONSE_NO_ERROR;
|
|
|
- }
|
|
|
+ struct rt_spi_message message;
|
|
|
+ uint8_t send_buffer[16];
|
|
|
+
|
|
|
+ rt_memset(send_buffer, DUMMY, sizeof(send_buffer));
|
|
|
+ send_buffer[sizeof(send_buffer) - 1] = token;
|
|
|
+
|
|
|
+ /* send start block token */
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = sizeof(send_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* send data */
|
|
|
+ {
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = block_size;
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* put crc and get data response */
|
|
|
+ {
|
|
|
+ uint8_t recv_buffer[3];
|
|
|
+ uint8_t response;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = recv_buffer;
|
|
|
+ message.length = sizeof(recv_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ device->bus->ops->xfer(device, &message);
|
|
|
+
|
|
|
+// response = 0x0E & recv_buffer[2];
|
|
|
+ response = MSD_GET_DATA_RESPONSE(recv_buffer[2]);
|
|
|
+ if(response != MSD_DATA_OK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] write block fail! data response : 0x%02X\r\n", response);
|
|
|
+ return RT_ERROR;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* wati ready */
|
|
|
+ return _wait_ready(device);
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GetStatus
|
|
|
-* Description : Returns the MSD status.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : The MSD status.
|
|
|
-*******************************************************************************/
|
|
|
-u16 MSD_GetStatus(void)
|
|
|
+/* RT-Thread Device Driver Interface */
|
|
|
+static rt_err_t rt_msd_init(rt_device_t dev)
|
|
|
{
|
|
|
- u16 Status = 0;
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ uint8_t response[MSD_RESPONSE_MAX_LEN];
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
+ rt_tick_t tick_start;
|
|
|
+ uint32_t OCR;
|
|
|
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD13 (MSD_SEND_STATUS) to get MSD status */
|
|
|
- MSD_SendCmd(MSD_SEND_STATUS, 0, 0xFF);
|
|
|
+ if(msd->spi_device == RT_NULL)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] the SPI SD device has no SPI!\r\n");
|
|
|
+ return RT_EIO;
|
|
|
+ }
|
|
|
|
|
|
- Status = MSD_ReadByte();
|
|
|
- Status |= (u16)(MSD_ReadByte() << 8);
|
|
|
+ /* config spi */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = 1000*400; /* 400kbit/s */
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
+
|
|
|
+ /* init SD card */
|
|
|
+ {
|
|
|
+ struct rt_spi_message message;
|
|
|
+
|
|
|
+ result = MSD_take_owner(msd->spi_device);
|
|
|
+
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ /* The host shall supply power to the card so that the voltage is reached to Vdd_min within 250ms and
|
|
|
+ start to supply at least 74 SD clocks to the SD card with keeping CMD line to high.
|
|
|
+ In case of SPI mode, CS shall be held to high during 74 clock cycles. */
|
|
|
+ {
|
|
|
+ uint8_t send_buffer[100]; /* 100byte > 74 clock */
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ memset(send_buffer, DUMMY, sizeof(send_buffer));
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = sizeof(send_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ msd->spi_device->bus->ops->xfer(msd->spi_device, &message);
|
|
|
+ } /* send 74 clock */
|
|
|
+
|
|
|
+ /* Send CMD0 (GO_IDLE_STATE) to put MSD in SPI mode */
|
|
|
+ {
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, GO_IDLE_STATE, 0x00, 0x95, response_r1, response);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ if((result == RT_EOK) && (response[0] == MSD_IN_IDLE_STATE))
|
|
|
+ {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_TRY_TIMES)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] SD card goto IDLE mode timeout!\r\n");
|
|
|
+ result = RT_ETIMEOUT;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ MSD_DEBUG("[info] SD card goto IDLE mode OK!\r\n");
|
|
|
+ } /* Send CMD0 (GO_IDLE_STATE) to put MSD in SPI mode */
|
|
|
+
|
|
|
+ /* CMD8 */
|
|
|
+ {
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ do
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, SEND_IF_COND, 0x01AA, 0x87, response_r7, response);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ if(result == RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] CMD8 response : 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X\r\n",
|
|
|
+ response[0], response[1], response[2], response[3], response[4]);
|
|
|
+
|
|
|
+ if(response[0] & (1<<2))
|
|
|
+ {
|
|
|
+ /* illegal command, SD V1.x or MMC card */
|
|
|
+ MSD_DEBUG("[info] CMD8 is illegal command.\r\n");
|
|
|
+ MSD_DEBUG("[info] maybe Ver1.X SD Memory Card or MMC card!\r\n");
|
|
|
+ msd->card_type = MSD_CARD_TYPE_SD_V1_X;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* SD V2.0 or later or SDHC or SDXC memory card! */
|
|
|
+ MSD_DEBUG("[info] Ver2.00 or later or SDHC or SDXC memory card!\r\n");
|
|
|
+ msd->card_type = MSD_CARD_TYPE_SD_V2_X;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((0xAA == response[4]) && (0x00 == response[3]))
|
|
|
+ {
|
|
|
+ /* SD2.0 not support current voltage */
|
|
|
+ MSD_DEBUG("[err] VCA = 0, SD2.0 not surpport current operation voltage range\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(200)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD8 SEND_IF_COND timeout!\r\n");
|
|
|
+ result = RT_ETIMEOUT;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ while(0xAA != response[4]);
|
|
|
+ } /* CMD8 */
|
|
|
+
|
|
|
+ /* Ver1.X SD Memory Card or MMC card */
|
|
|
+ if(msd->card_type == MSD_CARD_TYPE_SD_V1_X)
|
|
|
+ {
|
|
|
+ rt_bool_t is_sd_v1_x = RT_FALSE;
|
|
|
+ rt_tick_t tick_start;
|
|
|
+
|
|
|
+ /* try SD Ver1.x */
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_OCR, 0x00, 0x00, response_r3, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] It maybe SD1.x or MMC But it is Not response to CMD58!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(0 != (response[0]&0xFE))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] It look CMD58 as illegal command so it is not SD card!\r\n");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ OCR = response[1];
|
|
|
+ OCR = (OCR<<8) + response[2];
|
|
|
+ OCR = (OCR<<8) + response[3];
|
|
|
+ OCR = (OCR<<8) + response[4];
|
|
|
+ MSD_DEBUG("[info] OCR is 0x%08X\r\n", OCR);
|
|
|
+
|
|
|
+ if( 0 == (OCR & (0x1 << 15)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG(("[err] SD 1.x But not surpport current voltage\r\n"));
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* --Send ACMD41 to make card ready */
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ /* try CMD55 + ACMD41 */
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_TRY_TIMES_ACMD41)))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] try CMD55 + ACMD41 timeout! mabey MMC card!\r\n");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ /* CMD55 APP_CMD */
|
|
|
+ result = _send_cmd(msd->spi_device, APP_CMD, 0x00, 0x00, response_r1, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(0 != (response[0]&0xFE))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] Not SD card2 , may be MMC\r\n");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* ACMD41 SD_SEND_OP_COND */
|
|
|
+ result = _send_cmd(msd->spi_device, SD_SEND_OP_COND, 0x00, 0x00, response_r1, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(0 != (response[0]&0xFE))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] Not SD card4 , may be MMC\r\n");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(0 == (response[0]&0xFF))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ is_sd_v1_x = RT_TRUE;
|
|
|
+ MSD_DEBUG("[info] It is Ver1.X SD Memory Card!!!\r\n");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ } /* try CMD55 + ACMD41 */
|
|
|
+
|
|
|
+ break;
|
|
|
+ } /* try SD Ver1.x */
|
|
|
+
|
|
|
+ /* try MMC */
|
|
|
+ if(is_sd_v1_x != RT_TRUE)
|
|
|
+ {
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ MSD_DEBUG("[info] try MMC card!\r\n");
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ /* send dummy clock */
|
|
|
+ {
|
|
|
+ uint8_t send_buffer[100];
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ memset(send_buffer, DUMMY, sizeof(send_buffer));
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = sizeof(send_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ for(i=0; i<10; i++)
|
|
|
+ {
|
|
|
+ /* transfer message */
|
|
|
+ msd->spi_device->bus->ops->xfer(msd->spi_device, &message);
|
|
|
+ }
|
|
|
+ } /* send dummy clock */
|
|
|
+
|
|
|
+ /* send CMD0 goto IDLE state */
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, GO_IDLE_STATE, 0x00, 0x95, response_r1, response);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ if((result == RT_EOK) && (response[0] == MSD_IN_IDLE_STATE))
|
|
|
+ {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_TRY_TIMES)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] SD card goto IDLE mode timeout!\r\n");
|
|
|
+ result = RT_ETIMEOUT;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ } /* send CMD0 goto IDLE stat */
|
|
|
+
|
|
|
+ /* send CMD1 */
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, SEND_OP_COND, 0x00, 0x00, response_r1, response);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ if((result == RT_EOK) && (response[0] == MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] It is MMC card!!!\r\n");
|
|
|
+ msd->card_type = MSD_CARD_TYPE_MMC;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_TRY_TIMES)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] SD card goto IDLE mode timeout!\r\n");
|
|
|
+ result = RT_ETIMEOUT;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ } /* send CMD1 */
|
|
|
+ } /* try MMC */
|
|
|
+ }
|
|
|
+ else if(msd->card_type == MSD_CARD_TYPE_SD_V2_X)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_OCR, 0x00, 0x00, response_r3, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] It maybe SD2.0 But it is Not response to CMD58!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((response[0] & 0xFE) != 0)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] It look CMD58 as illegal command so it is not SD card!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ OCR = response[1];
|
|
|
+ OCR = (OCR<<8) + response[2];
|
|
|
+ OCR = (OCR<<8) + response[3];
|
|
|
+ OCR = (OCR<<8) + response[4];
|
|
|
+ MSD_DEBUG("[info] OCR is 0x%08X\r\n", OCR);
|
|
|
+
|
|
|
+ if( 0 == (OCR & (0x1 << 15)))
|
|
|
+ {
|
|
|
+ MSD_DEBUG(("[err] SD 1.x But not surpport current voltage\r\n"));
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* --Send ACMD41 to make card ready */
|
|
|
+ tick_start = rt_tick_get();
|
|
|
+
|
|
|
+ /* try CMD55 + ACMD41 */
|
|
|
+ do
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ if(rt_tick_timeout(tick_start, rt_tick_from_millisecond(CARD_TRY_TIMES_ACMD41)))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] SD Ver2.x or later try CMD55 + ACMD41 timeout!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* CMD55 APP_CMD */
|
|
|
+ result = _send_cmd(msd->spi_device, APP_CMD, 0x00, 0x65, response_r1, response);
|
|
|
+// if((result != RT_EOK) || (response[0] == 0x01))
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((response[0] & 0xFE) != 0)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] Not SD ready!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* ACMD41 SD_SEND_OP_COND */
|
|
|
+ result = _send_cmd(msd->spi_device, SD_SEND_OP_COND, 0x40000000, 0x77, response_r1, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] ACMD41 fail!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((response[0] & 0xFE) != 0)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[info] Not SD card4 , response : 0x%02X\r\n", response[0]);
|
|
|
+// break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ while(response[0] != MSD_RESPONSE_NO_ERROR);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ /* try CMD55 + ACMD41 */
|
|
|
+
|
|
|
+ /* --Read OCR again */
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, READ_OCR, 0x00, 0x00, response_r3, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] It maybe SD2.0 But it is Not response to 2nd CMD58!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((response[0] & 0xFE) != 0)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] It look 2nd CMD58 as illegal command so it is not SD card!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+
|
|
|
+ OCR = response[1];
|
|
|
+ OCR = (OCR<<8) + response[2];
|
|
|
+ OCR = (OCR<<8) + response[3];
|
|
|
+ OCR = (OCR<<8) + response[4];
|
|
|
+ MSD_DEBUG("[info] OCR 2nd read is 0x%08X\r\n", OCR);
|
|
|
+
|
|
|
+ if((OCR & 0x40000000) != 0)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] It is SD2.0 SDHC Card!!!\r\n");
|
|
|
+ msd->card_type = MSD_CARD_TYPE_SD_SDHC;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] It is SD2.0 standard capacity Card!!!\r\n");
|
|
|
+ }
|
|
|
+ } /* MSD_CARD_TYPE_SD_V2_X */
|
|
|
+ else
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] SD card type unkonw!\r\n");
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ } /* init SD card */
|
|
|
+
|
|
|
+ if(msd->card_type == MSD_CARD_TYPE_SD_SDHC)
|
|
|
+ {
|
|
|
+ dev->read = rt_msd_sdhc_read;
|
|
|
+ dev->write = rt_msd_sdhc_write;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ dev->read = rt_msd_read;
|
|
|
+ dev->write = rt_msd_write;
|
|
|
+ }
|
|
|
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte 0xFF */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
+ /* set CRC */
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+#ifdef MSD_USE_CRC
|
|
|
+ result = _send_cmd(msd->spi_device, CRC_ON_OFF, 0x01, 0x83, response_r1, response);
|
|
|
+#else
|
|
|
+ result = _send_cmd(msd->spi_device, CRC_ON_OFF, 0x00, 0x91, response_r1, response);
|
|
|
+#endif
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD59 CRC_ON_OFF fail! response : 0x%02X\r\n", response[0]);
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ } /* set CRC */
|
|
|
+
|
|
|
+ /* CMD16 SET_BLOCKLEN */
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, SET_BLOCKLEN, SECTOR_SIZE, 0x00, response_r1, response);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD16 SET_BLOCKLEN fail! response : 0x%02X\r\n", response[0]);
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ msd->geometry.block_size = SECTOR_SIZE;
|
|
|
+ msd->geometry.bytes_per_sector = SECTOR_SIZE;
|
|
|
+ }
|
|
|
|
|
|
- return Status;
|
|
|
+ /* read CSD */
|
|
|
+ {
|
|
|
+ uint8_t CSD_buffer[MSD_CSD_LEN];
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+// result = _send_cmd(msd->spi_device, SEND_CSD, 0x00, 0xAF, response_r1, response);
|
|
|
+ result = _send_cmd(msd->spi_device, SEND_CSD, 0x00, 0x00, response_r1, response);
|
|
|
+
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] CMD9 SEND_CSD timeout!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ MSD_DEBUG("[err] CMD9 SEND_CSD fail! response : 0x%02X\r\n", response[0]);
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _read_block(msd->spi_device, CSD_buffer, MSD_CSD_LEN);
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read CSD fail!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Analyze CSD */
|
|
|
+ {
|
|
|
+ uint8_t CSD_STRUCTURE;
|
|
|
+ uint32_t C_SIZE;
|
|
|
+ uint32_t card_capacity;
|
|
|
+
|
|
|
+ uint8_t tmp8;
|
|
|
+ uint16_t tmp16;
|
|
|
+ uint32_t tmp32;
|
|
|
+
|
|
|
+ /* get CSD_STRUCTURE */
|
|
|
+ tmp8 = CSD_buffer[0] & 0xC0; /* 0b11000000 */
|
|
|
+ CSD_STRUCTURE = tmp8 >> 6;
|
|
|
+
|
|
|
+ /* MMC CSD Analyze. */
|
|
|
+ if(msd->card_type == MSD_CARD_TYPE_MMC)
|
|
|
+ {
|
|
|
+ uint8_t C_SIZE_MULT;
|
|
|
+ uint8_t READ_BL_LEN;
|
|
|
+
|
|
|
+ if(CSD_STRUCTURE > 2)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] bad CSD Version : %d\r\n", CSD_STRUCTURE);
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ if(CSD_STRUCTURE == 0)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] CSD version No. 1.0\r\n");
|
|
|
+ }
|
|
|
+ else if(CSD_STRUCTURE == 1)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] CSD version No. 1.1\r\n");
|
|
|
+ }
|
|
|
+ else if(CSD_STRUCTURE == 2)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] CSD version No. 1.2\r\n");
|
|
|
+ }
|
|
|
+
|
|
|
+ /* get TRAN_SPEED 8bit [103:96] */
|
|
|
+ tmp8 = CSD_buffer[3];
|
|
|
+ tmp8 &= 0x03; /* [2:0] transfer rate unit.*/
|
|
|
+ if(tmp8 == 0)
|
|
|
+ {
|
|
|
+ msd->max_clock = 100 * 1000; /* 0=100kbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 1)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1 * 1000 * 1000; /* 1=1Mbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 2)
|
|
|
+ {
|
|
|
+ msd->max_clock = 10 * 1000 * 1000; /* 2=10Mbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 3)
|
|
|
+ {
|
|
|
+ msd->max_clock = 100 * 1000 * 1000; /* 3=100Mbit/s. */
|
|
|
+ }
|
|
|
+ if(tmp8 == 0)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] TRAN_SPEED: 0x%02X, %dkbit/s.\r\n", tmp8, msd->max_clock/1000);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] TRAN_SPEED: 0x%02X, %dMbit/s.\r\n", tmp8, msd->max_clock/1000/1000);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* get READ_BL_LEN 4bit [83:80] */
|
|
|
+ tmp8 = CSD_buffer[5] & 0x0F; /* 0b00001111; */
|
|
|
+ READ_BL_LEN = tmp8; /* 4 bit */
|
|
|
+ MSD_DEBUG("[info] CSD : READ_BL_LEN : %d %dbyte\r\n", READ_BL_LEN, (1 << READ_BL_LEN));
|
|
|
+
|
|
|
+ /* get C_SIZE 12bit [73:62] */
|
|
|
+ tmp16 = CSD_buffer[6] & 0x03; /* get [73:72] 0b00000011 */
|
|
|
+ tmp16 = tmp16<<8;
|
|
|
+ tmp16 += CSD_buffer[7]; /* get [71:64] */
|
|
|
+ tmp16 = tmp16<<2;
|
|
|
+ tmp8 = CSD_buffer[8] & 0xC0; /* get [63:62] 0b11000000 */
|
|
|
+ tmp8 = tmp8>>6;
|
|
|
+ tmp16 = tmp16 + tmp8;
|
|
|
+ C_SIZE = tmp16; //12 bit
|
|
|
+ MSD_DEBUG("[info] CSD : C_SIZE : %d\r\n", C_SIZE);
|
|
|
+
|
|
|
+ /* get C_SIZE_MULT 3bit [49:47] */
|
|
|
+ tmp8 = CSD_buffer[9] & 0x03;//0b00000011;
|
|
|
+ tmp8 = tmp8<<1;
|
|
|
+ tmp8 = tmp8 + ((CSD_buffer[10] & 0x80/*0b10000000*/)>>7);
|
|
|
+ C_SIZE_MULT = tmp8; // 3 bit
|
|
|
+ MSD_DEBUG("[info] CSD : C_SIZE_MULT : %d\r\n", C_SIZE_MULT);
|
|
|
+
|
|
|
+ /* memory capacity = BLOCKNR * BLOCK_LEN */
|
|
|
+ /* BLOCKNR = (C_SIZE+1) * MULT */
|
|
|
+ /* MULT = 2^(C_SIZE_MULT+2) */
|
|
|
+ /* BLOCK_LEN = 2^READ_BL_LEN */
|
|
|
+ card_capacity = (1 << READ_BL_LEN) * ((C_SIZE + 1) * (1 << (C_SIZE_MULT+2)));
|
|
|
+ msd->geometry.sector_count = card_capacity / msd->geometry.bytes_per_sector;
|
|
|
+ MSD_DEBUG("[info] card capacity : %d Mbyte\r\n", card_capacity/(1024*1024));
|
|
|
+ }
|
|
|
+ else /* SD CSD Analyze. */
|
|
|
+ {
|
|
|
+ if(CSD_STRUCTURE == 0)
|
|
|
+ {
|
|
|
+ uint8_t C_SIZE_MULT;
|
|
|
+ uint8_t READ_BL_LEN;
|
|
|
+
|
|
|
+ MSD_DEBUG("[info] CSD Version 1.0\r\n");
|
|
|
+
|
|
|
+ /* get TRAN_SPEED 8bit [103:96] */
|
|
|
+ tmp8 = CSD_buffer[3];
|
|
|
+ if(tmp8 == 0x32)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 10; /* 10Mbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 0x5A)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 50; /* 50Mbit/s. */
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 1; /* 1Mbit/s default. */
|
|
|
+ }
|
|
|
+ MSD_DEBUG("[info] TRAN_SPEED: 0x%02X, %dMbit/s.\r\n", tmp8, msd->max_clock/1000/1000);
|
|
|
+
|
|
|
+ /* get READ_BL_LEN 4bit [83:80] */
|
|
|
+ tmp8 = CSD_buffer[5] & 0x0F; /* 0b00001111; */
|
|
|
+ READ_BL_LEN = tmp8; /* 4 bit */
|
|
|
+ MSD_DEBUG("[info] CSD : READ_BL_LEN : %d %dbyte\r\n", READ_BL_LEN, (1 << READ_BL_LEN));
|
|
|
+
|
|
|
+ /* get C_SIZE 12bit [73:62] */
|
|
|
+ tmp16 = CSD_buffer[6] & 0x03; /* get [73:72] 0b00000011 */
|
|
|
+ tmp16 = tmp16<<8;
|
|
|
+ tmp16 += CSD_buffer[7]; /* get [71:64] */
|
|
|
+ tmp16 = tmp16<<2;
|
|
|
+ tmp8 = CSD_buffer[8] & 0xC0; /* get [63:62] 0b11000000 */
|
|
|
+ tmp8 = tmp8>>6;
|
|
|
+ tmp16 = tmp16 + tmp8;
|
|
|
+ C_SIZE = tmp16; //12 bit
|
|
|
+ MSD_DEBUG("[info] CSD : C_SIZE : %d\r\n", C_SIZE);
|
|
|
+
|
|
|
+ /* get C_SIZE_MULT 3bit [49:47] */
|
|
|
+ tmp8 = CSD_buffer[9] & 0x03;//0b00000011;
|
|
|
+ tmp8 = tmp8<<1;
|
|
|
+ tmp8 = tmp8 + ((CSD_buffer[10] & 0x80/*0b10000000*/)>>7);
|
|
|
+ C_SIZE_MULT = tmp8; // 3 bit
|
|
|
+ MSD_DEBUG("[info] CSD : C_SIZE_MULT : %d\r\n", C_SIZE_MULT);
|
|
|
+
|
|
|
+ /* memory capacity = BLOCKNR * BLOCK_LEN */
|
|
|
+ /* BLOCKNR = (C_SIZE+1) * MULT */
|
|
|
+ /* MULT = 2^(C_SIZE_MULT+2) */
|
|
|
+ /* BLOCK_LEN = 2^READ_BL_LEN */
|
|
|
+ card_capacity = (1 << READ_BL_LEN) * ((C_SIZE + 1) * (1 << (C_SIZE_MULT+2)));
|
|
|
+ msd->geometry.sector_count = card_capacity / msd->geometry.bytes_per_sector;
|
|
|
+ MSD_DEBUG("[info] card capacity : %d Mbyte\r\n", card_capacity/(1024*1024));
|
|
|
+ }
|
|
|
+ else if(CSD_STRUCTURE == 1)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[info] CSD Version 2.0\r\n");
|
|
|
+
|
|
|
+ /* get TRAN_SPEED 8bit [103:96] */
|
|
|
+ tmp8 = CSD_buffer[3];
|
|
|
+ if(tmp8 == 0x32)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 10; /* 10Mbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 0x5A)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 50; /* 50Mbit/s. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 0x0B)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 100; /* 100Mbit/s. */
|
|
|
+ /* UHS50 Card sets TRAN_SPEED to 0Bh (100Mbit/sec), */
|
|
|
+ /* for both SDR50 and DDR50 modes. */
|
|
|
+ }
|
|
|
+ else if(tmp8 == 0x2B)
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 200; /* 200Mbit/s. */
|
|
|
+ /* UHS104 Card sets TRAN_SPEED to 2Bh (200Mbit/sec). */
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ msd->max_clock = 1000 * 1000 * 1; /* 1Mbit/s default. */
|
|
|
+ }
|
|
|
+ MSD_DEBUG("[info] TRAN_SPEED: 0x%02X, %dMbit/s.\r\n", tmp8, msd->max_clock/1000/1000);
|
|
|
+
|
|
|
+ /* get C_SIZE 22bit [69:48] */
|
|
|
+ tmp32 = CSD_buffer[7] & 0x3F; /* 0b00111111 */
|
|
|
+ tmp32 = tmp32<<8;
|
|
|
+ tmp32 += CSD_buffer[8];
|
|
|
+ tmp32 = tmp32<<8;
|
|
|
+ tmp32 += CSD_buffer[9];
|
|
|
+ C_SIZE = tmp32;
|
|
|
+ MSD_DEBUG("[info] CSD : C_SIZE : %d\r\n", C_SIZE);
|
|
|
+
|
|
|
+ /* memory capacity = (C_SIZE+1) * 512K byte */
|
|
|
+ card_capacity = (C_SIZE + 1) / 2; /* unit : Mbyte */
|
|
|
+ msd->geometry.sector_count = card_capacity * 1024; /* 1 Mbyte = 512 byte X 2048 */
|
|
|
+ MSD_DEBUG("[info] card capacity : %d.%d Gbyte\r\n", card_capacity/1024, (card_capacity%1024)*100/1024);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] bad CSD Version : %d\r\n", CSD_STRUCTURE);
|
|
|
+ result = RT_ERROR;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ } /* SD CSD Analyze. */
|
|
|
+ } /* Analyze CSD */
|
|
|
+
|
|
|
+ } /* read CSD */
|
|
|
+
|
|
|
+ /* config spi to high speed */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = msd->max_clock;
|
|
|
+
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
+
|
|
|
+_exit:
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ rt_mutex_release(&(msd->spi_device->bus->lock));
|
|
|
+ return result;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_GoIdleState
|
|
|
-* Description : Put MSD in Idle state.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : The MSD Response: - MSD_RESPONSE_FAILURE: Sequence failed
|
|
|
-* - MSD_RESPONSE_NO_ERROR: Sequence succeed
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_GoIdleState(void)
|
|
|
+static rt_err_t rt_msd_open(rt_device_t dev, rt_uint16_t oflag)
|
|
|
{
|
|
|
- int i;
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- /* Send CMD0 (GO_IDLE_STATE) to put MSD in SPI mode */
|
|
|
- MSD_SendCmd(MSD_GO_IDLE_STATE, 0, 0x95);
|
|
|
-
|
|
|
- /* Wait for In Idle State Response (R1 Format) equal to 0x01 */
|
|
|
- if (MSD_GetResponse(MSD_IN_IDLE_STATE))
|
|
|
- {
|
|
|
- /* No Idle State Response: return response failue */
|
|
|
- return MSD_RESPONSE_FAILURE;
|
|
|
- }
|
|
|
- /*----------Activates the card initialization process-----------*/
|
|
|
- do
|
|
|
- {
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send Dummy byte 0xFF */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
- for (i = 0; i < 0xfff; i++);
|
|
|
-
|
|
|
- /* MSD chip select low */
|
|
|
- MSD_CS_LOW();
|
|
|
- for (i = 0; i < 0xfff; i++);
|
|
|
-
|
|
|
- /* Send CMD1 (Activates the card process) until response equal to 0x0 */
|
|
|
- MSD_SendCmd(MSD_SEND_OP_COND, 0, 0xFF);
|
|
|
- /* Wait for no error Response (R1 Format) equal to 0x00 */
|
|
|
- }
|
|
|
- while (MSD_GetResponse(MSD_RESPONSE_NO_ERROR));
|
|
|
-
|
|
|
- /* MSD chip select high */
|
|
|
- MSD_CS_HIGH();
|
|
|
- /* Send dummy byte 0xFF */
|
|
|
- MSD_WriteByte(DUMMY);
|
|
|
-
|
|
|
- return MSD_RESPONSE_NO_ERROR;
|
|
|
+// struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_WriteByte
|
|
|
-* Description : Write a byte on the MSD.
|
|
|
-* Input : Data: byte to send.
|
|
|
-* Output : None
|
|
|
-* Return : None.
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_WriteByte(u8 Data)
|
|
|
+static rt_err_t rt_msd_close(rt_device_t dev)
|
|
|
{
|
|
|
- /* Wait until the transmit buffer is empty */
|
|
|
- while (SPI_I2S_GetFlagStatus(MSD_SPI, SPI_I2S_FLAG_TXE) == RESET);
|
|
|
- /* Send the byte */
|
|
|
- SPI_I2S_SendData(MSD_SPI, Data);
|
|
|
-
|
|
|
- /* Get the received data */
|
|
|
- Data = SPI_I2S_ReceiveData(MSD_SPI);
|
|
|
-
|
|
|
- return Data;
|
|
|
+// struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : MSD_ReadByte
|
|
|
-* Description : Read a byte from the MSD.
|
|
|
-* Input : None.
|
|
|
-* Output : None
|
|
|
-* Return : The received byte.
|
|
|
-*******************************************************************************/
|
|
|
-u8 MSD_ReadByte(void)
|
|
|
+static rt_size_t rt_msd_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
|
|
{
|
|
|
- u8 Data = 0;
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ uint8_t response[MSD_RESPONSE_MAX_LEN];
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
+
|
|
|
+ result = MSD_take_owner(msd->spi_device);
|
|
|
+
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
|
|
|
- /* Wait until the transmit buffer is empty */
|
|
|
- while (SPI_I2S_GetFlagStatus(MSD_SPI, SPI_I2S_FLAG_TXE) == RESET);
|
|
|
- /* Send the byte */
|
|
|
- SPI_I2S_SendData(MSD_SPI, DUMMY);
|
|
|
+ /* config spi to high speed */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = msd->max_clock;
|
|
|
|
|
|
- /* Wait until a data is received */
|
|
|
- while (SPI_I2S_GetFlagStatus(MSD_SPI, SPI_I2S_FLAG_RXNE) == RESET);
|
|
|
- /* Get the received data */
|
|
|
- Data = SPI_I2S_ReceiveData(MSD_SPI);
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
|
|
|
- /* Return the shifted data */
|
|
|
- return Data;
|
|
|
+ /* SINGLE_BLOCK? */
|
|
|
+ if(size == 1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_SINGLE_BLOCK, pos * msd->geometry.bytes_per_sector, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _read_block(msd->spi_device, buffer, msd->geometry.bytes_per_sector);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if(size > 1)
|
|
|
+ {
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_MULTIPLE_BLOCK, pos * msd->geometry.bytes_per_sector, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ for(i=0; i<size; i++)
|
|
|
+ {
|
|
|
+ result = _read_block(msd->spi_device,
|
|
|
+ (uint8_t *)buffer + msd->geometry.bytes_per_sector * i,
|
|
|
+ msd->geometry.bytes_per_sector);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = i;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* send CMD12 stop transfer */
|
|
|
+ result = _send_cmd(msd->spi_device, STOP_TRANSMISSION, 0x00, 0x00, response_r1b, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK, send stop token fail!\r\n");
|
|
|
+ }
|
|
|
+ } /* READ_MULTIPLE_BLOCK */
|
|
|
+
|
|
|
+_exit:
|
|
|
+ /* release and exit */
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ rt_mutex_release(&(msd->spi_device->bus->lock));
|
|
|
+
|
|
|
+ return size;
|
|
|
}
|
|
|
|
|
|
-/*******************************************************************************
|
|
|
-* Function Name : SPI_Config
|
|
|
-* Description : Initializes the SPI and CS pins.
|
|
|
-* Input : None
|
|
|
-* Output : None
|
|
|
-* Return : None
|
|
|
-*******************************************************************************/
|
|
|
-void SPI_Config(void)
|
|
|
+static rt_size_t rt_msd_sdhc_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
|
|
{
|
|
|
- uint32_t delay;
|
|
|
- GPIO_InitTypeDef GPIO_InitStructure;
|
|
|
- SPI_InitTypeDef SPI_InitStructure;
|
|
|
-
|
|
|
- /* GPIOA and GPIOC Periph clock enable */
|
|
|
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOC | RCC_APB2Periph_AFIO, ENABLE);
|
|
|
- /* SPI Periph clock enable */
|
|
|
- RCC_APB2PeriphClockCmd(MSD_RCC_SPI, ENABLE);
|
|
|
-
|
|
|
- /* Configure SPI pins: SCK, MISO and MOSI */
|
|
|
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_5 | GPIO_Pin_6 | GPIO_Pin_7;
|
|
|
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
|
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
|
|
|
- GPIO_Init(GPIOA, &GPIO_InitStructure);
|
|
|
-
|
|
|
- /* Configure PA4 pin: CS pin, PC4 : SD Power */
|
|
|
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_4;
|
|
|
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
|
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
|
|
|
- GPIO_Init(GPIOA, &GPIO_InitStructure);
|
|
|
-
|
|
|
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_4;
|
|
|
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
|
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
|
|
|
- GPIO_Init(GPIOC, &GPIO_InitStructure);
|
|
|
-
|
|
|
- /* SPI Config */
|
|
|
- SPI_InitStructure.SPI_Direction = SPI_Direction_2Lines_FullDuplex;
|
|
|
- SPI_InitStructure.SPI_Mode = SPI_Mode_Master;
|
|
|
- SPI_InitStructure.SPI_DataSize = SPI_DataSize_8b;
|
|
|
- SPI_InitStructure.SPI_CPOL = SPI_CPOL_High;
|
|
|
- SPI_InitStructure.SPI_CPHA = SPI_CPHA_2Edge;
|
|
|
- SPI_InitStructure.SPI_NSS = SPI_NSS_Soft;
|
|
|
- SPI_InitStructure.SPI_BaudRatePrescaler = SPI_BaudRatePrescaler_4;
|
|
|
- SPI_InitStructure.SPI_FirstBit = SPI_FirstBit_MSB;
|
|
|
- SPI_InitStructure.SPI_CRCPolynomial = 7;
|
|
|
- SPI_Init(MSD_SPI, &SPI_InitStructure);
|
|
|
-
|
|
|
- /* SPI enable */
|
|
|
- SPI_Cmd(MSD_SPI, ENABLE);
|
|
|
-
|
|
|
- /* active SD card */
|
|
|
- GPIO_ResetBits(GPIOC, GPIO_Pin_4);
|
|
|
- for (delay = 0; delay < 0xfffff; delay ++);
|
|
|
-}
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ uint8_t response[MSD_RESPONSE_MAX_LEN];
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
|
|
|
-/******************* (C) COPYRIGHT 2008 STMicroelectronics *****END OF FILE****/
|
|
|
+ result = MSD_take_owner(msd->spi_device);
|
|
|
|
|
|
-/*
|
|
|
- * RT-Thread SD Card Driver
|
|
|
- * 2009-04-17 Bernard first version
|
|
|
- * 2010-07-15 Modify read/write according new block driver interface
|
|
|
- */
|
|
|
-#include <rtthread.h>
|
|
|
-#include <dfs_fs.h>
|
|
|
-
|
|
|
-static struct rt_device sdcard_device;
|
|
|
-static struct dfs_partition part;
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
|
|
|
-#define SECTOR_SIZE 512
|
|
|
+ /* config spi to high speed */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = msd->max_clock;
|
|
|
|
|
|
-/* RT-Thread Device Driver Interface */
|
|
|
-static rt_err_t rt_msd_init(rt_device_t dev)
|
|
|
-{
|
|
|
- sMSD_CSD MSD_csd;
|
|
|
- MSD_GetCSDRegister(&MSD_csd);
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
|
|
|
- return RT_EOK;
|
|
|
+ /* SINGLE_BLOCK? */
|
|
|
+ if(size == 1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_SINGLE_BLOCK, pos, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _read_block(msd->spi_device, buffer, msd->geometry.bytes_per_sector);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if(size > 1)
|
|
|
+ {
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, READ_MULTIPLE_BLOCK, pos, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ for(i=0; i<size; i++)
|
|
|
+ {
|
|
|
+ result = _read_block(msd->spi_device,
|
|
|
+ (uint8_t *)buffer + msd->geometry.bytes_per_sector * i,
|
|
|
+ msd->geometry.bytes_per_sector);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = i;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* send CMD12 stop transfer */
|
|
|
+ result = _send_cmd(msd->spi_device, STOP_TRANSMISSION, 0x00, 0x00, response_r1b, response);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] read READ_MULTIPLE_BLOCK, send stop token fail!\r\n");
|
|
|
+ }
|
|
|
+ } /* READ_MULTIPLE_BLOCK */
|
|
|
+
|
|
|
+_exit:
|
|
|
+ /* release and exit */
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ rt_mutex_release(&(msd->spi_device->bus->lock));
|
|
|
+
|
|
|
+ return size;
|
|
|
}
|
|
|
|
|
|
-static rt_err_t rt_msd_open(rt_device_t dev, rt_uint16_t oflag)
|
|
|
+static rt_size_t rt_msd_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
|
|
{
|
|
|
- return RT_EOK;
|
|
|
-}
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ uint8_t response[MSD_RESPONSE_MAX_LEN];
|
|
|
+ rt_err_t result;
|
|
|
|
|
|
-static rt_err_t rt_msd_close(rt_device_t dev)
|
|
|
-{
|
|
|
- return RT_EOK;
|
|
|
-}
|
|
|
+ result = MSD_take_owner(msd->spi_device);
|
|
|
|
|
|
-static rt_size_t rt_msd_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
|
|
-{
|
|
|
- rt_uint8_t status;
|
|
|
- rt_uint32_t i;
|
|
|
-
|
|
|
- status = MSD_RESPONSE_NO_ERROR;
|
|
|
- // rt_kprintf("read: 0x%x, size %d\n", pos, size);
|
|
|
-
|
|
|
- /* read all sectors */
|
|
|
- for (i = 0; i < size; i ++)
|
|
|
- {
|
|
|
- status = MSD_ReadBlock((rt_uint8_t*)((rt_uint8_t*)buffer + i * SECTOR_SIZE),
|
|
|
- (part.offset + pos + i)* SECTOR_SIZE, SECTOR_SIZE);
|
|
|
- if (status != MSD_RESPONSE_NO_ERROR)
|
|
|
- {
|
|
|
- rt_kprintf("sd card read failed\n");
|
|
|
- return 0;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- if (status == MSD_RESPONSE_NO_ERROR) return size;
|
|
|
-
|
|
|
- rt_kprintf("read failed: %d\n", status);
|
|
|
- return 0;
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] get SPI owner fail!\r\n");
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* config spi to high speed */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = msd->max_clock;
|
|
|
+
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
+
|
|
|
+ /* SINGLE_BLOCK? */
|
|
|
+ if(size == 1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, WRITE_BLOCK, pos * msd->geometry.bytes_per_sector, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD WRITE_BLOCK fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _write_block(msd->spi_device, buffer, msd->geometry.bytes_per_sector, MSD_TOKEN_WRITE_SINGLE_START);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] write SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if(size > 1)
|
|
|
+ {
|
|
|
+ struct rt_spi_message message;
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+#ifdef MSD_USE_PRE_ERASED
|
|
|
+ if(msd->card_type != MSD_CARD_TYPE_MMC)
|
|
|
+ {
|
|
|
+ /* CMD55 APP_CMD */
|
|
|
+ result = _send_cmd(msd->spi_device, APP_CMD, 0x00, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD55 APP_CMD fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* ACMD23 Pre-erased */
|
|
|
+ result = _send_cmd(msd->spi_device, SET_WR_BLK_ERASE_COUNT, size, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] ACMD23 SET_BLOCK_COUNT fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, WRITE_MULTIPLE_BLOCK, pos * msd->geometry.bytes_per_sector, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD WRITE_MULTIPLE_BLOCK fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* write all block */
|
|
|
+ for(i=0; i<size; i++)
|
|
|
+ {
|
|
|
+ result = _write_block(msd->spi_device,
|
|
|
+ (const uint8_t *)buffer + msd->geometry.bytes_per_sector * i,
|
|
|
+ msd->geometry.bytes_per_sector,
|
|
|
+ MSD_TOKEN_WRITE_MULTIPLE_START);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] write SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = i;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ } /* write all block */
|
|
|
+
|
|
|
+ /* send stop token */
|
|
|
+ {
|
|
|
+ uint8_t send_buffer[18];
|
|
|
+
|
|
|
+ rt_memset(send_buffer, DUMMY, sizeof(send_buffer));
|
|
|
+ send_buffer[sizeof(send_buffer) - 1] = MSD_TOKEN_WRITE_MULTIPLE_STOP;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = sizeof(send_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ msd->spi_device->bus->ops->xfer(msd->spi_device, &message);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* wait ready */
|
|
|
+ result = _wait_ready(msd->spi_device);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[warning] wait WRITE_MULTIPLE_BLOCK stop token ready timeout!\r\n");
|
|
|
+ }
|
|
|
+ } /* size > 1 */
|
|
|
+
|
|
|
+_exit:
|
|
|
+ /* release and exit */
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ rt_mutex_release(&(msd->spi_device->bus->lock));
|
|
|
+
|
|
|
+ return size;
|
|
|
}
|
|
|
|
|
|
-static rt_size_t rt_msd_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
|
|
+static rt_size_t rt_msd_sdhc_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
|
|
{
|
|
|
- rt_uint8_t status;
|
|
|
- rt_uint32_t i;
|
|
|
-
|
|
|
- status = MSD_RESPONSE_NO_ERROR;
|
|
|
- // rt_kprintf("write: 0x%x, size %d\n", pos, size);
|
|
|
-
|
|
|
- /* write all sectors */
|
|
|
- for (i = 0; i < size; i ++)
|
|
|
- {
|
|
|
- status = MSD_WriteBuffer((rt_uint8_t*)((rt_uint8_t*)buffer + i * SECTOR_SIZE),
|
|
|
- (part.offset + pos + i)* SECTOR_SIZE, SECTOR_SIZE);
|
|
|
- if (status != MSD_RESPONSE_NO_ERROR)
|
|
|
- {
|
|
|
- rt_kprintf("sd card write failed\n");
|
|
|
- return 0;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- if (status == MSD_RESPONSE_NO_ERROR) return size;
|
|
|
-
|
|
|
- rt_kprintf("write failed: %d\n", status);
|
|
|
- return 0;
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+ uint8_t response[MSD_RESPONSE_MAX_LEN];
|
|
|
+ rt_err_t result;
|
|
|
+
|
|
|
+ result = MSD_take_owner(msd->spi_device);
|
|
|
+
|
|
|
+ if (result != RT_EOK)
|
|
|
+ {
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* config spi to high speed */
|
|
|
+ {
|
|
|
+ struct rt_spi_configuration cfg;
|
|
|
+ cfg.data_width = 8;
|
|
|
+ cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 */
|
|
|
+ cfg.max_hz = msd->max_clock;
|
|
|
+
|
|
|
+ rt_spi_configure(msd->spi_device, &cfg);
|
|
|
+ } /* config spi */
|
|
|
+
|
|
|
+ /* SINGLE_BLOCK? */
|
|
|
+ if(size == 1)
|
|
|
+ {
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+ result = _send_cmd(msd->spi_device, WRITE_BLOCK, pos, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD WRITE_BLOCK fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _write_block(msd->spi_device, buffer, msd->geometry.bytes_per_sector, MSD_TOKEN_WRITE_SINGLE_START);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] write SINGLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = 0;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if(size > 1)
|
|
|
+ {
|
|
|
+ struct rt_spi_message message;
|
|
|
+ uint32_t i;
|
|
|
+
|
|
|
+ MSD_take_cs(msd->spi_device);
|
|
|
+
|
|
|
+#ifdef MSD_USE_PRE_ERASED
|
|
|
+ /* CMD55 APP_CMD */
|
|
|
+ result = _send_cmd(msd->spi_device, APP_CMD, 0x00, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD55 APP_CMD fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* ACMD23 Pre-erased */
|
|
|
+ result = _send_cmd(msd->spi_device, SET_WR_BLK_ERASE_COUNT, size, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] ACMD23 SET_BLOCK_COUNT fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ result = _send_cmd(msd->spi_device, WRITE_MULTIPLE_BLOCK, pos, 0x00, response_r1, response);
|
|
|
+ if((result != RT_EOK) || (response[0] != MSD_RESPONSE_NO_ERROR))
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] CMD WRITE_MULTIPLE_BLOCK fail!\r\n");
|
|
|
+ size = 0;
|
|
|
+ goto _exit;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* write all block */
|
|
|
+ for(i=0; i<size; i++)
|
|
|
+ {
|
|
|
+ result = _write_block(msd->spi_device,
|
|
|
+ (const uint8_t *)buffer + msd->geometry.bytes_per_sector * i,
|
|
|
+ msd->geometry.bytes_per_sector,
|
|
|
+ MSD_TOKEN_WRITE_MULTIPLE_START);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[err] write MULTIPLE_BLOCK #%d fail!\r\n", pos);
|
|
|
+ size = i;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ } /* write all block */
|
|
|
+
|
|
|
+ /* send stop token */
|
|
|
+ {
|
|
|
+ uint8_t send_buffer[18];
|
|
|
+
|
|
|
+ rt_memset(send_buffer, DUMMY, sizeof(send_buffer));
|
|
|
+ send_buffer[sizeof(send_buffer) - 1] = MSD_TOKEN_WRITE_MULTIPLE_STOP;
|
|
|
+
|
|
|
+ /* initial message */
|
|
|
+ message.send_buf = send_buffer;
|
|
|
+ message.recv_buf = RT_NULL;
|
|
|
+ message.length = sizeof(send_buffer);
|
|
|
+ message.cs_take = message.cs_release = 0;
|
|
|
+
|
|
|
+ /* transfer message */
|
|
|
+ msd->spi_device->bus->ops->xfer(msd->spi_device, &message);
|
|
|
+ }
|
|
|
+
|
|
|
+ result = _wait_ready(msd->spi_device);
|
|
|
+ if(result != RT_EOK)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("[warning] wait WRITE_MULTIPLE_BLOCK stop token ready timeout!\r\n");
|
|
|
+ }
|
|
|
+ } /* size > 1 */
|
|
|
+
|
|
|
+_exit:
|
|
|
+ /* release and exit */
|
|
|
+ MSD_release_cs(msd->spi_device);
|
|
|
+ rt_mutex_release(&(msd->spi_device->bus->lock));
|
|
|
+
|
|
|
+ return size;
|
|
|
}
|
|
|
|
|
|
static rt_err_t rt_msd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
|
|
{
|
|
|
+ struct msd_device * msd = (struct msd_device *)dev;
|
|
|
+
|
|
|
RT_ASSERT(dev != RT_NULL);
|
|
|
|
|
|
- return RT_EOK;
|
|
|
+ if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
|
|
|
+ {
|
|
|
+ struct rt_device_blk_geometry *geometry;
|
|
|
+
|
|
|
+ geometry = (struct rt_device_blk_geometry *)args;
|
|
|
+ if (geometry == RT_NULL) return -RT_ERROR;
|
|
|
+
|
|
|
+ geometry->bytes_per_sector = msd->geometry.bytes_per_sector;
|
|
|
+ geometry->block_size = msd->geometry.block_size;
|
|
|
+ geometry->sector_count = msd->geometry.sector_count;
|
|
|
+ }
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
}
|
|
|
|
|
|
-void rt_hw_msd_init()
|
|
|
+rt_err_t msd_init(const char * sd_device_name, const char * spi_device_name)
|
|
|
{
|
|
|
- if (MSD_Init() == MSD_RESPONSE_NO_ERROR)
|
|
|
- {
|
|
|
- rt_uint8_t status;
|
|
|
- rt_uint8_t *sector;
|
|
|
-
|
|
|
- /* register sdcard device */
|
|
|
- sdcard_device.init = rt_msd_init;
|
|
|
- sdcard_device.open = rt_msd_open;
|
|
|
- sdcard_device.close = rt_msd_close;
|
|
|
- sdcard_device.read = rt_msd_read;
|
|
|
- sdcard_device.write = rt_msd_write;
|
|
|
- sdcard_device.control = rt_msd_control;
|
|
|
-
|
|
|
- /* no private */
|
|
|
- sdcard_device.user_data = RT_NULL;
|
|
|
- /* get the first sector to read partition table */
|
|
|
- sector = (rt_uint8_t*) rt_malloc (512);
|
|
|
- if (sector == RT_NULL)
|
|
|
- {
|
|
|
- rt_kprintf("allocate partition sector buffer failed\n");
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- status = MSD_ReadBlock(sector, 0, 512);
|
|
|
- if (status == MSD_RESPONSE_NO_ERROR)
|
|
|
- {
|
|
|
- /* get the first partition */
|
|
|
- status = dfs_filesystem_get_partition(&part, sector, 0);
|
|
|
- if (status != RT_EOK)
|
|
|
- {
|
|
|
- /* there is no partition table */
|
|
|
- part.offset = 0;
|
|
|
- part.size = 0;
|
|
|
- }
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- /* there is no partition table */
|
|
|
- part.offset = 0;
|
|
|
- part.size = 0;
|
|
|
- }
|
|
|
-
|
|
|
- /* release sector buffer */
|
|
|
- rt_free(sector);
|
|
|
-
|
|
|
- rt_device_register(&sdcard_device, "sd0",
|
|
|
- RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_REMOVABLE | RT_DEVICE_FLAG_STANDALONE);
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_kprintf("sdcard init failed\n");
|
|
|
- }
|
|
|
+ rt_err_t result = RT_EOK;
|
|
|
+ struct rt_spi_device * spi_device;
|
|
|
+
|
|
|
+ spi_device = (struct rt_spi_device *)rt_device_find(spi_device_name);
|
|
|
+ if(spi_device == RT_NULL)
|
|
|
+ {
|
|
|
+ MSD_DEBUG("spi device %s not found!\r\n", spi_device_name);
|
|
|
+ return -RT_ENOSYS;
|
|
|
+ }
|
|
|
+ rt_memset(&_msd_device, 0, sizeof(_msd_device));
|
|
|
+ _msd_device.spi_device = spi_device;
|
|
|
+
|
|
|
+ /* register sdcard device */
|
|
|
+ _msd_device.parent.type = RT_Device_Class_Block;
|
|
|
+
|
|
|
+ _msd_device.geometry.bytes_per_sector = 0;
|
|
|
+ _msd_device.geometry.sector_count = 0;
|
|
|
+ _msd_device.geometry.block_size = 0;
|
|
|
+
|
|
|
+ _msd_device.parent.init = rt_msd_init;
|
|
|
+ _msd_device.parent.open = rt_msd_open;
|
|
|
+ _msd_device.parent.close = rt_msd_close;
|
|
|
+ _msd_device.parent.read = RT_NULL;
|
|
|
+ _msd_device.parent.write = RT_NULL;
|
|
|
+ _msd_device.parent.control = rt_msd_control;
|
|
|
+
|
|
|
+ /* no private, no callback */
|
|
|
+ _msd_device.parent.user_data = RT_NULL;
|
|
|
+ _msd_device.parent.rx_indicate = RT_NULL;
|
|
|
+ _msd_device.parent.tx_complete = RT_NULL;
|
|
|
+
|
|
|
+ result = rt_device_register(&_msd_device.parent, sd_device_name,
|
|
|
+ RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_REMOVABLE | RT_DEVICE_FLAG_STANDALONE);
|
|
|
+
|
|
|
+ return result;
|
|
|
}
|