119 lines
3.0 KiB
C
119 lines
3.0 KiB
C
/******************************************************************************
|
|
* Copyright (c) 2012 - 2020 Xilinx, Inc. All rights reserved.
|
|
* SPDX-License-Identifier: MIT
|
|
******************************************************************************/
|
|
|
|
/*****************************************************************************/
|
|
/**
|
|
*
|
|
* @file nor.c
|
|
*
|
|
* Contains code for the NOR FLASH functionality.
|
|
*
|
|
* <pre>
|
|
* MODIFICATION HISTORY:
|
|
*
|
|
* Ver Who Date Changes
|
|
* ----- ---- -------- -------------------------------------------------------
|
|
* 1.00a ecm 01/10/10 Initial release
|
|
* 2.00a mb 25/05/12 mio init removed
|
|
* 3.00a sgd 30/01/13 Code cleanup
|
|
*
|
|
* </pre>
|
|
*
|
|
* @note
|
|
*
|
|
******************************************************************************/
|
|
|
|
/***************************** Include Files *********************************/
|
|
#include "fsbl.h"
|
|
#include "nor.h"
|
|
#include "xstatus.h"
|
|
|
|
/************************** Constant Definitions *****************************/
|
|
|
|
/**************************** Type Definitions *******************************/
|
|
|
|
|
|
/***************** Macros (Inline Functions) Definitions *********************/
|
|
|
|
/************************** Function Prototypes ******************************/
|
|
|
|
/************************** Variable Definitions *****************************/
|
|
|
|
extern u32 FlashReadBaseAddress;
|
|
|
|
/******************************************************************************/
|
|
/******************************************************************************/
|
|
/**
|
|
*
|
|
* This function initializes the controller for the NOR FLASH interface.
|
|
*
|
|
* @param None
|
|
*
|
|
* @return None
|
|
*
|
|
* @note None.
|
|
*
|
|
****************************************************************************/
|
|
void InitNor(void)
|
|
{
|
|
|
|
/*
|
|
* Set up the base address for access
|
|
*/
|
|
FlashReadBaseAddress = XPS_NOR_BASEADDR;
|
|
}
|
|
|
|
/******************************************************************************/
|
|
/**
|
|
*
|
|
* This function provides the NOR FLASH interface for the Simplified header
|
|
* functionality.
|
|
*
|
|
* @param SourceAddress is address in FLASH data space
|
|
* @param DestinationAddress is address in OCM data space
|
|
* @param LengthBytes is the data length to transfer in bytes
|
|
*
|
|
* @return
|
|
* - XST_SUCCESS if the write completes correctly
|
|
* - XST_FAILURE if the write fails to completes correctly
|
|
*
|
|
* @note None.
|
|
*
|
|
****************************************************************************/
|
|
u32 NorAccess(u32 SourceAddress, u32 DestinationAddress, u32 LengthBytes)
|
|
{
|
|
u32 Data;
|
|
u32 Count;
|
|
u32 *SourceAddr;
|
|
u32 *DestAddr;
|
|
u32 LengthWords;
|
|
|
|
/*
|
|
* check for non-word tail
|
|
* add bytes to cover the end
|
|
*/
|
|
if ((LengthBytes%4) != 0){
|
|
|
|
LengthBytes += (4 - (LengthBytes & 0x00000003));
|
|
}
|
|
|
|
LengthWords = LengthBytes >> WORD_LENGTH_SHIFT;
|
|
|
|
SourceAddr = (u32 *)(SourceAddress + FlashReadBaseAddress);
|
|
DestAddr = (u32 *)(DestinationAddress);
|
|
|
|
/*
|
|
* Word transfers, endianism isn't an issue
|
|
*/
|
|
for (Count=0; Count < LengthWords; Count++){
|
|
|
|
Data = Xil_In32((u32)(SourceAddr++));
|
|
Xil_Out32((u32)(DestAddr++), Data);
|
|
}
|
|
|
|
return XST_SUCCESS;
|
|
}
|
|
|