Mfp4: Remove mci_device.c. It should have been removed when it was

      merged ito sd-card.c, but this is an imperfect world.

1 files changed, 0 insertions, 575 deletions

diff --git a/sys/boot/arm/at91/libat91/mci_device.c b/sys/boot/arm/at91/libat91/mci_device.c
deleted file mode 100644
index 5eb6b9f..0000000
--- a/sys/boot/arm/at91/libat91/mci_device.c
+++ /dev/null
@@ -1,575 +0,0 @@
-/*-
- * Copyright (c) 2006 M. Warner Losh.  All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- *    notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- *    notice, this list of conditions and the following disclaimer in the
- *    documentation and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
- * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
- * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
- * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
- * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
- * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
- * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- * This software is derived from software provide by Kwikbyte who specifically
- * disclaimed copyright on the code.
- *
- * $FreeBSD$
- */
-
-//*----------------------------------------------------------------------------
-//*         ATMEL Microcontroller Software Support  -  ROUSSET  -
-//*----------------------------------------------------------------------------
-//* The software is delivered "AS IS" without warranty or condition of any
-//* kind, either express, implied or statutory. This includes without
-//* limitation any warranty or condition with respect to merchantability or
-//* fitness for any particular purpose, or against the infringements of
-//* intellectual property rights of others.
-//*----------------------------------------------------------------------------
-//* File Name           : mci_device.c
-//* Object              : TEST DataFlash Functions
-//* Creation            : FB   26/11/2002
-//*
-//*----------------------------------------------------------------------------
-#include "at91rm9200.h"
-#include "lib_AT91RM9200.h"
-
-#include "mci_device.h"
-
-#include "lib.h"
-
-#define MMC_SUPPORT 0
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SendCommand
-//* \brief Generic function to send a command to the MMC or SDCard
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_SendCommand(
-	unsigned int Cmd,
-	unsigned int Arg)
-{
-	unsigned int	error,status;
-
-	AT91C_BASE_MCI->MCI_ARGR = Arg;
-	AT91C_BASE_MCI->MCI_CMDR = Cmd;
-
-//	printf("CMDR %x ARG %x\n", Cmd, Arg);
-	// wait for CMDRDY Status flag to read the response
-	do
-	{
-		status = AT91C_BASE_MCI->MCI_SR;
-	} while( !(status & AT91C_MCI_CMDRDY) );
-
-	// Test error  ==> if crc error and response R3 ==> don't check error
-	error = (AT91C_BASE_MCI->MCI_SR) & AT91C_MCI_SR_ERROR;
-	if (error != 0 ) {
-		// if the command is SEND_OP_COND the CRC error flag is
-		// always present (cf : R3 response)
-		if ((Cmd != SDCARD_APP_OP_COND_CMD) &&
-		    (Cmd != MMC_SEND_OP_COND_CMD))
-			return ((AT91C_BASE_MCI->MCI_SR) & AT91C_MCI_SR_ERROR);
-		if (error != AT91C_MCI_RCRCE)
-			return ((AT91C_BASE_MCI->MCI_SR) & AT91C_MCI_SR_ERROR);
-	}
-	return AT91C_CMD_SEND_OK;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SDCard_SendAppCommand
-//* \brief Specific function to send a specific command to the SDCard
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_SDCard_SendAppCommand(
-	AT91PS_MciDevice pMCI_Device,
-	unsigned int Cmd_App,
-	unsigned int Arg)
-{
-	unsigned int status;
-
-	// Send the CMD55 for application specific command
-	AT91C_BASE_MCI->MCI_ARGR = (pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address << 16 );
-	AT91C_BASE_MCI->MCI_CMDR = APP_CMD;
-
-	// wait for CMDRDY Status flag to read the response
-	do
-	{
-		status = AT91C_BASE_MCI->MCI_SR;
-	}
-	while( !(status & AT91C_MCI_CMDRDY) );
-
-	// if an error occurs
-	if (((AT91C_BASE_MCI->MCI_SR) & AT91C_MCI_SR_ERROR) != 0 )
-		return ((AT91C_BASE_MCI->MCI_SR) & AT91C_MCI_SR_ERROR);
-
-	return(AT91F_MCI_SendCommand(Cmd_App,Arg));
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_GetStatus
-//* \brief Addressed card sends its status register
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_GetStatus(unsigned int relative_card_address)
-{
-	if (AT91F_MCI_SendCommand(SEND_STATUS_CMD,
-		relative_card_address <<16) == AT91C_CMD_SEND_OK)
-		return (AT91C_BASE_MCI->MCI_RSPR[0]);
-	return AT91C_CMD_SEND_ERROR;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_Device_Handler
-//* \brief MCI C interrupt handler
-//*----------------------------------------------------------------------------
-void
-AT91F_MCI_Device_Handler(
-	AT91PS_MciDevice pMCI_Device,
-	unsigned int status)
-{
-	// If End of Tx Buffer Empty interrupt occurred
-	if (pMCI_Device->pMCI_DeviceDesc->state == AT91C_MCI_TX_SINGLE_BLOCK && status & AT91C_MCI_TXBUFE) {
-		AT91C_BASE_MCI->MCI_IDR = AT91C_MCI_TXBUFE;
- 		AT91C_BASE_PDC_MCI->PDC_PTCR = AT91C_PDC_TXTDIS;
-		pMCI_Device->pMCI_DeviceDesc->state = AT91C_MCI_IDLE;
-	}	// End of if AT91C_MCI_TXBUFF
-
-	// If End of Rx Buffer Full interrupt occurred
-	if (pMCI_Device->pMCI_DeviceDesc->state == AT91C_MCI_RX_SINGLE_BLOCK && status & AT91C_MCI_RXBUFF) {
-		AT91C_BASE_MCI->MCI_IDR = AT91C_MCI_RXBUFF;
- 		AT91C_BASE_PDC_MCI->PDC_PTCR = AT91C_PDC_RXTDIS;
-		pMCI_Device->pMCI_DeviceDesc->state = AT91C_MCI_IDLE;
-	}	// End of if AT91C_MCI_RXBUFF
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_ReadBlock
-//* \brief Read an ENTIRE block or PARTIAL block
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_ReadBlock(
-	AT91PS_MciDevice pMCI_Device,
-	int src,
-	unsigned int *dataBuffer,
-	int sizeToRead)
-{
-	unsigned log2sl = pMCI_Device->pMCI_DeviceFeatures->READ_BL_LEN;
-	unsigned sectorLength = 1 << log2sl;
-
-	///////////////////////////////////////////////////////////////////////
-	if (pMCI_Device->pMCI_DeviceDesc->state != AT91C_MCI_IDLE)
-		return AT91C_READ_ERROR;
-    
-	if ((AT91F_MCI_GetStatus(
-	     pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address) & AT91C_SR_READY_FOR_DATA) == 0)
-		return AT91C_READ_ERROR;
-
-	///////////////////////////////////////////////////////////////////////
-      
-        // Init Mode Register
-	AT91C_BASE_MCI->MCI_MR |= ((sectorLength << 16) | AT91C_MCI_PDCMODE);
-	 
-	sizeToRead = sizeToRead / 4;
-
-	AT91C_BASE_PDC_MCI->PDC_PTCR = (AT91C_PDC_TXTDIS | AT91C_PDC_RXTDIS);
-	AT91C_BASE_PDC_MCI->PDC_RPR  = (unsigned int)dataBuffer;
-	AT91C_BASE_PDC_MCI->PDC_RCR  = sizeToRead;
-
-	// Send the Read single block command
-	if (AT91F_MCI_SendCommand(READ_SINGLE_BLOCK_CMD, src) != AT91C_CMD_SEND_OK)
-		return AT91C_READ_ERROR;
-	pMCI_Device->pMCI_DeviceDesc->state = AT91C_MCI_RX_SINGLE_BLOCK;
-
-	// Enable AT91C_MCI_RXBUFF Interrupt
-	AT91C_BASE_MCI->MCI_IER = AT91C_MCI_RXBUFF;
-
-	// (PDC) Receiver Transfer Enable
-	AT91C_BASE_PDC_MCI->PDC_PTCR = AT91C_PDC_RXTEN;
-	
-	return AT91C_READ_OK;
-}
-
-#if MMC_SUPPORT
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_WriteBlock
-//* \brief  Write an ENTIRE block but not always PARTIAL block !!!
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_WriteBlock(
-	AT91PS_MciDevice pMCI_Device,
-	int dest,
-	unsigned int *dataBuffer,
-	int sizeToWrite )
-{
-	unsigned log2sl = pMCI_Device->pMCI_DeviceFeatures->WRITE_BL_LEN;
-	unsigned sectorLength = 1 << log2sl;
-
-	///////////////////////////////////////////////////////////////////////
-	if( pMCI_Device->pMCI_DeviceDesc->state != AT91C_MCI_IDLE)
-		return AT91C_WRITE_ERROR;
-    
-	if( (AT91F_MCI_GetStatus(pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address) & AT91C_SR_READY_FOR_DATA) == 0)
-		return AT91C_WRITE_ERROR;
-    	
-	if ((dest + sizeToWrite) > pMCI_Device->pMCI_DeviceFeatures->Memory_Capacity)
-		return AT91C_WRITE_ERROR;
-
-    // If source does not fit a begin of a block
-	if ( dest % sectorLength != 0 )
-		return AT91C_WRITE_ERROR;
-   
-    // Test if the MMC supports Partial Write Block 
-	if ((sizeToWrite < sectorLength) 
-	    && (pMCI_Device->pMCI_DeviceFeatures->Write_Partial == 0x00))
-   		return AT91C_WRITE_ERROR;
-   		
-   	if (sizeToWrite > sectorLength)
-   		return AT91C_WRITE_ERROR;
-	///////////////////////////////////////////////////////////////////////
-  
-	// Init Mode Register
-	AT91C_BASE_MCI->MCI_MR |= ((1 << pMCI_Device->pMCI_DeviceFeatures->WRITE_BL_LEN) << 16) | AT91C_MCI_PDCMODE;
-
-	sizeToWrite = sizeToWrite / 4;
-
-	// Init PDC for write sequence
-	AT91C_BASE_PDC_MCI->PDC_PTCR = (AT91C_PDC_TXTDIS | AT91C_PDC_RXTDIS);
-	AT91C_BASE_PDC_MCI->PDC_TPR = (unsigned int) dataBuffer;
-	AT91C_BASE_PDC_MCI->PDC_TCR = sizeToWrite;
-
-	// Send the write single block command
-	if ( AT91F_MCI_SendCommand(WRITE_BLOCK_CMD, dest) != AT91C_CMD_SEND_OK)
-		return AT91C_WRITE_ERROR;
-
-	pMCI_Device->pMCI_DeviceDesc->state = AT91C_MCI_TX_SINGLE_BLOCK;
-
-	// Enable AT91C_MCI_TXBUFE Interrupt
-	AT91C_BASE_MCI->MCI_IER = AT91C_MCI_TXBUFE;
-  
-  	// Enables TX for PDC transfert requests
-	AT91C_BASE_PDC_MCI->PDC_PTCR = AT91C_PDC_TXTEN;
-  
-	return AT91C_WRITE_OK;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_MMC_SelectCard
-//* \brief Toggles a card between the Stand_by and Transfer states or between Programming and Disconnect states
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_MMC_SelectCard(AT91PS_MciDevice pMCI_Device, unsigned int relative_card_address)
-{
-	int status;
-	
-	//* Check if the MMC card chosen is already the selected one
-	status = AT91F_MCI_GetStatus(relative_card_address);
-
-	if (status < 0)
-		return AT91C_CARD_SELECTED_ERROR;
-
-	if ((status & AT91C_SR_CARD_SELECTED) == AT91C_SR_CARD_SELECTED)
-		return AT91C_CARD_SELECTED_OK;
-
-	//* Search for the MMC Card to be selected,
-	// status = the Corresponding Device Number
-	status = 0;
-	while( (pMCI_Device->pMCI_DeviceFeatures[status].Relative_Card_Address != relative_card_address)
-		   && (status < AT91C_MAX_MCI_CARDS) )
-		status++;
-
-	if (status > AT91C_MAX_MCI_CARDS)
-		return AT91C_CARD_SELECTED_ERROR;
-
-	if (AT91F_MCI_SendCommand(SEL_DESEL_CARD_CMD,
-	    pMCI_Device->pMCI_DeviceFeatures[status].Relative_Card_Address << 16) == AT91C_CMD_SEND_OK)
-		return AT91C_CARD_SELECTED_OK;
-	return AT91C_CARD_SELECTED_ERROR;
-}
-#endif
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_GetCSD
-//* \brief Asks to the specified card to send its CSD
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_GetCSD(unsigned int relative_card_address , unsigned int * response)
-{
- 	
- 	if(AT91F_MCI_SendCommand(SEND_CSD_CMD,
-	       (relative_card_address << 16)) != AT91C_CMD_SEND_OK)
-		return AT91C_CMD_SEND_ERROR;
-	
-	response[0] = AT91C_BASE_MCI->MCI_RSPR[0];
-   	response[1] = AT91C_BASE_MCI->MCI_RSPR[1];
-	response[2] = AT91C_BASE_MCI->MCI_RSPR[2];
-	response[3] = AT91C_BASE_MCI->MCI_RSPR[3];
-    
-	return AT91C_CMD_SEND_OK;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SetBlocklength
-//* \brief Select a block length for all following block commands (R/W)
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_SetBlocklength(unsigned int length)
-{
-	return( AT91F_MCI_SendCommand(SET_BLOCKLEN_CMD, length) );
-}
-
-#if MMC_SUPPORT
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_MMC_GetAllOCR
-//* \brief Asks to all cards to send their operations conditions
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_MMC_GetAllOCR()
-{
-	unsigned int	response =0x0;
- 	
- 	while(1) {
-		response = AT91F_MCI_SendCommand(MMC_SEND_OP_COND_CMD,
-		    AT91C_MMC_HOST_VOLTAGE_RANGE);
-		if (response != AT91C_CMD_SEND_OK)
-			return AT91C_INIT_ERROR;
-		response = AT91C_BASE_MCI->MCI_RSPR[0];
-		if ( (response & AT91C_CARD_POWER_UP_BUSY) == AT91C_CARD_POWER_UP_BUSY)
-			return(response);	
-	}
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_MMC_GetAllCID
-//* \brief Asks to the MMC on the chosen slot to send its CID
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_MMC_GetAllCID(AT91PS_MciDevice pMCI_Device, unsigned int *response)
-{
-	int Nb_Cards_Found=-1;
-  
-	while (1) {
-	 	if(AT91F_MCI_SendCommand(MMC_ALL_SEND_CID_CMD,
-		       AT91C_NO_ARGUMENT) != AT91C_CMD_SEND_OK)
-			return Nb_Cards_Found;
-		else {		
-			Nb_Cards_Found = 0;
-			//* Assignation of the relative address to the MMC CARD
-			pMCI_Device->pMCI_DeviceFeatures[Nb_Cards_Found].Relative_Card_Address = Nb_Cards_Found + AT91C_FIRST_RCA;
-			//* Set the insert flag
-			pMCI_Device->pMCI_DeviceFeatures[Nb_Cards_Found].Card_Inserted = AT91C_MMC_CARD_INSERTED;
-	
-			if (AT91F_MCI_SendCommand(
-				MMC_SET_RELATIVE_ADDR_CMD,
-				(Nb_Cards_Found + AT91C_FIRST_RCA) << 16) != AT91C_CMD_SEND_OK)
-				return AT91C_CMD_SEND_ERROR;
-				 
-			//* If no error during assignation address ==> Increment Nb_cards_Found
-			Nb_Cards_Found++ ;
-		}
-	}
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_MMC_Init
-//* \brief Return the MMC initialisation status
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_MMC_Init (AT91PS_MciDevice pMCI_Device)
-{
-	unsigned int	tab_response[4];
-	unsigned int	mult,blocknr;
-	unsigned int 	i,Nb_Cards_Found=0;
-	AT91PS_MciDeviceFeatures f;
-
-	//* Resets all MMC Cards in Idle state
-	AT91F_MCI_SendCommand(MMC_GO_IDLE_STATE_CMD, AT91C_NO_ARGUMENT);
-
-	if (AT91F_MCI_MMC_GetAllOCR(pMCI_Device) == AT91C_INIT_ERROR)
-		return AT91C_INIT_ERROR;
-
-	Nb_Cards_Found = AT91F_MCI_MMC_GetAllCID(pMCI_Device,tab_response);
-	if (Nb_Cards_Found == AT91C_CMD_SEND_ERROR)
-		return AT91C_INIT_ERROR;
-
-	//* Set the Mode Register
-	AT91C_BASE_MCI->MCI_MR = AT91C_MCI_MR_PDCMODE;
-	for(i = 0; i < Nb_Cards_Found; i++) {
-	    	f = pMCI_Device->pMCI_DeviceFeatures + i;
-		if (AT91F_MCI_GetCSD(f->Relative_Card_Address, tab_response) !=
-		    AT91C_CMD_SEND_OK) {
-			f->Relative_Card_Address = 0;
-			continue;
-		}
-		f->READ_BL_LEN = ((tab_response[1] >> CSD_1_RD_B_LEN_S) & CSD_1_RD_B_LEN_M);
-		f->WRITE_BL_LEN = ((tab_response[3] >> CSD_3_WBLEN_S) & CSD_3_WBLEN_M );
-		f->Sector_Size = 1 + ((tab_response[2] >> CSD_2_v22_SECT_SIZE_S) & CSD_2_v22_SECT_SIZE_M );
-		f->Read_Partial = (tab_response[1] >> CSD_1_RD_B_PAR_S) & CSD_1_RD_B_PAR_M;
-		f->Write_Partial = (tab_response[3] >> CSD_3_WBLOCK_P_S) & CSD_3_WBLOCK_P_M;
-				
-		// None in MMC specification version 2.2
-		f->Erase_Block_Enable = 0;
-		f->Read_Block_Misalignment = (tab_response[1] >> CSD_1_RD_B_MIS_S) & CSD_1_RD_B_MIS_M;
-		f->Write_Block_Misalignment = (tab_response[1] >> CSD_1_WR_B_MIS_S) & CSD_1_WR_B_MIS_M;
-			
-		//// Compute Memory Capacity
-		// compute MULT
-		mult = 1 << ( ((tab_response[2] >> CSD_2_C_SIZE_M_S) & CSD_2_C_SIZE_M_M) + 2 );
-		// compute MSB of C_SIZE
-		blocknr = ((tab_response[1] >> CSD_1_CSIZE_H_S) & CSD_1_CSIZE_H_M) << 2;
-		// compute MULT * (LSB of C-SIZE + MSB already computed + 1) = BLOCKNR
-		blocknr = mult * ( ( blocknr + ( (tab_response[2] >> CSD_2_CSIZE_L_S) & CSD_2_CSIZE_L_M) ) + 1 );
-		f->Memory_Capacity =  (1 << f->READ_BL_LEN) * blocknr;
-		//// End of Compute Memory Capacity
-	}
-	// XXX warner hacked this
-	return AT91C_INIT_OK;
-}
-#endif
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SDCard_GetOCR
-//* \brief Asks to all cards to send their operations conditions
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_SDCard_GetOCR (AT91PS_MciDevice pMCI_Device)
-{
-	unsigned int	response =0x0;
-
-	// The RCA to be used for CMD55 in Idle state shall be the card's default RCA=0x0000.
-	pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address = 0x0;
- 	
- 	while( (response & AT91C_CARD_POWER_UP_BUSY) != AT91C_CARD_POWER_UP_BUSY ) {
-		response = AT91F_MCI_SDCard_SendAppCommand(pMCI_Device,
-		    SDCARD_APP_OP_COND_CMD,
-		    AT91C_MMC_HOST_VOLTAGE_RANGE);
-		if (response != AT91C_CMD_SEND_OK)
-			return AT91C_INIT_ERROR;
-		response = AT91C_BASE_MCI->MCI_RSPR[0];
-	}
-	
-	return(AT91C_BASE_MCI->MCI_RSPR[0]);
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SDCard_GetCID
-//* \brief Asks to the SDCard on the chosen slot to send its CID
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_SDCard_GetCID(unsigned int *response)
-{
-	if (AT91F_MCI_SendCommand(ALL_SEND_CID_CMD,
-		AT91C_NO_ARGUMENT) != AT91C_CMD_SEND_OK)
-		return AT91C_CMD_SEND_ERROR;
-	
-	response[0] = AT91C_BASE_MCI->MCI_RSPR[0];
-   	response[1] = AT91C_BASE_MCI->MCI_RSPR[1];
-	response[2] = AT91C_BASE_MCI->MCI_RSPR[2];
-	response[3] = AT91C_BASE_MCI->MCI_RSPR[3];
-    
-	return AT91C_CMD_SEND_OK;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SDCard_SetBusWidth
-//* \brief  Set bus width for SDCard
-//*----------------------------------------------------------------------------
-static AT91S_MCIDeviceStatus
-AT91F_MCI_SDCard_SetBusWidth(AT91PS_MciDevice pMCI_Device)
-{
-	volatile int	ret_value;
-	char			bus_width;
-
-	do {
-		ret_value =AT91F_MCI_GetStatus(pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address);
-	}
-	while((ret_value > 0) && ((ret_value & AT91C_SR_READY_FOR_DATA) == 0));
-
-	// Select Card
-	AT91F_MCI_SendCommand(SEL_DESEL_CARD_CMD,
-	    (pMCI_Device->pMCI_DeviceFeatures->Relative_Card_Address)<<16);
-
-	// Set bus width for Sdcard
-	if (pMCI_Device->pMCI_DeviceDesc->SDCard_bus_width == AT91C_MCI_SCDBUS)
-		bus_width = AT91C_BUS_WIDTH_4BITS;
-	else
-		bus_width = AT91C_BUS_WIDTH_1BIT;
-
-	if (AT91F_MCI_SDCard_SendAppCommand(pMCI_Device,
-	      SDCARD_SET_BUS_WIDTH_CMD,bus_width) != AT91C_CMD_SEND_OK)
-		return AT91C_CMD_SEND_ERROR;
-
-	return AT91C_CMD_SEND_OK;
-}
-
-//*----------------------------------------------------------------------------
-//* \fn    AT91F_MCI_SDCard_Init
-//* \brief Return the SDCard initialisation status
-//*----------------------------------------------------------------------------
-AT91S_MCIDeviceStatus
-AT91F_MCI_SDCard_Init (AT91PS_MciDevice pMCI_Device)
-{
-	unsigned int	tab_response[4];
-	unsigned int	mult,blocknr;
-	AT91PS_MciDeviceFeatures f;
-
-	AT91F_MCI_SendCommand(GO_IDLE_STATE_CMD, AT91C_NO_ARGUMENT);
-
-	if (AT91F_MCI_SDCard_GetOCR(pMCI_Device) == AT91C_INIT_ERROR)
-		return AT91C_INIT_ERROR;
-
-	f = pMCI_Device->pMCI_DeviceFeatures;
-	if (AT91F_MCI_SDCard_GetCID(tab_response) != AT91C_CMD_SEND_OK)
-		return AT91C_INIT_ERROR;
-	f->Card_Inserted = AT91C_SD_CARD_INSERTED;
-	if (AT91F_MCI_SendCommand(SET_RELATIVE_ADDR_CMD, 0) !=
-	    AT91C_CMD_SEND_OK)
-		return AT91C_INIT_ERROR;
-	f->Relative_Card_Address = (AT91C_BASE_MCI->MCI_RSPR[0] >> 16);
-	if (AT91F_MCI_GetCSD(f->Relative_Card_Address,tab_response)
-	    != AT91C_CMD_SEND_OK)
-		return AT91C_INIT_ERROR;
-	f->READ_BL_LEN = (tab_response[1] >> CSD_1_RD_B_LEN_S) &
-	    CSD_1_RD_B_LEN_M;
-	f->WRITE_BL_LEN = (tab_response[3] >> CSD_3_WBLEN_S) &
-	    CSD_3_WBLEN_M;
-	f->Sector_Size = 1 + ((tab_response[2] >> CSD_2_v21_SECT_SIZE_S) &
-	    CSD_2_v21_SECT_SIZE_M);
-	f->Read_Partial = (tab_response[1] >> CSD_1_RD_B_PAR_S) &
-	    CSD_1_RD_B_PAR_M;
-	f->Write_Partial = (tab_response[3] >> CSD_3_WBLOCK_P_S) &
-	    CSD_3_WBLOCK_P_M;
-	f->Erase_Block_Enable = (tab_response[2] >> CSD_2_v21_ER_BLEN_EN_S) &
-	    CSD_2_v21_ER_BLEN_EN_M;
-	f->Read_Block_Misalignment = (tab_response[1] >> CSD_1_RD_B_MIS_S) &
-	    CSD_1_RD_B_MIS_M;
-	f->Write_Block_Misalignment = (tab_response[1] >> CSD_1_WR_B_MIS_S) &
-	    CSD_1_WR_B_MIS_M;
-	//// Compute Memory Capacity
-	// compute MULT
-	mult = 1 << ( ((tab_response[2] >> CSD_2_C_SIZE_M_S) &
-	    CSD_2_C_SIZE_M_M) + 2 );
-	// compute MSB of C_SIZE
-	blocknr = ((tab_response[1] >> CSD_1_CSIZE_H_S) &
-	    CSD_1_CSIZE_H_M) << 2;
-	// compute MULT * (LSB of C-SIZE + MSB already computed + 1) = BLOCKNR
-	blocknr = mult * ((blocknr + ((tab_response[2] >> CSD_2_CSIZE_L_S) &
-	    CSD_2_CSIZE_L_M)) + 1);
-	f->Memory_Capacity = (1 << f->READ_BL_LEN) * blocknr;
-	//// End of Compute Memory Capacity
-	if (AT91F_MCI_SDCard_SetBusWidth(pMCI_Device) != AT91C_CMD_SEND_OK)
-		return AT91C_INIT_ERROR;
-	if (AT91F_MCI_SetBlocklength(1 << f->READ_BL_LEN) != AT91C_CMD_SEND_OK)
-		return AT91C_INIT_ERROR;
-	printf("Found SD card %u bytes\n", f->Memory_Capacity);
-	return AT91C_INIT_OK;
-}