【HDMI出力編(3)】静止画をZynqからHDMI出力するVitisアプリケーション

#include <stdio.h>
#include "math.h"
#include <ctype.h>
#include <stdlib.h>
#include "xil_types.h"
#include "xil_cache.h"
#include "xparameters.h"
#include "vga_modes.h"
#include "xaxivdma.h"
#include "xvtc.h"
#include "./dynclk/dynclk.h"

#define DYNCLK_BASEADDR XPAR_AXI_DYNCLK_0_BASEADDR
#define VGA_VDMA_ID XPAR_AXIVDMA_0_DEVICE_ID
#define DISP_VTC_ID XPAR_VTC_0_DEVICE_ID

#define DEMO_MAX_FRAME (1920*1080*4)
#define DEMO_STRIDE (1920 * 4)
int dynclk_setting(u32 dynClkAddr, VideoMode vMode);
int VTC_setting(u16 vtcId, XVtc *vtc, VideoMode vMode);
int VDMA_setting(u16 VDMA_Id, XAxiVdma *vdma, XAxiVdma_DmaSetup *vdmasetup, u8 *framePtr, u32 stride, VideoMode vMode);

XAxiVdma vdma;
XAxiVdma_DmaSetup   vdmasetup;
XVtc vtc;
u8  frameBuf[DEMO_MAX_FRAME] __attribute__((aligned(0x20)));

int main(void)
{
    int Status;
    /* dynclk の設定*/
    Status = dynclk_setting(DYNCLK_BASEADDR, VMODE_640x480);

    /* VTCの設定 */
    Status = VTC_setting(DISP_VTC_ID, &vtc, VMODE_640x480);

    /* VDMAの設定 */
    Status = VDMA_setting(VGA_VDMA_ID, &vdma, &vdmasetup, frameBuf, DEMO_STRIDE, VMODE_640x480);

    /* frameBufへの書き込み */
    u32 iPixelAddr;
    u32 xcoi, ycoi;
    for(xcoi = 0; xcoi < (VMODE_640x480.width*4); xcoi+=4)
    {
        iPixelAddr = xcoi;
        for(ycoi = 0; ycoi < VMODE_640x480.height; ycoi++)
        {
            frameBuf[iPixelAddr]       = 0;   //blue
            frameBuf[iPixelAddr + 1]   = 0; //green
            frameBuf[iPixelAddr + 2]   = 255;   //red

            iPixelAddr += DEMO_STRIDE;
        }
    }
    Xil_DCacheFlushRange((unsigned int) frameBuf, DEMO_MAX_FRAME);

    return 0;
}

int dynclk_setting(u32 dynClkAddr, VideoMode vMode)
{
    ClkConfig clkReg;
    ClkMode clkMode;

    ClkFindParams(vMode.freq, &clkMode);

    if (!ClkFindReg(&clkReg, &clkMode))
    {
        xdbg_printf(XDBG_DEBUG_GENERAL, "Error calculating CLK register values\n\r");
        return XST_FAILURE;
    }
    
    ClkWriteReg(&clkReg, dynClkAddr);
    ClkStart(dynClkAddr);

    return XST_SUCCESS;
}

int VTC_setting(u16 vtcId, XVtc *vtc, VideoMode vMode){
    /*　略　*/
}

int VDMA_setting(u16 VDMA_Id, XAxiVdma *vdma, XAxiVdma_DmaSetup *vdmasetup, u8 *framePtr, u32 stride, VideoMode vMode){
    /*　略　*/
}

    int Status;
    /* dynclk の設定*/
    Status = dynclk_setting(DYNCLK_BASEADDR, VMODE_640x480);

    /* VTCの設定 */
    Status = VTC_setting(DISP_VTC_ID, &vtc, VMODE_640x480);

    /* VDMAの設定 */
    Status = VDMA_setting(VGA_VDMA_ID, &vdma, &vdmasetup, frameBuf, DEMO_STRIDE, VMODE_640x480);

    /* frameBufへの書き込み */
    u32 iPixelAddr;
    u32 xcoi, ycoi;
    for(xcoi = 0; xcoi < (VMODE_640x480.width*4); xcoi+=4)
    {
        iPixelAddr = xcoi;
        for(ycoi = 0; ycoi < VMODE_640x480.height; ycoi++)
        {
            frameBuf[iPixelAddr]       = 0;   //blue
            frameBuf[iPixelAddr + 1]   = 0; //green
            frameBuf[iPixelAddr + 2]   = 255;   //red

            iPixelAddr += DEMO_STRIDE;
        }
    }
    Xil_DCacheFlushRange((unsigned int) frameBuf, DEMO_MAX_FRAME);

    for(xcoi = 0; xcoi < (VMODE_640x480.width*4); xcoi+=4)
    {
        iPixelAddr = xcoi;
        for(ycoi = 0; ycoi < VMODE_640x480.height; ycoi++)
        {
            frameBuf[iPixelAddr]       = 0;   //blue
            frameBuf[iPixelAddr + 1]   = 0; //green
            frameBuf[iPixelAddr + 2]   = 255;   //red

            iPixelAddr += DEMO_STRIDE;
        }
    }

    //Xil_DCacheFlushRange((unsigned int) frameBuf, DEMO_MAX_FRAME);