Xilinx FSBL 代碼簡析

前言

在分析ZYNQ7000啓動流程時，發現FSBL工程在其中起到了非常重要的作用。參考了許多別人分析的過程，在這裏也總結一下自己的代碼分析流程。如有問題，歡迎指正。

1. 在FSBL工程中首先找到main函數，第一眼看到的就是ps7_init()；從註釋可以看到這裏是對MIO, PLL, CLK, DDR進行初始化。

int main(void)
{
u32 BootModeRegister = 0;
u32 HandoffAddress = 0;
u32 Status = XST_SUCCESS;
/*
* PCW initialization for MIO,PLL,CLK and DDR
*/
Status = ps7_init();
if (Status != FSBL_PS7_INIT_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"PS7_INIT_FAIL : %s\r\n",
getPS7MessageInfo(Status));
OutputStatus(PS7_INIT_FAIL);
/*
* Calling FsblHookFallback instead of Fallback
* since, devcfg driver is not yet initialized
*/
FsblHookFallback();
}

2. 進入到函數ps7_init();中也可以看到這裏通過識別PS_VERSION對外設首先進行初始化

// MIO init
ret = ps7_config (ps7_mio_init_data);
if (ret != PS7_INIT_SUCCESS) return ret;
// PLL init
ret = ps7_config (ps7_pll_init_data);
if (ret != PS7_INIT_SUCCESS) return ret;
// Clock init
ret = ps7_config (ps7_clock_init_data);
if (ret != PS7_INIT_SUCCESS) return ret;
// DDR init
ret = ps7_config (ps7_ddr_init_data);
if (ret != PS7_INIT_SUCCESS) return ret;
// Peripherals init
ret = ps7_config (ps7_peripherals_init_data);
if (ret != PS7_INIT_SUCCESS) return ret;
//xil_printf ("\n PCW Silicon Version : %d.0", pcw_ver);
return PS7_INIT_SUCCESS;

3. 接下來在main函數中清cache關cache以及註冊異常處理函數

/*
* Flush the Caches
*/
Xil_DCacheFlush();
/*
* Disable Data Cache
*/
Xil_DCacheDisable();
/*
* Register the Exception handlers
*/
RegisterHandlers();

4. DDR初始化完成後，在該函數中對DDR進行基本的讀寫測試

u32 DDRInitCheck(void)
{
u32 ReadVal;
/*
* Write and Read from the DDR location for sanity checks
*/
Xil_Out32(DDR_START_ADDR, DDR_TEST_PATTERN);
ReadVal = Xil_In32(DDR_START_ADDR);
if (ReadVal != DDR_TEST_PATTERN) {
return XST_FAILURE;
}
/*
* Write and Read from the DDR location for sanity checks
*/
Xil_Out32(DDR_START_ADDR + DDR_TEST_OFFSET, DDR_TEST_PATTERN);
ReadVal = Xil_In32(DDR_START_ADDR + DDR_TEST_OFFSET);
if (ReadVal != DDR_TEST_PATTERN) {
return XST_FAILURE;
}
return XST_SUCCESS;
}

5. PCAP的初始化，這裏不太清楚具體是什麼設備。

/*
* PCAP initialization
*/
Status = InitPcap();
if (Status == XST_FAILURE) {
fsbl_printf(DEBUG_GENERAL,"PCAP_INIT_FAIL \n\r");
OutputStatus(PCAP_INIT_FAIL);
/*
* Calling FsblHookFallback instead of Fallback
* since, devcfg driver is not yet initialized
*/
FsblHookFallback();
}
fsbl_printf(DEBUG_INFO,"Devcfg driver initialized \r\n");

6. 從當前抓到的log版本號爲：Silicon Version 3.1

void GetSiliconVersion(void)
{
/*
* Get the silicon version
*/
Silicon_Version = XDcfg_GetPsVersion(DcfgInstPtr);
if(Silicon_Version == SILICON_VERSION_3_1) {
fsbl_printf(DEBUG_GENERAL,"Silicon Version 3.1\r\n");
} else {
fsbl_printf(DEBUG_GENERAL,"Silicon Version %lu.0\r\n",
Silicon_Version + 1);
}
}

7. 函數MarkFSBLIn()中設置了REBOOT_STATE，從寄存器BOOT_MODE_REG(0xF8000000U + 0x25C)的低3bit獲取啓動模式。

/*
* Store FSBL run state in Reboot Status Register
*/
MarkFSBLIn();
/*
* Read bootmode register
*/
BootModeRegister = Xil_In32(BOOT_MODE_REG);
BootModeRegister &= BOOT_MODES_MASK;

8. 基於目前調試的ZYNQ7000有以下幾種啓動模式，在這裏我們重點關注以QSPI模式啓動

/*
* Boot Modes
*/
#define JTAG_MODE 0x00000000 /**< JTAG Boot Mode */
#define QSPI_MODE 0x00000001 /**< QSPI Boot Mode */
#define NOR_FLASH_MODE 0x00000002 /**< NOR Boot Mode */
#define NAND_FLASH_MODE 0x00000004 /**< NAND Boot Mode */
#define SD_MODE 0x00000005 /**< SD Boot Mode */
#define MMC_MODE 0x00000006 /**< MMC Boot Device */

9. 從代碼中可以看出在判斷啓動模式爲QSPI模式後，做了兩件事

if (BootModeRegister == QSPI_MODE) {
fsbl_printf(DEBUG_GENERAL,"Boot mode is QSPI\n\r");
InitQspi();
MoveImage = QspiAccess;
fsbl_printf(DEBUG_INFO,"QSPI Init Done \r\n");
} else

（1）首先對QSPI進行初始化，這裏我們簡單的過一下QSPI初始化的代碼

u32 InitQspi(void)
{
XQspiPs_Config *QspiConfig;
int Status;
u32 ConfigCmd;
QspiInstancePtr = &QspiInstance;
/*
* Set up the base address for access
*/
FlashReadBaseAddress = XPS_QSPI_LINEAR_BASEADDR; // 表示QSPI Flash的基地址，從SDK中hdf文件中可以得到相應的硬件配置信息
/*
* Initialize the QSPI driver so that it's ready to use
*/
QspiConfig = XQspiPs_LookupConfig(QSPI_DEVICE_ID);
if (NULL == QspiConfig) {
return XST_FAILURE;
}
Status = XQspiPs_CfgInitialize(QspiInstancePtr, QspiConfig,
QspiConfig->BaseAddress);
if (Status != XST_SUCCESS) {
return XST_FAILURE;
}
/*
* Set Manual Chip select options and drive HOLD_B pin high.
*/
XQspiPs_SetOptions(QspiInstancePtr, XQSPIPS_FORCE_SSELECT_OPTION |
XQSPIPS_HOLD_B_DRIVE_OPTION);
/*
* Set the prescaler for QSPI clock
*/
XQspiPs_SetClkPrescaler(QspiInstancePtr, XQSPIPS_CLK_PRESCALE_8);
/*
* Assert the FLASH chip select.
*/
XQspiPs_SetSlaveSelect(QspiInstancePtr);
/*
* Read Flash ID and extract Manufacture and Size information
*/
Status = FlashReadID(); // 該函數非常重要，用來獲取flash的製造廠商及size信息。
if (Status != XST_SUCCESS) {
return XST_FAILURE;
}

從獲取的log信息看當前flash信息如下：

Single Flash Information

FlashID=0x20 0xBB 0x19

MICRON 256M Bits

QSPI is in single flash connection

QSPI is in 4-bit mode

QSPI Init Done

符合我們拿到的flash芯片手冊：【N25q256.pdf】

做完以上這些以後，根據拿到的器件信息設置了QSPI Flash的IO模式並使能了控制器。以上完成QSPI Flash的初始化操作

（2）函數指針賦值，把QspiAccess賦值給MoveImage

這裏我們主要關注MoveImage()函數。結合函數的註釋和函數中的主要代碼（即memcpy函數)該函數實現了從flash上搬移一定大小的數據到內存固定的地址上去。

/******************************************************************************/
/**
*
* This function provides the QSPI FLASH interface for the Simplified header
* functionality.
*
* @param SourceAddress is address in FLASH data space
* @param DestinationAddress is address in DDR data space
* @param LengthBytes is the length of the data in Bytes
*
* @return
* - XST_SUCCESS if the write completes correctly
* - XST_FAILURE if the write fails to completes correctly
*
* @note none.
*
****************************************************************************/
u32 QspiAccess( u32 SourceAddress, u32 DestinationAddress, u32 LengthBytes)
{
u8 *BufferPtr;
u32 Length = 0;
u32 BankSel = 0;
u32 LqspiCrReg;
u32 Status;
u8 BankSwitchFlag = 1;
/*
* Linear access check
*/
if (LinearBootDeviceFlag == 1) {
/*
* Check for non-word tail, add bytes to cover the end
*/
if ((LengthBytes%4) != 0){
LengthBytes += (4 - (LengthBytes & 0x00000003));
}
memcpy((void*)DestinationAddress,
(const void*)(SourceAddress + FlashReadBaseAddress),
(size_t)LengthBytes);
} else {

10. QSPI Flash以後分別是

（1）NAND BOOT MODE

（2）NOR BOOT MODE

（3）SD BOOT MODE

// 以上幾種模式的處理流程和QSPI Flash的處理流程類似，都是對設備的初始化以及函數指針的賦值

（4）JTAG BOOT MODE

從代碼中看到函數FsblHandoffJtagExit最終順序執行到FsblHandoffExit，其中bx lr指令就是跳轉到用戶代碼執行。

FsblHandoffJtagExit
mcr p15,0,r0,c7,c5,0 ;/* Invalidate Instruction cache */
mcr p15,0,r0,c7,c5,6 ;/* Invalidate branch predictor array */
dsb
isb ;/* make sure it completes */
ldr r4, =0
mcr p15,0,r4,c1,c0,0 ;/* disable the ICache and MMU */
isb ;/* make sure it completes */
Loop
wfe
b Loop
FsblHandoffExit
mov lr, r0 ;/* move the destination address into link register */
mcr p15,0,r0,c7,c5,0 ;/* Invalidate Instruction cache */
mcr p15,0,r0,c7,c5,6 ;/* Invalidate branch predictor array */
dsb
isb ;/* make sure it completes */
ldr r4, =0
mcr p15,0,r4,c1,c0,0 ;/* disable the ICache and MMU */
isb ;/* make sure it completes */
bx lr ;/* force the switch, destination should have been in r0 */
Ldone b Ldone ;/* Paranoia: we should never get here */
END

11. 首先從我們打印log信息得到：Handoff Address: 0x00100000即ddr的起始地址，在hdf文件中可以查到

初步猜測裏面應該完成了FPGA bit文件在PL中的加載，以及搬移裸機的軟件elf文件到內存中去。

做完這些工作最終調用了FsblHandoff函數，通過該函數跳轉到DDR中執行應用程序。

/*
* Load boot image
*/
HandoffAddress = LoadBootImage();
fsbl_printf(DEBUG_INFO,"Handoff Address: 0x%08lx\r\n",HandoffAddress);
/*
* For Performance measurement
*/
#ifdef FSBL_PERF
XTime tEnd = 0;
fsbl_printf(DEBUG_GENERAL,"Total Execution time is ");
FsblMeasurePerfTime(tCur,tEnd);
#endif
/*
* FSBL handoff to valid handoff address or
* exit in JTAG
*/
FsblHandoff(HandoffAddress);

12. 接下來我們詳細分析LoadBootImage()這個函數

因爲我們的Silicon_Version不是1，所以我們執行以下代碼。這段代碼的作用是從multiboot寄存器中讀取要執行的image的地址，其實如果就一個image的話可以不用管這個，這個算出來的imagestartaddress一定是0。

結合我們拿到的log：

Multiboot Register: 0x0000C000

Image Start Address: 0x00000000

else {
/*
* read the multiboot register
*/
MultiBootReg = XDcfg_ReadReg(DcfgInstPtr->Config.BaseAddr,
XDCFG_MULTIBOOT_ADDR_OFFSET);
fsbl_printf(DEBUG_INFO,"Multiboot Register: 0x%08lx\r\n",MultiBootReg);
/*
* Compute the image start address
*/
ImageStartAddress = (MultiBootReg & PCAP_MBOOT_REG_REBOOT_OFFSET_MASK)
* GOLDEN_IMAGE_OFFSET;
}
fsbl_printf(DEBUG_INFO,"Image Start Address: 0x%08lx\r\n",ImageStartAddress);

13. 這一段是讀取在flash中的每個部分的頭文件信息，包括大小起始地址等。也就是在生成BOOT的時候加入的幾個文件，比如說先加的是FSBL，然後是BIT，最後是APP，那麼這裏的部分的數量就是3個。

結合log，這裏跳過FSBL了，所以從Partition Number：1 開始加載bit；然後在Partition Number：2加載軟件elf文件。

/*
* Get partitions header information
*/
Status = GetPartitionHeaderInfo(ImageStartAddress);
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL, "Partition Header Load Failed\r\n");
OutputStatus(GET_HEADER_INFO_FAIL);
FsblFallback();
}

14. 從函數Status = GetPartitionHeaderInfo(ImageStartAddress);

->Status = GetFsblLength(ImageBaseAddress, &FsblLength);

在該函數中調用了MoveImage函數，實際上是把BOOT.bin image的0x40地址的4字節賦值給FsblLength，從而獲取到Fsbl的size大小。這裏需要了解一下BOOT.bin的結構。

在boot.bin中從地址0-0x8BF可以分成17個部分，每個部分都有一定的含義

1. 0x000 中斷向量表

2. 0x020 固定值 0xaa995566

3. 0x024 固定值 0x584c4e58 ASCII: XLNX

4. 0x028 如果是0xa5c3c5a3或者0x3a5c3c5a爲加密的

5. 0x02C bootrom頭版本號，不用管

6. 0x030 從bootrom開始到app地址的總數（bytes）

7. 0x034 從loadimage拷到OCM的長度【上電後BootRom會主動把FSBL拷貝到OCM中執行】

8. 0x038 目的地址到哪兒拷貝FSBL

9. 0x03C 開始執行的地址

10. 0x040 同7 【此處代碼邏輯中其實是把該字段的值賦給FSBL的size】

11. 0x044 0x01爲固定值

12. 0x048 校驗和（從0x020-0x047）按32-bit word 相加取反

13. 0x04C bootgen相關

14. 0x098 image頭的表指針

15. 0x09C partition頭的表指針

16. 0x0A0 寄存器初始化的參數

17. 0x8A0 fsbl user defined

18. 0x8C0 fsbl開始的地方

如果是從qspi加載的話，bootrom會把數據從qspi拷貝到OCM中，在OCM中運行，也就是0地址運行。

u32 GetFsblLength(u32 ImageAddress, u32 *FsblLength)
{
u32 Status;
Status = MoveImage(ImageAddress + IMAGE_TOT_BYTE_LEN_OFFSET,
(u32)FsblLength, 4);
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"Move Image failed reading FsblLength\r\n");
return XST_FAILURE;
}
return XST_SUCCESS;
}

15. 結合14項中BOOT.bin的頭信息，下面函數通過image偏移地址0x9C獲取partition頭的表指針。還記得13項中提供的log打印：Partition Header Offset:0x00000C80

分析代碼基於該partition header開始計算partition count，正常情況下最多遍歷15個partition，我們這裏實際只有3個，即FSBL, BIT, ELF。

分析代碼正常的一個partion的表頭信息結構如下：

struct HeaderArray {

u32 Fields[16];

};

最後的一個partion的表頭的內容應該如下：

* 0x00000000

* ....

* 0x00000000

* 0xFFFFFFFF

即前15個元素均爲0，最後一個元素全爲F，這時判斷所有partition遍歷完畢，得到當前的partition的個數

u32 GetPartitionHeaderStartAddr(u32 ImageAddress, u32 *Offset)
{
u32 Status;
Status = MoveImage(ImageAddress + IMAGE_PHDR_OFFSET, (u32)Offset, 4);
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"Move Image failed\r\n");
return XST_FAILURE;
}
return XST_SUCCESS;
}

16. 首先我們這裏不再解析partition 0即FSBL，直接從partition 1開始解析。在函數HeaderDump中把當前所有partition的大小即其實地址都解析出來。結合如下log我們可以看到FPGA bit和軟件的elf文件的信息。

Partition Header Offset:0x00000C80

Partition Count: 3

Partition Number: 1

Header Dump

Image Word Len: 0x00427028 // 這裏應該是bit文件的大小，單位是word。轉換0x00427028 * 4 / 1024 ≈ 17009KB，查看工程符合當前bit文件的大小

Data Word Len: 0x00427028

Partition Word Len:0x00427028

Load Addr: 0x00000000

Exec Addr: 0x00000000

Partition Start: 0x000055D0

Partition Attr: 0x00000020 // Bitstream

Partition Checksum Offset: 0x00000000

Section Count: 0x00000001

Checksum: 0xFF385746

Bitstream

In FsblHookAfterBitstreamDload function

Partition Number: 2

Header Dump

Image Word Len: 0x00004002

Data Word Len: 0x00004002

Partition Word Len:0x00004002

Load Addr: 0x00100000

Exec Addr: 0x00100000

Partition Start: 0x0042C600 // 0x0042C600 - 0x000055D0 = 0x427030，可以看到bit文件和軟件elf基本上是連續的

Partition Attr: 0x00000010 // Application

Partition Checksum Offset: 0x00000000

Section Count: 0x00000001

Checksum: 0xFF9C7788

Application

PartitionNum = 1;
while (PartitionNum < PartitionCount) {
fsbl_printf(DEBUG_INFO, "Partition Number: %lu\r\n", PartitionNum);
HeaderPtr = &PartitionHeader[PartitionNum];
/*
* Print partition header information
*/
HeaderDump(HeaderPtr);

17. 當解析當前partition屬性爲Bitstream時，設置如下代碼中的flag

if (PartitionAttr & ATTRIBUTE_PL_IMAGE_MASK) {
fsbl_printf(DEBUG_INFO, "Bitstream\r\n");
PLPartitionFlag = 1;
PSPartitionFlag = 0;
BitstreamFlag = 1;
if (ApplicationFlag == 1) {
#ifdef STDOUT_BASEADDRESS
xil_printf("\r\nFSBL Warning !!!"
"Bitstream not loaded into PL\r\n");
xil_printf("Partition order invalid\r\n");
#endif
break;
}
}

通過函數PcapLoadPartition完成了PL的加載，這裏不再做深入分析。

/*
* Load Signed PL partition in Fabric
*/
if (PLPartitionFlag) {
Status = PcapLoadPartition((u32*)PartitionStartAddr,
(u32*)PartitionLoadAddr,
PartitionImageLength,
PartitionDataLength,
EncryptedPartitionFlag);
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"BITSTREAM_DOWNLOAD_FAIL\r\n");
OutputStatus(BITSTREAM_DOWNLOAD_FAIL);
FsblFallback();
}
}
}
/*
* FSBL user hook call after bitstream download
*/
if (PLPartitionFlag) {
Status = FsblHookAfterBitstreamDload();
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"FSBL_AFTER_BSTREAM_HOOK_FAIL\r\n");
OutputStatus(FSBL_AFTER_BSTREAM_HOOK_FAIL);
FsblFallback();
}

18. 根據partition屬性爲Application時設置如下的flag

if (PartitionAttr & ATTRIBUTE_PS_IMAGE_MASK) {
fsbl_printf(DEBUG_INFO, "Application\r\n");
PSPartitionFlag = 1;
PLPartitionFlag = 0;
ApplicationFlag = 1;
}

在這裏會把elf文件搬移到DDR地址0x00100000上，而bit文件會搬移到0x00000000地址上去。

/*
* Move partitions from boot device
*/
Status = PartitionMove(ImageStartAddress, HeaderPtr);
if (Status != XST_SUCCESS) {
fsbl_printf(DEBUG_GENERAL,"PARTITION_MOVE_FAIL\r\n");
OutputStatus(PARTITION_MOVE_FAIL);
FsblFallback();
}

Xilinx FSBL 代碼簡析

測試人員都是畫畫大神，讓我看看誰還不會用代碼圖？

Object.values()對象遍歷

我拍了拍Redis，被移出了羣聊···

網絡現代化通向雲原生應用的高速公路

面試官：說說你對序列化的理解

關於sata狀態寄存器和錯誤寄存器的理解

RAID 0是什麼？

SATA 3.3協議 Error handing機制

【讀書筆記】第二章信息的表示和處理

SATA主機協議的FPGA實現之物理層設計

https://yachay.unat.edu.pe/blog/index.php?comment_area=format_blog&comment_component=blog&comment_co

linux以太網驅動總結