devbox
天景科技苑
这个屌丝很懒，什么也没留下！
关注作者
热门标签
热门文章
当前位置:   article > 正文

Zynq-PS-SDK(15) 之 OV5640-HDMI 视频通路软件配置_ov5640sdk

作者：天景科技苑 | 2024-07-25 18:30:25

赞

踩

ov5640sdk

《Zynq-PS-SDK(13) 之 VDMA+VTC+AXI4S-VideoOut 视频通路软件配置》将硬件做好后，导出到 SDK，我们进行代码的编写，代码主要分为两部分：

1、SCCB 的 I2C 对 OV5640 进行配置；

2、配置 VDMA + VTC + Dynamic Clock；

先 reset，完成 SCCB 的配置，然后进行 IP 核的配置，main 函数如下所示：

  1. /************************************************************************/
  2. /*																		*/
  3. /*	display_demo.c	--	ALINX AX7010 HDMI Display demonstration 						*/
  4. /*																		*/
  5. /************************************************************************/
  6.  
  7. /* ------------------------------------------------------------ */
  8. /*				Include File Definitions						*/
  9. /* ------------------------------------------------------------ */
  10.  
  11. #include "display_demo.h"
  12. #include "display_ctrl/display_ctrl.h"
  13. #include <stdio.h>
  14. #include "math.h"
  15. #include <ctype.h>
  16. #include <stdlib.h>
  17. #include "xil_types.h"
  18. #include "xil_cache.h"
  19. #include "xparameters.h"
  20. #include "xiicps.h"
  21. #include "vdma.h"
  22. #include "i2c/PS_i2c.h"
  23. #include "xgpio.h"
  24. #include "sleep.h"
  25. #include "ov5640.h"
  26. #include "steph_vdma.h"
  27. /*
  28.  * XPAR redefines
  29.  */
  30. #define DYNCLK_BASEADDR XPAR_AXI_DYNCLK_0_BASEADDR
  31. #define VGA_VDMA_ID XPAR_AXIVDMA_0_DEVICE_ID
  32. #define DISP_VTC_ID XPAR_VTC_0_DEVICE_ID
  33. #define VID_VTC_IRPT_ID XPS_FPGA3_INT_ID
  34. #define VID_GPIO_IRPT_ID XPS_FPGA4_INT_ID
  35. #define SCU_TIMER_ID XPAR_SCUTIMER_DEVICE_ID
  36. #define UART_BASEADDR XPAR_PS7_UART_1_BASEADDR
  37.  
  38.  
  39. /* ------------------------------------------------------------ */
  40. /*				Global Variables								*/
  41. /* ------------------------------------------------------------ */
  42.  
  43. /*
  44.  * Display Driver structs
  45.  */
  46. DisplayCtrl dispCtrl;
  47. XAxiVdma vdma;
  48. XIicPs ps_i2c0;
  49. XGpio cmos_rstn;
  50. /*
  51.  * Framebuffers for video data
  52.  */
  53. u8 frameBuf[DISPLAY_NUM_FRAMES][DEMO_MAX_FRAME] __attribute__ ((aligned(64)));
  54. u8 *pFrames[DISPLAY_NUM_FRAMES]; //array of pointers to the frame buffers
  55.  
  56. /* ------------------------------------------------------------ */
  57. /*				Procedure Definitions							*/
  58. /* ------------------------------------------------------------ */
  59.  
  60.  
  61.  
  62. int main(void)
  63. {
  64.  
  65. 	int Status;
  66. 	XAxiVdma_Config *vdmaConfig;
  67. 	int i;
  68.  
  69. 	/*
  70. 	 * Initialize an array of pointers to the 3 frame buffers
  71. 	 */
  72. 	for (i = 0; i < DISPLAY_NUM_FRAMES; i++)
  73. 	{
  74. 		pFrames[i] = frameBuf[i];
  75. 		memset(pFrames[i], 0, DEMO_MAX_FRAME);
  76. 		Xil_DCacheFlushRange((INTPTR) pFrames[i], DEMO_MAX_FRAME) ;
  77. 	}
  78.  
  79. 	i2c_init(&ps_i2c0, XPAR_XIICPS_0_DEVICE_ID,40000);
  80.  
  81. 	XGpio_Initialize(&cmos_rstn, XPAR_CMOS_RST_DEVICE_ID);   //initialize GPIO IP
  82. 	XGpio_SetDataDirection(&cmos_rstn, 1, 0x0);            //set GPIO as output
  83. 	XGpio_DiscreteWrite(&cmos_rstn, 1, 0x1);
  84. 	usleep(500000);
  85. 	XGpio_DiscreteWrite(&cmos_rstn, 1, 0x0);               //set GPIO output value to 0
  86.  
  87. 	usleep(500000);
  88. 	XGpio_DiscreteWrite(&cmos_rstn, 1, 0x1);
  89. 	usleep(500000);
  90.  
  91. 	/*
  92. 	 * Initialize Sensor
  93. 	 */
  94. 	sensor_init(&ps_i2c0);
  95. 	/*
  96. 	 * Initialize VDMA driver
  97. 	 */
  98.  
  99. 	// Reset StephenZhou's IP
  100. 	Xil_Out32(XPAR_STEPH_OV5640_0_S00_AXI_BASEADDR, 0x00000000);
  101. 	usleep(500000);
  102. 	Xil_Out32(XPAR_STEPH_OV5640_0_S00_AXI_BASEADDR, 0x00000001);
  103.  
  104. 	vdmaConfig = XAxiVdma_LookupConfig(VGA_VDMA_ID);
  105. 	if (!vdmaConfig)
  106. 	{
  107. 		xil_printf("No video DMA found for ID %d\r\n", VGA_VDMA_ID);
  108.  
  109. 	}
  110. 	Status = XAxiVdma_CfgInitialize(&vdma, vdmaConfig, vdmaConfig->BaseAddress);
  111. 	if (Status != XST_SUCCESS)
  112. 	{
  113. 		xil_printf("VDMA Configuration Initialization failed %d\r\n", Status);
  114.  
  115. 	}
  116.  
  117. 	/*
  118. 	 * Initialize the Display controller and start it
  119. 	 */
  120. 	Status = DisplayInitialize(&dispCtrl, &vdma, DISP_VTC_ID, DYNCLK_BASEADDR,pFrames, DEMO_STRIDE);
  121. 	if (Status != XST_SUCCESS)
  122. 	{
  123. 		xil_printf("Display Ctrl initialization failed during demo initialization%d\r\n", Status);
  124.  
  125. 	}
  126. 	Status = DisplayStart(&dispCtrl);
  127. 	if (Status != XST_SUCCESS)
  128. 	{
  129. 		xil_printf("Couldn't start display during demo initialization%d\r\n", Status);
  130.  
  131. 	}
  132. 	/* Clear frame buffer */
  133. 	memset(dispCtrl.framePtr[dispCtrl.curFrame], 0, 1920 * 1080 * 3);
  134. 	/* Start Sensor Vdma */
  135. 	// vdma_write_init(XPAR_AXIVDMA_1_DEVICE_ID,1280 * 3,720,1280 * 3,(unsigned int)dispCtrl.framePtr[dispCtrl.curFrame]);
  136.  
  137. 	Steph_VDMAInit(&vdma, VGA_VDMA_ID, 1280, 720, DEMO_STRIDE, (unsigned int) pFrames[0]);
  138. 	while(1);
  139.  
  140. 	return 0;
  141. }
  142.  
  143.

VDMA 的配置，配置了读写通道：

  1. /******************** Include files **********************************/
  2. #include "xaxivdma.h"
  3. #include "xparameters.h"
  4. #include "xil_exception.h"
  5.  
  6. #define STEPH_VDMA_DBG              1
  7.  
  8. typedef struct steph_vdma_desc {
  9.  
  10.     /** The XAxiVdma driver instance data. */
  11.     XAxiVdma* InstancePtr;
  12.     /** The Read channel configure. */
  13.     XAxiVdma_DmaSetup ReadCfg;
  14.     /** The Write channel configure. */
  15.     XAxiVdma_DmaSetup WriteCfg;
  16.     /* Horizontal size of frame */
  17.     unsigned int hsize;
  18.     /* Stride horizontal size of frame */
  19.     unsigned int stride;
  20.     /* Vertical size of frame */
  21.     unsigned int vsize;
  22.     /* FrameBuffer address from where read and write will be done by VDMA */
  23.     unsigned int fb_addr;
  24.  
  25. } steph_vdma_desc_t;
  26.  
  27. steph_vdma_desc_t steph_vdma;
  28.  
  29. static int _Steph_VDMA_ConfigWriteChannel(steph_vdma_desc_t *steph_vdma)
  30. {
  31.     int Status = XST_SUCCESS;
  32.     u32 Addr;
  33.  
  34.     steph_vdma->WriteCfg.VertSizeInput      = steph_vdma->vsize;
  35.     steph_vdma->WriteCfg.HoriSizeInput      = steph_vdma->hsize;
  36.     steph_vdma->WriteCfg.Stride             = steph_vdma->stride;
  37.  
  38.     steph_vdma->WriteCfg.FrameDelay         = 0;
  39.     // Circular mode
  40.     steph_vdma->WriteCfg.EnableCircularBuf  = 1;
  41.     // GenLock enable
  42.     steph_vdma->WriteCfg.EnableSync         = 1;
  43.     steph_vdma->WriteCfg.PointNum           = 0;
  44.     steph_vdma->WriteCfg.EnableFrameCounter = 0;
  45.     /* We are not doing parking */
  46.     steph_vdma->WriteCfg.FixedFrameStoreAddr= 0;
  47.     steph_vdma->WriteCfg.GenLockRepeat      = 0;
  48.  
  49.     Status = XAxiVdma_DmaConfig(steph_vdma->InstancePtr, XAXIVDMA_WRITE, &steph_vdma->WriteCfg);
  50.     if (Status != XST_SUCCESS) {
  51.         xil_printf("[ERROR] : Write channel config failed %d\r\n", Status);
  52.         return Status;
  53.     }
  54.  
  55.     // Configure the framebuffer
  56.     Addr = steph_vdma->fb_addr;
  57.     for(int Index = 0; Index < steph_vdma->InstancePtr->MaxNumFrames; Index++)
  58.     {
  59.         steph_vdma->WriteCfg.FrameStoreStartAddr[Index] = Addr;
  60.         Addr += (steph_vdma->hsize * steph_vdma->vsize);
  61.     }
  62.  
  63.     // Set the framebuffer addresses for transfer in the DMA engine
  64.     Status = XAxiVdma_DmaSetBufferAddr(steph_vdma->InstancePtr, XAXIVDMA_WRITE,
  65.             steph_vdma->WriteCfg.FrameStoreStartAddr);
  66.  
  67.     if (Status != XST_SUCCESS)
  68.     {
  69.         xil_printf("[ERROR] : Write channel set buffer address failed %d\r\n", Status);
  70.         return Status;
  71.     }
  72.  
  73.     return Status;
  74. }
  75.  
  76. static int _Steph_VDMA_ConfigReadChannel(steph_vdma_desc_t *steph_vdma)
  77. {
  78.     int Status = XST_SUCCESS;
  79.     u32 Addr;
  80.  
  81.     steph_vdma->ReadCfg.VertSizeInput      = steph_vdma->vsize;
  82.     steph_vdma->ReadCfg.HoriSizeInput      = steph_vdma->hsize;
  83.     steph_vdma->ReadCfg.Stride             = steph_vdma->stride;
  84.  
  85.     steph_vdma->ReadCfg.FrameDelay         = 0;
  86.     // Circular mode
  87.     steph_vdma->ReadCfg.EnableCircularBuf  = 1;
  88.     // GenLock enable
  89.     steph_vdma->ReadCfg.EnableSync         = 1;
  90.     steph_vdma->ReadCfg.PointNum           = 0;
  91.     steph_vdma->ReadCfg.EnableFrameCounter = 0;
  92.     /* We are not doing parking */
  93.     steph_vdma->ReadCfg.FixedFrameStoreAddr= 0;
  94.     steph_vdma->ReadCfg.GenLockRepeat      = 0;
  95.  
  96.     Status = XAxiVdma_DmaConfig(steph_vdma->InstancePtr, XAXIVDMA_READ, &steph_vdma->ReadCfg);
  97.     if (Status != XST_SUCCESS) {
  98.         xil_printf("[ERROR] : Read channel config failed %d\r\n", Status);
  99.         return Status;
  100.     }
  101.  
  102.     // Configure the framebuffer
  103.     Addr = steph_vdma->fb_addr;
  104.     for(int Index = 0; Index < steph_vdma->InstancePtr->MaxNumFrames; Index++)
  105.     {
  106.         steph_vdma->ReadCfg.FrameStoreStartAddr[Index] = Addr;
  107.         Addr += (steph_vdma->hsize * steph_vdma->vsize);
  108.     }
  109.  
  110.     // Set the framebuffer addresses for transfer in the DMA engine
  111.     Status = XAxiVdma_DmaSetBufferAddr(steph_vdma->InstancePtr, XAXIVDMA_READ,
  112.             steph_vdma->ReadCfg.FrameStoreStartAddr);
  113.  
  114.     if (Status != XST_SUCCESS)
  115.     {
  116.         xil_printf("[ERROR] : Read channel set buffer address failed %d\r\n", Status);
  117.         return Status;
  118.     }
  119.  
  120.     return Status;
  121. }
  122.  
  123. static int _Steph_VDMA_StartWriteChannel(steph_vdma_desc_t *steph_vdma)
  124. {
  125.     int Status = XST_SUCCESS;
  126.  
  127.     Status = XAxiVdma_DmaStart(steph_vdma->InstancePtr, XAXIVDMA_WRITE);
  128.     if (Status != XST_SUCCESS)
  129.     {
  130.         xil_printf("[ERROR] : Start Write transfer failed %d\r\n", Status);
  131.     }
  132.  
  133.     return Status;
  134. }
  135.  
  136. static int _Steph_VDMA_StartReadChannel(steph_vdma_desc_t *steph_vdma)
  137. {
  138.     int Status = XST_SUCCESS;
  139.  
  140.     Status = XAxiVdma_DmaStart(steph_vdma->InstancePtr, XAXIVDMA_READ);
  141.     if (Status != XST_SUCCESS)
  142.     {
  143.         xil_printf("[ERROR] : Start Read transfer failed %d\r\n", Status);
  144.     }
  145.  
  146.     return Status;
  147. }
  148.  
  149. int Steph_VDMAInit(XAxiVdma *_InstancePtr, int device_id, int hsize, int vsize, int stride, int fb_addr)
  150. {
  151.     int Status = XST_SUCCESS;
  152.     XAxiVdma_Config *Config;
  153.     
  154.     Config = XAxiVdma_LookupConfig(device_id);
  155.     if (!Config)
  156.     {
  157.         xil_printf("[ERROR] : No video DMA found for ID %d\r\n",device_id);
  158.         return XST_FAILURE;
  159.     }
  160.  
  161.     /* Initialize DMA engine */
  162.     Status = XAxiVdma_CfgInitialize(_InstancePtr, Config, Config->BaseAddress);
  163.     if (Status != XST_SUCCESS)
  164.     {
  165.         xil_printf("[ERROR] : Configuration Initialization failed %d\r\n",Status);
  166.         return Status;
  167.     }
  168.  
  169.     steph_vdma.InstancePtr = _InstancePtr;
  170.     steph_vdma.hsize       = hsize * (Config->Mm2SStreamWidth>>3);
  171.     steph_vdma.stride      = stride;
  172.     steph_vdma.vsize       = vsize;
  173.     steph_vdma.fb_addr     = fb_addr;
  174.  
  175. #ifdef STEPH_VDMA_DBG
  176.     xil_printf("hsize = %d\r\n",hsize);
  177.     xil_printf("stride = %d\r\n",steph_vdma.stride);
  178.     xil_printf("vsize = %d\r\n",vsize);
  179.     xil_printf("fb_addr = 0x%08X\r\n",fb_addr);
  180. #endif
  181.  
  182.     // Configure the write channel
  183.     Status = _Steph_VDMA_ConfigWriteChannel(&steph_vdma);
  184.     if (Status != XST_SUCCESS)
  185.     {
  186.         xil_printf("[ERROR] : Write channel setup failed %d\r\n", Status);
  187.         return Status;
  188.     }
  189.  
  190.     // Configure the read channel
  191.     Status = _Steph_VDMA_ConfigReadChannel(&steph_vdma);
  192.     if (Status != XST_SUCCESS)
  193.     {
  194.         xil_printf("[ERROR] : Read channel setup failed %d\r\n", Status);
  195.         return Status;
  196.     }
  197.  
  198.     // Start the write channel
  199.     Status = _Steph_VDMA_StartWriteChannel(&steph_vdma);
  200.     if (Status != XST_SUCCESS)
  201.     {
  202.         xil_printf("[ERROR] : Start Write channel failed %d\r\n", Status);
  203.         return Status;
  204.     }
  205.  
  206.     // Configure the read channel
  207.     Status = _Steph_VDMA_StartReadChannel(&steph_vdma);
  208.     if (Status != XST_SUCCESS)
  209.     {
  210.         xil_printf("[ERROR] : Start Read channel failed %d\r\n", Status);
  211.         return Status;
  212.     }
  213.  
  214.     xil_printf("StephenZhou VDMA OK...\r\n");
  215.  
  216.     return Status;
  217. }

3 块 framebuffer 轮流使用，开启 GenLock；

更多寄存器的配置详细，参考 pg020；主要是配置一些宽，高，framebuffer 地址，GenLock 同步方式等；

 

 

本文内容由网友自发贡献，转载请注明出处：https://www.wpsshop.cn/w/天景科技苑/article/detail/881532
推荐阅读
相关标签

Copyright © 2003-2013 www.wpsshop.cn 版权所有，并保留所有权利。

  

闽ICP备14008679号