/*
 * FreeRTOS+FAT build 191128 - Note:  FreeRTOS+FAT is still in the lab!
 * Copyright (C) 2018 Amazon.com, Inc. or its affiliates.  All Rights Reserved.
 * Authors include James Walmsley, Hein Tibosch and Richard Barry
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy of
 * this software and associated documentation files (the "Software"), to deal in
 * the Software without restriction, including without limitation the rights to
 * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
 * the Software, and to permit persons to whom the Software is furnished to do so,
 * subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all
 * copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 * https://www.FreeRTOS.org
 *
 */

/* Standard includes. */
#include <stdlib.h>
#include <string.h>
#include <stdarg.h>
#include <stdio.h>

/* Xilinx library includes. */
#include "xparameters.h"
#include "xil_types.h"
#include "xsdps.h"		/* SD device driver */
#include "xsdps_info.h"	/* SD info */

/* FreeRTOS includes. */
#include "FreeRTOS.h"
#include "task.h"
#include "semphr.h"
#include "portmacro.h"

/* FreeRTOS+FAT includes. */
#include "ff_headers.h"
#include "ff_sddisk.h"
#include "ff_sys.h"

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	#include "xil_exception.h"
	#include "xscugic_hw.h"
#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */

#include "uncached_memory.h"

#define sdSIGNATURE 0x41404342

#ifndef ARRAY_SIZE
	#define	ARRAY_SIZE(x)	(int) (sizeof(x)/sizeof(x)[0])
#endif

#define STA_NOINIT		0x01	/* Drive not initialized */
#define STA_NODISK		0x02	/* No medium in the drive */
#define STA_PROTECT		0x04	/* Write protected */

#define SD_DEVICE_ID					XPAR_XSDPS_0_DEVICE_ID
#define HIGH_SPEED_SUPPORT				0x01
#define WIDTH_4_BIT_SUPPORT				0x4
#define SD_CLK_12_MHZ					12000000
#define SD_CLK_25_MHZ					25000000
#define SD_CLK_26_MHZ					26000000
#define SD_CLK_52_MHZ					52000000
#define EXT_CSD_DEVICE_TYPE_BYTE		196
#define EXT_CSD_4_BIT_WIDTH_BYTE		183
#define EXT_CSD_HIGH_SPEED_BYTE			185
#define EXT_CSD_DEVICE_TYPE_HIGH_SPEED	0x3

#define HUNDRED_64_BIT			100ULL
#define BYTES_PER_MB			( 1024ull * 1024ull )
#define SECTORS_PER_MB			( BYTES_PER_MB / 512ull )

#define XSDPS_INTR_NORMAL_ENABLE ( XSDPS_INTR_CC_MASK | XSDPS_INTR_TC_MASK | \
	XSDPS_INTR_DMA_MASK | XSDPS_INTR_CARD_INSRT_MASK | XSDPS_INTR_CARD_REM_MASK | \
	XSDPS_INTR_ERR_MASK )

/* Two defines used to set or clear the interrupt */
#define INTC_BASE_ADDR		XPAR_SCUGIC_CPU_BASEADDR
#define INTC_DIST_BASE_ADDR	XPAR_SCUGIC_DIST_BASEADDR

/* Interupt numbers for SDIO units 0 and 1: */
#define SCUGIC_SDIO_0_INTR	0x38
#define SCUGIC_SDIO_1_INTR	0x4F

/* Define a timeout on data transfers for SDIO: */
#define sdWAIT_INT_TIME_OUT_MS		5000UL

/* Define a short timeout, used during card-detection only (CMD1): */
#define sdQUICK_WAIT_INT_TIME_OUT_MS	1000UL

/* XSdPs xSDCardInstance; */
static XSdPs *pxSDCardInstance;

static int sd_disk_status = STA_NOINIT;	/* Disk status */
const int drive_nr = 0;
static SemaphoreHandle_t xPlusFATMutex;
#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	/* Create a semaphore for each of the two memory-card slots. */
	static SemaphoreHandle_t xSDSemaphores[ 2 ];
#endif

static int vSDMMC_Init( int iDriveNumber );
static int vSDMMC_Status( int iDriveNumber );

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	static void vInstallInterrupt( void );
#endif

struct xCACHE_MEMORY_INFO
{
	/* Reserve 'uncached' memory for caching sectors, will be passed to the +FAT library. */
	uint8_t pucCacheMemory[ 0x10000 ];
	/* Reserve 'uncached' memory for i/o to the SD-card. */
	uint8_t pucHelpMemory[ 0x40000 ];
	XSdPs xSDCardInstance;
};

struct xCACHE_STATS
{
	uint32_t xMemcpyReadCount;
	uint32_t xMemcpyWriteCount;
	uint32_t xPassReadCount;
	uint32_t xPassWriteCount;
	uint32_t xFailReadCount;
	uint32_t xFailWriteCount;
};

struct xCACHE_STATS xCacheStats;
struct xCACHE_MEMORY_INFO *pxCacheMem = NULL;

static const uint8_t *prvStoreSDCardData( const uint8_t *pucBuffer, uint32_t ulByteCount );
static uint8_t *prvReadSDCardData( uint8_t *pucBuffer, uint32_t ulByteCount );

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	void XSdPs_IntrHandler(void *XSdPsPtr);
#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */

static int32_t prvFFRead( uint8_t *pucBuffer, uint32_t ulSectorNumber, uint32_t ulSectorCount, FF_Disk_t *pxDisk )
{
int32_t lReturnCode;
int iResult;
uint8_t *pucReadBuffer;

	if( ( pxDisk != NULL ) &&		/*_RB_ Could this be changed to an assert? */
		( pxDisk->ulSignature == sdSIGNATURE ) &&
		( pxDisk->xStatus.bIsInitialised != pdFALSE ) &&
		( ulSectorNumber < pxDisk->ulNumberOfSectors ) &&
		( pxDisk->ulNumberOfSectors - ulSectorNumber ) >= ulSectorCount )
	{
		iResult = vSDMMC_Status( drive_nr );
		if( ( iResult & STA_NODISK ) != 0 )
		{
			lReturnCode = FF_ERR_DRIVER_NOMEDIUM | FF_ERRFLAG;
			FF_PRINTF( "prvFFRead: NOMEDIUM\n" );
		}
		else if( ( iResult & STA_NOINIT ) != 0 )
		{
			lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_READ | FF_ERRFLAG;
			FF_PRINTF( "prvFFRead: NOINIT\n" );
		}
		else if( ulSectorCount == 0ul )
		{
			lReturnCode = 0;
		}
		else
		{
			/* Convert LBA to byte address if needed */
			if( pxSDCardInstance->HCS == 0 )
			{
				ulSectorNumber *= XSDPS_BLK_SIZE_512_MASK;
			}

			pucReadBuffer = prvReadSDCardData( pucBuffer, 512UL * ulSectorCount );

			if( ucIsCachedMemory( pucReadBuffer ) != pdFALSE )
			{
				xCacheStats.xFailReadCount++;
			}

			iResult  = XSdPs_ReadPolled( pxSDCardInstance, ulSectorNumber, ulSectorCount, pucReadBuffer );
			if( pucBuffer != pucReadBuffer )
			{
				xCacheStats.xMemcpyReadCount++;
				memcpy( pucBuffer, pucReadBuffer, 512 * ulSectorCount );
			}
			else
			{
				xCacheStats.xPassReadCount++;
			}
			if( iResult == XST_SUCCESS )
			{
				lReturnCode = 0l;
			}
			else
			{
				lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_READ | FF_ERRFLAG;
			}
		}
	}
	else
	{
		memset( ( void *) pucBuffer, '\0', ulSectorCount * 512 );

		if( pxDisk->xStatus.bIsInitialised != pdFALSE )
		{
			FF_PRINTF( "prvFFRead: warning: %lu + %lu > %lu\n", ulSectorNumber, ulSectorCount, pxDisk->ulNumberOfSectors );
		}

		lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_READ | FF_ERRFLAG;
	}

	return lReturnCode;
}
/*-----------------------------------------------------------*/

static int32_t prvFFWrite( uint8_t *pucBuffer, uint32_t ulSectorNumber, uint32_t ulSectorCount, FF_Disk_t *pxDisk )
{
int32_t lReturnCode;

	if( ( pxDisk != NULL ) &&
		( pxDisk->ulSignature == sdSIGNATURE ) &&
		( pxDisk->xStatus.bIsInitialised != pdFALSE ) &&
		( ulSectorNumber < pxDisk->ulNumberOfSectors ) &&
		( ( pxDisk->ulNumberOfSectors - ulSectorNumber ) >= ulSectorCount ) )
	{
		int iResult;
		iResult = vSDMMC_Status(drive_nr);

		if( ( iResult & STA_NODISK ) != 0 )
		{
			lReturnCode = FF_ERR_DRIVER_NOMEDIUM | FF_ERRFLAG;
			FF_PRINTF( "prvFFWrite: NOMEDIUM\n" );
		}
		else if( ( iResult & STA_NOINIT ) != 0 )
		{
			lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_WRITE | FF_ERRFLAG;
			FF_PRINTF( "prvFFWrite: NOINIT\n" );
		}
		else
		{
			if( ulSectorCount == 0ul )
			{
				lReturnCode = 0l;
			}
			else
			{
				/* Convert LBA to byte address if needed */
				if (!(pxSDCardInstance->HCS)) ulSectorNumber *= XSDPS_BLK_SIZE_512_MASK;

				pucBuffer = ( uint8_t * )prvStoreSDCardData( pucBuffer, 512UL * ulSectorCount );

				if( ucIsCachedMemory( pucBuffer ) != pdFALSE )
				{
					xCacheStats.xFailWriteCount++;
				}

				iResult = XSdPs_WritePolled( pxSDCardInstance, ulSectorNumber, ulSectorCount, pucBuffer );

				if( iResult == XST_SUCCESS )
				{
					lReturnCode = 0;
				}
				else
				{
					FF_PRINTF( "prvFFWrite[%d]: at 0x%X count %ld : %d\n",
						(int)drive_nr, (unsigned)ulSectorNumber, ulSectorCount, iResult );
					lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_WRITE | FF_ERRFLAG;
				}
			}
		}
	}
	else
	{
		lReturnCode = FF_ERR_IOMAN_OUT_OF_BOUNDS_WRITE | FF_ERRFLAG;
		if( pxDisk->xStatus.bIsInitialised )
		{
			FF_PRINTF( "prvFFWrite::read: warning: %lu + %lu > %lu\n",
				ulSectorNumber, ulSectorCount, pxDisk->ulNumberOfSectors );
		}
	}

	return lReturnCode;
}
/*-----------------------------------------------------------*/

void FF_SDDiskFlush( FF_Disk_t *pxDisk )
{
	if( ( pxDisk != NULL ) &&
		( pxDisk->xStatus.bIsInitialised != pdFALSE ) &&
		( pxDisk->pxIOManager != NULL ) )
	{
		FF_FlushCache( pxDisk->pxIOManager );
	}
}
/*-----------------------------------------------------------*/

static const uint8_t *prvStoreSDCardData( const uint8_t *pucBuffer, uint32_t ulByteCount )
{
const uint8_t *pucReturn;

	if( ( ucIsCachedMemory( pucBuffer ) != pdFALSE ) && ( ulByteCount <= sizeof( pxCacheMem->pucHelpMemory ) ) )
	{
		memcpy( pxCacheMem->pucHelpMemory, pucBuffer, ulByteCount );
		pucReturn = pxCacheMem->pucHelpMemory;
		xCacheStats.xMemcpyWriteCount++;
	}
	else
	{
		pucReturn = pucBuffer;
		xCacheStats.xPassWriteCount++;
	}

	return pucReturn;
}
/*-----------------------------------------------------------*/

static uint8_t *prvReadSDCardData( uint8_t *pucBuffer, uint32_t ulByteCount )
{
uint8_t *pucReturn;

	if( ( ucIsCachedMemory( pucBuffer ) != pdFALSE ) && ( ulByteCount <= sizeof( pxCacheMem->pucHelpMemory ) ) )
	{
		pucReturn = pxCacheMem->pucHelpMemory;
	}
	else
	{
		pucReturn = pucBuffer;
	}

	return pucReturn;
}
/*-----------------------------------------------------------*/

static struct xCACHE_MEMORY_INFO *pucGetSDIOCacheMemory( )
{
	if( pxCacheMem == NULL )
	{
		pxCacheMem = ( struct xCACHE_MEMORY_INFO * ) pucGetUncachedMemory( sizeof( *pxCacheMem ) );
		memset( pxCacheMem, '\0', sizeof( *pxCacheMem ) );
	}
	return pxCacheMem;
}
/*-----------------------------------------------------------*/

/* Initialise the SDIO driver and mount an SD card */
FF_Disk_t *FF_SDDiskInit( const char *pcName )
{
FF_Error_t xFFError;
BaseType_t xPartitionNumber = 0;
FF_CreationParameters_t xParameters;
FF_Disk_t * pxDisk;
#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	int iIndex;
#endif

	pucGetSDIOCacheMemory();

	pxDisk = (FF_Disk_t *)pvPortMalloc( sizeof( *pxDisk ) );
	if( pxDisk == NULL )
	{
		FF_PRINTF( "FF_SDDiskInit: Malloc failed\n" );
	}
	else if( pxCacheMem == NULL )
	{
		FF_PRINTF( "FF_SDDiskInit: Cached memory failed\n" );
	}
	else
	{
		pxSDCardInstance = &( pxCacheMem->xSDCardInstance );

		#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
		{
			for( iIndex = 0; iIndex < ARRAY_SIZE( xSDSemaphores ); iIndex++ )
			{
				if( xSDSemaphores[ iIndex ] == NULL )
				{
					xSDSemaphores[ iIndex ] = xSemaphoreCreateBinary();
					configASSERT( xSDSemaphores[ iIndex ] != NULL );
				}
			}
		}
		#endif

		vSDMMC_Init( 0 );

		/* Initialise the created disk structure. */
		memset( pxDisk, '\0', sizeof( *pxDisk ) );

		pxDisk->ulNumberOfSectors = myCSD.sd_last_block_address + 1;

		if( xPlusFATMutex == NULL )
		{
			xPlusFATMutex = xSemaphoreCreateRecursiveMutex();
		}
		pxDisk->ulSignature = sdSIGNATURE;

		if( xPlusFATMutex != NULL)
		{
			memset( &xParameters, '\0', sizeof( xParameters ) );
			xParameters.pucCacheMemory = pxCacheMem->pucCacheMemory;
			xParameters.ulMemorySize = sizeof( pxCacheMem->pucCacheMemory );
			xParameters.ulSectorSize = 512;
			xParameters.fnWriteBlocks = prvFFWrite;
			xParameters.fnReadBlocks = prvFFRead;
			xParameters.pxDisk = pxDisk;

			/* prvFFRead()/prvFFWrite() are not re-entrant and must be protected with
			the use of a semaphore. */
			xParameters.xBlockDeviceIsReentrant = pdFALSE;

			/* The semaphore will be used to protect critical sections in the +FAT driver,
			and also to avoid concurrent calls to prvFFRead()/prvFFWrite() from different tasks. */
			xParameters.pvSemaphore = ( void * ) xPlusFATMutex;

			pxDisk->pxIOManager = FF_CreateIOManger( &xParameters, &xFFError );
			if( pxDisk->pxIOManager == NULL )
			{
				FF_PRINTF( "FF_SDDiskInit: FF_CreateIOManger: %s\n", (const char*)FF_GetErrMessage( xFFError ) );
				FF_SDDiskDelete( pxDisk );
				pxDisk = NULL;
			}
			else
			{
				pxDisk->xStatus.bIsInitialised = pdTRUE;
				pxDisk->xStatus.bPartitionNumber = xPartitionNumber;

				if( FF_SDDiskMount( pxDisk ) == 0 )
				{
					FF_SDDiskDelete( pxDisk );
					pxDisk = NULL;
				}
				else
				{
					if( pcName == NULL )
					{
						pcName = "/";
					}

					FF_FS_Add( pcName, pxDisk );
					FF_PRINTF( "FF_SDDiskInit: Mounted SD-card as root \"%s\"\n", pcName );
					FF_SDDiskShowPartition( pxDisk );
				}
			}
		}
	}

	return pxDisk;
}
/*-----------------------------------------------------------*/

BaseType_t FF_SDDiskFormat( FF_Disk_t *pxDisk, BaseType_t aPart )
{
FF_Error_t xError;
BaseType_t xReturn = 0;

	FF_SDDiskUnmount( pxDisk );
	{
		/* Format the drive */
		xError = FF_Format( pxDisk, aPart, pdFALSE, pdFALSE);  // Try FAT32 with large clusters
		if( FF_isERR( xError ) )
		{
			FF_PRINTF( "FF_SDDiskFormat: %s\n", (const char*)FF_GetErrMessage( xError ) );
			return 0;
		}
		else
		{
			FF_PRINTF( "FF_SDDiskFormat: OK, now remounting\n" );
			pxDisk->xStatus.bPartitionNumber = aPart;
			xError = FF_SDDiskMount( pxDisk );
			FF_PRINTF( "FF_SDDiskFormat: rc %08x\n", ( unsigned )xError );
			if( FF_isERR( xError ) == pdFALSE )
			{
				xReturn = 1;
				FF_SDDiskShowPartition( pxDisk );
			}
		}
	}
	return xReturn;
}
/*-----------------------------------------------------------*/

/* Unmount the volume */
BaseType_t FF_SDDiskUnmount( FF_Disk_t *pxDisk )
{
FF_Error_t xFFError;
BaseType_t xReturn = 1;

	if( ( pxDisk != NULL ) && ( pxDisk->xStatus.bIsMounted != pdFALSE ) )
	{
		pxDisk->xStatus.bIsMounted = pdFALSE;
		xFFError = FF_Unmount( pxDisk );
		FF_PRINTF( "FF_SDDiskUnmount: rc %08x\n", ( unsigned )xFFError );
		if( FF_isERR( xFFError ) )
		{
			xReturn = 0;
		}
		else
		{
			FF_PRINTF( "Drive unmounted\n" );
		}
	}

	return xReturn;
}
/*-----------------------------------------------------------*/

BaseType_t FF_SDDiskReinit( FF_Disk_t *pxDisk )
{
int iStatus = vSDMMC_Init( 0 ); /* Hard coded index. */

	/*_RB_ parameter not used. */
	( void ) pxDisk;

	FF_PRINTF( "FF_SDDiskReinit: rc %08x\n", ( unsigned )iStatus );
	return iStatus;
}
/*-----------------------------------------------------------*/

BaseType_t FF_SDDiskMount( FF_Disk_t *pxDisk )
{
FF_Error_t xFFError;
BaseType_t xReturn = 1;

	/* Mount the partition */
	xFFError = FF_Mount( pxDisk, pxDisk->xStatus.bPartitionNumber );

	if( FF_isERR( xFFError ) )
	{
		FF_PRINTF( "FF_SDDiskMount: %08lX\n", xFFError );
		xReturn = 0;
	}
	else
	{
		pxDisk->xStatus.bIsMounted = pdTRUE;
		FF_PRINTF( "****** FreeRTOS+FAT initialized %lu sectors\n", pxDisk->pxIOManager->xPartition.ulTotalSectors );
	}

	return xReturn;
}
/*-----------------------------------------------------------*/

/* Get a pointer to IOMAN, which can be used for all FreeRTOS+FAT functions */
FF_IOManager_t *sddisk_ioman( FF_Disk_t *pxDisk )
{
FF_IOManager_t *pxReturn;

	if( ( pxDisk != NULL ) && ( pxDisk->xStatus.bIsInitialised != pdFALSE ) )
	{
		pxReturn = pxDisk->pxIOManager;
	}
	else
	{
		pxReturn = NULL;
	}
	return pxReturn;
}
/*-----------------------------------------------------------*/

/* Release all resources */
BaseType_t FF_SDDiskDelete( FF_Disk_t *pxDisk )
{
	if( pxDisk != NULL )
	{
		pxDisk->ulSignature = 0;
		pxDisk->xStatus.bIsInitialised = 0;
		if( pxDisk->pxIOManager != NULL )
		{
			if( FF_Mounted( pxDisk->pxIOManager ) != pdFALSE )
			{
				FF_Unmount( pxDisk );
			}
			FF_DeleteIOManager( pxDisk->pxIOManager );
		}

		vPortFree( pxDisk );
	}
	return 1;
}
/*-----------------------------------------------------------*/

BaseType_t FF_SDDiskShowPartition( FF_Disk_t *pxDisk )
{
FF_Error_t xError;
uint64_t ullFreeSectors;
uint32_t ulTotalSizeMB, ulFreeSizeMB;
int iPercentageFree;
FF_IOManager_t *pxIOManager;
const char *pcTypeName = "unknown type";
BaseType_t xReturn = pdPASS;

	if( pxDisk == NULL )
	{
		xReturn = pdFAIL;
	}
	else
	{
		pxIOManager = pxDisk->pxIOManager;

		FF_PRINTF( "Reading FAT and calculating Free Space\n" );

		switch( pxIOManager->xPartition.ucType )
		{
			case FF_T_FAT12:
				pcTypeName = "FAT12";
				break;

			case FF_T_FAT16:
				pcTypeName = "FAT16";
				break;

			case FF_T_FAT32:
				pcTypeName = "FAT32";
				break;

			default:
				pcTypeName = "UNKOWN";
				break;
		}

		FF_GetFreeSize( pxIOManager, &xError );

		ullFreeSectors = pxIOManager->xPartition.ulFreeClusterCount * pxIOManager->xPartition.ulSectorsPerCluster;
		iPercentageFree = ( int ) ( ( HUNDRED_64_BIT * ullFreeSectors + pxIOManager->xPartition.ulDataSectors / 2 ) /
			( ( uint64_t )pxIOManager->xPartition.ulDataSectors ) );

		ulTotalSizeMB = pxIOManager->xPartition.ulDataSectors / SECTORS_PER_MB;
		ulFreeSizeMB = ( uint32_t ) ( ullFreeSectors / SECTORS_PER_MB );

		/* It is better not to use the 64-bit format such as %Lu because it
		might not be implemented. */
		FF_PRINTF( "Partition Nr   %8u\n", pxDisk->xStatus.bPartitionNumber );
		FF_PRINTF( "Type           %8u (%s)\n", pxIOManager->xPartition.ucType, pcTypeName );
		FF_PRINTF( "VolLabel       '%8s' \n", pxIOManager->xPartition.pcVolumeLabel );
		FF_PRINTF( "TotalSectors   %8lu\n", pxIOManager->xPartition.ulTotalSectors );
		FF_PRINTF( "DataSectors    %8lu\n", pxIOManager->xPartition.ulDataSectors );
		FF_PRINTF( "SecsPerCluster %8lu\n", pxIOManager->xPartition.ulSectorsPerCluster );
		FF_PRINTF( "Size           %8lu MB\n", ulTotalSizeMB );
		FF_PRINTF( "FreeSize       %8lu MB ( %d perc free )\n", ulFreeSizeMB, iPercentageFree );
		FF_PRINTF( "BeginLBA       %8lu\n", pxIOManager->xPartition.ulBeginLBA );
		FF_PRINTF( "FATBeginLBA    %8lu\n", pxIOManager->xPartition.ulFATBeginLBA );
	}

	return xReturn;
}
/*-----------------------------------------------------------*/

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	static void vInstallInterrupt( void )
	{
		/* Install an interrupt handler for SDIO_0 */
		XScuGic_RegisterHandler( INTC_BASE_ADDR, SCUGIC_SDIO_0_INTR,
			( Xil_ExceptionHandler )XSdPs_IntrHandler,
			( void * )pxSDCardInstance );

		/* Enable this interrupt. */
		XScuGic_EnableIntr( INTC_DIST_BASE_ADDR, SCUGIC_SDIO_0_INTR );

		/* Choose the signals. */
		XSdPs_WriteReg16(pxSDCardInstance->Config.BaseAddress,
				XSDPS_NORM_INTR_SIG_EN_OFFSET,
				XSDPS_INTR_NORMAL_ENABLE );
		XSdPs_WriteReg16(pxSDCardInstance->Config.BaseAddress,
				XSDPS_ERR_INTR_SIG_EN_OFFSET,
				0x0 );
	}
#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */
/*-----------------------------------------------------------*/

static int vSDMMC_Init( int iDriveNumber )
{
int iReturnCode, iStatus;
XSdPs_Config *SdConfig;

	/*_RB_ Function name not following convention, parameter not used, parameter
	using plain int type. */


	/* Open a do {} while(0) loop to allow the use of break. */
	do
	{
		/* Check if card is in the socket */
		iStatus = vSDMMC_Status( iDriveNumber );
		if( ( iStatus & STA_NODISK ) != 0 )
		{
			break;
		}

		/* Assume that the initialisation will fail: set the 'STA_NOINIT' bit. */
		iStatus |= STA_NOINIT;

		/* Initialize the host controller */
		SdConfig = XSdPs_LookupConfig(SD_DEVICE_ID);
		if( SdConfig == NULL )
		{
			break;
		}

		iReturnCode = XSdPs_CfgInitialize(pxSDCardInstance, SdConfig, SdConfig->BaseAddress);
		if( iReturnCode != XST_SUCCESS )
		{
			break;
		}

		#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
		{
			vInstallInterrupt();
		}
		#endif	/* ffconfigSDIO_DRIVER_USES_INTERRUPT */
		iReturnCode = XSdPs_CardInitialize( pxSDCardInstance );
		if( iReturnCode != XST_SUCCESS )
		{
			break;
		}

		/* Disk is initialized OK: clear the 'STA_NOINIT' bit. */
		iStatus &= ~( STA_NOINIT );
	} while( 0 );

	sd_disk_status = iStatus;

	return iStatus;
}
/*-----------------------------------------------------------*/

static int vSDMMC_Status( int iDriveNumber )
{
int iStatus = sd_disk_status;
u32 ulStatusReg;

	/*_RB_ Function name not following convention, parameter not used, parameter
	using plain int type. */
	( void ) iDriveNumber;

	ulStatusReg = XSdPs_GetPresentStatusReg( XPAR_XSDPS_0_BASEADDR );
	if( ( ulStatusReg & XSDPS_PSR_CARD_INSRT_MASK ) == 0 )
	{
		iStatus = STA_NODISK | STA_NOINIT;
	}
	else
	{
		iStatus &= ~STA_NODISK;
		if( ( ulStatusReg & XSDPS_PSR_WPS_PL_MASK ) != 0 )
		{
			iStatus &= ~STA_PROTECT;
		}
		else
		{
			iStatus |= STA_PROTECT;
		}
	}

	sd_disk_status = iStatus;
	return iStatus;
}
/*-----------------------------------------------------------*/

BaseType_t FF_SDDiskInserted( BaseType_t xDriveNr )
{
BaseType_t xReturn;
int iStatus;

	/* Check if card is in the socket */
	iStatus = vSDMMC_Status( xDriveNr );
	if( ( iStatus & STA_NODISK ) != 0 )
	{
		xReturn = pdFALSE;
	}
	else
	{
		xReturn = pdTRUE;
	}

	return xReturn;
}

volatile unsigned sd_int_count = 0;

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	volatile u32 ulSDInterruptStatus[2];

	void XSdPs_IntrHandler(void *XSdPsPtr)
	{
	XSdPs *InstancePtr = (XSdPs *)XSdPsPtr;
	int iIndex = InstancePtr->Config.DeviceId;
	uint32_t ulStatusReg;

		configASSERT( iIndex <= 1 );
		sd_int_count++;

		/* Read the current status. */
		ulStatusReg = XSdPs_ReadReg( InstancePtr->Config.BaseAddress, XSDPS_NORM_INTR_STS_OFFSET );

		/* Write to clear error bits. */
		XSdPs_WriteReg( InstancePtr->Config.BaseAddress, XSDPS_NORM_INTR_STS_OFFSET, ulStatusReg );

		/* The new value must be OR-ed, if not the
		Command Complete (CC) event might get overwritten
		by the Transfer Complete (TC) event. */
		ulSDInterruptStatus[ iIndex ] |= ulStatusReg;

		if( ( ulStatusReg & ( XSDPS_INTR_CARD_INSRT_MASK | XSDPS_INTR_CARD_REM_MASK ) ) != 0 )
		{
			/* Could wake-up another task. */
		}
		if( xSDSemaphores[ iIndex ] != NULL )
		{
		BaseType_t xHigherPriorityTaskWoken = pdFALSE;

			xSemaphoreGiveFromISR( xSDSemaphores[ iIndex ], &xHigherPriorityTaskWoken );
			if( xHigherPriorityTaskWoken != 0 )
			{
				portYIELD_FROM_ISR( xHigherPriorityTaskWoken );
			}
		}
	}
#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */
/*-----------------------------------------------------------*/

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	void XSdPs_ClearInterrupt( XSdPs *InstancePtr )
	{
	int iIndex = InstancePtr->Config.DeviceId;

		configASSERT( iIndex <= 1 );
		ulSDInterruptStatus[ iIndex ] = 0;
	}
#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */
/*-----------------------------------------------------------*/

#if( ffconfigSDIO_DRIVER_USES_INTERRUPT != 0 )
	/* Wait for an interrupt and return the 32 bits of the status register.
	A return value of 0 means: time-out. */
	u32 XSdPs_WaitInterrupt( XSdPs *InstancePtr, u32 ulMask, u32 ulWait )
	{
	u32 ulStatusReg;
	int iIndex = InstancePtr->Config.DeviceId;
	TickType_t xRemainingTime = pdMS_TO_TICKS( sdWAIT_INT_TIME_OUT_MS );
	TimeOut_t xTimeOut;

		if( ulWait == 0UL )
		{
			xRemainingTime = pdMS_TO_TICKS( sdQUICK_WAIT_INT_TIME_OUT_MS );
		}

		configASSERT( iIndex <= 1 );
		configASSERT( xSDSemaphores[ iIndex ] != 0 );
		vTaskSetTimeOutState( &xTimeOut );
		/* Loop until:
		1. Expected bit (ulMask) becomes high
		2. Time-out reached (normally 2 seconds)
		*/
		do
		{
			if( xRemainingTime != 0 )
			{
				xSemaphoreTake( xSDSemaphores[ iIndex ], xRemainingTime );
			}
			ulStatusReg = ulSDInterruptStatus[ iIndex ];
			if( ( ulStatusReg & XSDPS_INTR_ERR_MASK ) != 0 )
			{
				break;
			}
		}
		while( ( xTaskCheckForTimeOut( &xTimeOut, &xRemainingTime ) == pdFALSE ) &&
			   ( ( ulStatusReg & ulMask ) == 0 ) );

		if( ( ulStatusReg & ulMask ) == 0 )
		{
		ulStatusReg = XSdPs_ReadReg( InstancePtr->Config.BaseAddress, XSDPS_NORM_INTR_STS_OFFSET );
			if( ulWait != 0UL )
			{
				FF_PRINTF( "XSdPs_WaitInterrupt[ %d ]: Got %08lx, expect %08lx ints: %d\n",
					iIndex,
					ulStatusReg,
					ulMask,
					sd_int_count );
			}
		}

		return ulStatusReg;
	}

#endif /* ffconfigSDIO_DRIVER_USES_INTERRUPT */
/*-----------------------------------------------------------*/