Diff: main.cpp

Revision:

0:020195991898

Child:

1:28e2f24b11b3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sat Feb 03 14:39:39 2018 +0000
@@ -0,0 +1,200 @@
+#include "mbed.h"
+#define USE_STM32746G_DISCOVERY
+#include "stm32f7xx_hal.h"
+#include "stm32746g_discovery.h"
+#include "stm32746g_discovery_sd.h"
+#include "string.h"
+#include "stm32746g_discovery_lcd.h"
+#include "ff_gen_drv.h"
+#include "sd_diskio.h"
+
+#define FRAME_BUFFER    0xC0000000
+#define SD_IN_BUFFER    0xC0140000
+#define SD_OUT_BUFFER   0xC0280000
+
+FATFS SDFatFs;  
+FIL MyFile;  
+
+
+ 
+
+static void LCD_LL_ConvertFrameToARGB8888(void *pSrc, void *pDst);
+static void LCD_LL_ConvertFrameToRGB888(void *pSrc, void *pDst);
+extern SD_HandleTypeDef uSdHandle;
+DMA2D_HandleTypeDef hdma2d_disco;
+
+Serial pc(USBTX, USBRX);
+uint32_t i = 0, image_width = 0, image_height = 0;
+const char image_header[] = "P6\n# Generated by STM32\n272 480\n255\n";
+
+char SDPath[4];
+char text [40];
+char c;
+
+int main(void)
+{
+    FRESULT res;
+    uint32_t  bytesread;
+    uint32_t line_cnt=0;
+    pc.baud(115200);
+
+    BSP_LCD_Init();
+    BSP_LCD_DisplayOff();
+    BSP_LCD_LayerDefaultInit(0, FRAME_BUFFER);
+    BSP_LCD_SelectLayer(0);
+    BSP_LCD_DisplayOn();
+
+    FATFS_LinkDriver(&SD_Driver, SDPath);
+    
+    res = f_mount(&SDFatFs, (TCHAR const*)SDPath, 0);
+    if(res!= FR_OK)
+        pc.printf("Failed to mount SD\n");
+        
+    res = f_open(&MyFile, "image.ppm",  FA_READ);
+    if(res!= FR_OK)
+        pc.printf("Failed to open file\n");
+        
+    while(1) {
+        
+        res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+        if (c!='#')
+            line_cnt++;
+        if(line_cnt==2) {
+            text[0] = c;
+            res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+            i = 1;
+            while(c!=' ') {
+                text[i]=c;
+                res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+                i++;
+            }
+            text[i]=0;
+            image_width = atoi(text);
+            res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+            i = 0;
+            while(c!='\n') {
+                text[i]=c;
+                res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+                i++;
+            }
+            text[i]=0;
+            image_height = atoi(text);
+        } else {
+            while(c!='\n')
+                res = f_read(&MyFile, &c, 1, (UINT*)&bytesread);
+        }
+        if(line_cnt == 3)
+            break;
+
+    }
+    pc.printf("w = %d \n",image_width);
+    pc.printf("h = %d \n",image_height);
+    
+    if(image_width != 480 || image_height != 272)
+        pc.printf("Image size should be 272x480");
+    
+    for(i = 0; i < image_width*image_width*3; i = i + 512) {
+        res = f_read(&MyFile, (void *)(SD_IN_BUFFER+i) , 512, (UINT*)&bytesread);
+    }
+    f_close(&MyFile);
+    
+    LCD_LL_ConvertFrameToARGB8888((uint32_t *)(SD_IN_BUFFER), (uint32_t *)(FRAME_BUFFER));
+    
+
+    LCD_LL_ConvertFrameToRGB888((uint32_t *)(FRAME_BUFFER), (uint32_t *)(SD_OUT_BUFFER));
+    
+    res = f_open(&MyFile, "image_ou.ppm",   FA_CREATE_ALWAYS | FA_WRITE);
+    if(res!= FR_OK)
+        pc.printf("Failed to open file\n");
+
+
+    res = f_write(&MyFile, image_header, 15, &bytesread);
+    if(res!= FR_OK)
+        pc.printf("Failed to write file 1\n");
+        
+    for(i = 0; i < 480*272*3; i = i + 512) {
+        res = f_write(&MyFile, (uint8_t *)(SD_OUT_BUFFER+i), 512, &bytesread);
+        if(res!= FR_OK)
+            pc.printf("Failed to write file\n");
+    }
+    f_close(&MyFile);
+    FATFS_UnLinkDriver(SDPath);
+
+    while (1) {
+    }
+}
+extern "C" {
+    void BSP_SDMMC_IRQHandler(void)
+    {
+        HAL_SD_IRQHandler(&uSdHandle);
+    }
+    void BSP_SDMMC_DMA_Tx_IRQHandler(void)
+    {
+        HAL_DMA_IRQHandler(uSdHandle.hdmatx);
+    }
+    void BSP_SDMMC_DMA_Rx_IRQHandler(void)
+    {
+        HAL_DMA_IRQHandler(uSdHandle.hdmarx);
+    }
+    static void LCD_LL_ConvertFrameToARGB8888(void *pSrc, void *pDst)
+    {
+        /* Enable DMA2D clock */
+        __HAL_RCC_DMA2D_CLK_ENABLE();
+
+        /* Configure the DMA2D Mode, Color Mode and output offset */
+        hdma2d_disco.Init.Mode         = DMA2D_M2M_PFC;
+        hdma2d_disco.Init.ColorMode    = DMA2D_ARGB8888;
+        hdma2d_disco.Init.OutputOffset = 0;
+
+        /* Foreground Configuration */
+        hdma2d_disco.LayerCfg[1].AlphaMode = DMA2D_NO_MODIF_ALPHA;
+        hdma2d_disco.LayerCfg[1].InputAlpha = 0xFF;
+        hdma2d_disco.LayerCfg[1].InputColorMode = CM_RGB888;
+        hdma2d_disco.LayerCfg[1].InputOffset = 0;
+
+        hdma2d_disco.Instance = DMA2D;
+
+        /* DMA2D Initialization */
+        if(HAL_DMA2D_Init(&hdma2d_disco) == HAL_OK) {
+            if(HAL_DMA2D_ConfigLayer(&hdma2d_disco, 1) == HAL_OK) {
+                if (HAL_DMA2D_Start(&hdma2d_disco, (uint32_t)pSrc, (uint32_t)pDst, 480, 272) == HAL_OK) {
+                    /* Polling For DMA transfer */
+                    HAL_DMA2D_PollForTransfer(&hdma2d_disco, 10);
+                }
+            }
+        } else {
+
+        }
+    }
+    static void LCD_LL_ConvertFrameToRGB888(void *pSrc, void *pDst)
+    {
+        /* Enable DMA2D clock */
+        __HAL_RCC_DMA2D_CLK_ENABLE();
+
+        /* Configure the DMA2D Mode, Color Mode and output offset */
+        hdma2d_disco.Init.Mode         = DMA2D_M2M_PFC;
+        hdma2d_disco.Init.ColorMode    = DMA2D_RGB888;
+        hdma2d_disco.Init.OutputOffset = 0;
+
+        /* Foreground Configuration */
+        hdma2d_disco.LayerCfg[1].AlphaMode = DMA2D_NO_MODIF_ALPHA;
+        hdma2d_disco.LayerCfg[1].InputAlpha = 0xFF;
+        hdma2d_disco.LayerCfg[1].InputColorMode = CM_ARGB8888;
+        hdma2d_disco.LayerCfg[1].InputOffset = 0;
+
+        hdma2d_disco.Instance = DMA2D;
+
+        /* DMA2D Initialization */
+        if(HAL_DMA2D_Init(&hdma2d_disco) == HAL_OK) {
+            if(HAL_DMA2D_ConfigLayer(&hdma2d_disco, 1) == HAL_OK) {
+                if (HAL_DMA2D_Start(&hdma2d_disco, (uint32_t)pSrc, (uint32_t)pDst, 480, 272) == HAL_OK) {
+                    /* Polling For DMA transfer */
+                    HAL_DMA2D_PollForTransfer(&hdma2d_disco, 10);
+                }
+            }
+        } else {
+
+        }
+    }
+
+}
\ No newline at end of file