Browse Source

[add] spdifrx driver.

thread-liu 4 years ago
parent
commit
b71d496b83

+ 4 - 1
bsp/stm32/libraries/STM32MPxx_HAL/SConscript

@@ -99,7 +99,10 @@ if GetDepend(['BSP_USING_FDCAN']):
 
 if GetDepend(['BSP_USING_QSPI']):
     src += ['STM32MP1xx_HAL_Driver/Src/stm32mp1xx_hal_qspi.c']
-    
+
+if GetDepend(['BSP_USING_SPDIFRX']):
+    src += ['STM32MP1xx_HAL_Driver/Src/stm32mp1xx_hal_spdifrx.c']
+
 path = [cwd + '/STM32MP1xx_HAL_Driver/Inc',
     cwd + '/CMSIS/Device/ST/STM32MP1xx/Include',
     cwd + '/CMSIS/Core/Include',

+ 1 - 1
bsp/stm32/stm32mp157a-st-ev1/board/CubeMX_Config/CM4/Inc/stm32mp1xx_hal_conf.h

@@ -62,7 +62,7 @@
 /*#define HAL_MMC_MODULE_ENABLED   */
 /*#define HAL_RTC_MODULE_ENABLED   */
 /*#define HAL_SMBUS_MODULE_ENABLED   */
-/*#define HAL_SPDIFRX_MODULE_ENABLED   */
+#define HAL_SPDIFRX_MODULE_ENABLED
 #define HAL_SPI_MODULE_ENABLED
 /*#define HAL_SRAM_MODULE_ENABLED   */
 /*#define HAL_TAMP_MODULE_ENABLED   */

+ 70 - 0
bsp/stm32/stm32mp157a-st-ev1/board/CubeMX_Config/CM4/Src/stm32mp1xx_hal_msp.c

@@ -29,6 +29,7 @@
 DMA_HandleTypeDef hdma_sai2_a     = {0};
 DMA_HandleTypeDef hdma_sai2_b     = {0};
 DMA_HandleTypeDef hdma_sai4_a     = {0};
+DMA_HandleTypeDef hdma_spdifrx_rx = {0};
 /* USER CODE END TD */
 
 /* Private define ------------------------------------------------------------*/
@@ -1618,6 +1619,75 @@ void HAL_FDCAN_MspDeInit(FDCAN_HandleTypeDef* hfdcan)
 
 }
 
+void HAL_SPDIFRX_MspInit(SPDIFRX_HandleTypeDef* hspdifrx)
+{
+    GPIO_InitTypeDef GPIO_InitStruct = {0};
+    RCC_PeriphCLKInitTypeDef PeriphClkInit = {0};
+
+    if(hspdifrx->Instance==SPDIFRX)
+    {
+        if(IS_ENGINEERING_BOOT_MODE())
+        {
+
+            PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_SPDIFRX;
+            PeriphClkInit.SpdifrxClockSelection = RCC_SPDIFRXCLKSOURCE_PLL4;
+            if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
+            {
+                Error_Handler();
+            }
+        }
+        /* Peripheral clock enable */
+        __HAL_RCC_SPDIFRX_CLK_ENABLE();
+
+        __HAL_RCC_GPIOG_CLK_ENABLE();
+
+        GPIO_InitStruct.Pin = GPIO_PIN_12;
+        GPIO_InitStruct.Mode = GPIO_MODE_AF;
+        GPIO_InitStruct.Pull = GPIO_NOPULL;
+        GPIO_InitStruct.Alternate = GPIO_AF8_SPDIF;
+        HAL_GPIO_Init(GPIOG, &GPIO_InitStruct);
+
+        __HAL_RCC_DMAMUX_CLK_ENABLE();
+        __HAL_RCC_DMA1_CLK_ENABLE();
+            
+        hdma_spdifrx_rx.Instance                  = DMA1_Stream7;
+        hdma_spdifrx_rx.Init.Request              = DMA_REQUEST_SPDIF_RX_DT;
+        hdma_spdifrx_rx.Init.Direction            = DMA_PERIPH_TO_MEMORY;
+        hdma_spdifrx_rx.Init.PeriphInc            = DMA_PINC_DISABLE;
+        hdma_spdifrx_rx.Init.MemInc               = DMA_MINC_ENABLE;
+        hdma_spdifrx_rx.Init.PeriphDataAlignment  = DMA_PDATAALIGN_WORD;
+        hdma_spdifrx_rx.Init.MemDataAlignment     = DMA_MDATAALIGN_WORD;
+        hdma_spdifrx_rx.Init.Mode                 = DMA_CIRCULAR;
+        hdma_spdifrx_rx.Init.Priority             = DMA_PRIORITY_HIGH;
+        hdma_spdifrx_rx.Init.FIFOMode             = DMA_FIFOMODE_ENABLE;
+        hdma_spdifrx_rx.Init.FIFOThreshold        = DMA_FIFO_THRESHOLD_FULL;
+        hdma_spdifrx_rx.Init.MemBurst             = DMA_MBURST_SINGLE;
+        hdma_spdifrx_rx.Init.PeriphBurst          = DMA_MBURST_SINGLE; 
+  
+        HAL_DMA_DeInit(&hdma_spdifrx_rx);
+        if (HAL_DMA_Init(&hdma_spdifrx_rx) != HAL_OK)
+        {
+            Error_Handler();
+        }
+
+        __HAL_LINKDMA(hspdifrx, hdmaDrRx, hdma_spdifrx_rx);
+        
+        HAL_NVIC_SetPriority(DMA1_Stream7_IRQn, 0x02, 0);
+        HAL_NVIC_EnableIRQ(DMA1_Stream7_IRQn);
+    }
+}
+
+void HAL_SPDIFRX_MspDeInit(SPDIFRX_HandleTypeDef* hspdifrx)
+{
+    if(hspdifrx->Instance==SPDIFRX)
+    {
+        __HAL_RCC_SPDIFRX_CLK_DISABLE();
+
+        HAL_GPIO_DeInit(GPIOG, GPIO_PIN_12);
+        HAL_DMA_DeInit(hspdifrx->hdmaDrRx);
+    }
+}
+
 /**
   * @brief  This function is executed in case of error occurrence.
   * @retval None

+ 9 - 1
bsp/stm32/stm32mp157a-st-ev1/board/Kconfig

@@ -75,6 +75,9 @@ menu "Onboard Peripheral Drivers"
     bool "Enable Audio Device (WM8994)"
     select RT_USING_AUDIO
     select BSP_USING_PMIC
+    select BSP_USING_SDMMC
+    select BSP_USING_SD_CARD
+    select SD_USING_DFS
     select BSP_USING_I2C
     select BSP_USING_I2C2
     default n
@@ -104,7 +107,12 @@ menu "On-chip Peripheral Drivers"
         select RT_USING_QSPI
         select RT_USING_SPI
         default n
-        
+    
+    config BSP_USING_SPDIFRX
+        bool "Enable spdifrx"
+        select BSP_USING_AUDIO
+        default n
+
     menuconfig BSP_USING_UART
         bool "Enable UART"
         select RT_USING_SERIAL

+ 3 - 0
bsp/stm32/stm32mp157a-st-ev1/board/SConscript

@@ -46,6 +46,9 @@ if GetDepend(['BSP_USING_FDCAN']):
 if GetDepend(['BSP_USING_QSPI']):
     src += Glob('ports/drv_qspi_flash.c')
 
+if GetDepend(['BSP_USING_SPDIFRX']):
+    src += Glob('ports/drv_spdifrx.c')
+
 if GetDepend(['BSP_USING_OPENAMP']):
     src +=  Glob('CubeMX_Config/CM4/Src/ipcc.c')
     src +=  Glob('CubeMX_Config/CM4/Src/openamp.c')

+ 303 - 0
bsp/stm32/stm32mp157a-st-ev1/board/ports/drv_spdifrx.c

@@ -0,0 +1,303 @@
+/*
+ * Copyright (c) 2006-2022, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author            Notes
+ * 2020-07-28     thread-liu        the first version
+ */
+
+#include "board.h"
+
+#if defined(BSP_USING_SPDIFRX)
+#include "drv_spdifrx.h"
+
+#define DRV_DEBUG
+#define LOG_TAG             "drv.spdifrx"
+#include <drv_log.h>
+
+struct stm32_spdifrx
+{
+    struct rt_device dev;  
+    SPDIFRX_HandleTypeDef spdifrx;
+    SAI_HandleTypeDef sai4;
+    volatile rt_uint8_t complate;
+};
+static struct stm32_spdifrx rt_spdifrx = {0};
+
+extern DMA_HandleTypeDef hdma_spdifrx_rx;
+extern DMA_HandleTypeDef hdma_sai4_a;
+
+static void sai4a_init(SAI_HandleTypeDef* sai)
+{
+    sai->Instance                 = SAI4_Block_A;
+    sai->Init.Protocol            = SAI_SPDIF_PROTOCOL;
+    sai->Init.AudioMode           = SAI_MODEMASTER_TX;
+    sai->Init.Synchro             = SAI_ASYNCHRONOUS;
+    sai->Init.OutputDrive         = SAI_OUTPUTDRIVE_DISABLE;
+    sai->Init.FIFOThreshold       = SAI_FIFOTHRESHOLD_EMPTY;
+    sai->Init.AudioFrequency      = SAI_AUDIO_FREQUENCY_96K;
+    sai->Init.MonoStereoMode      = SAI_STEREOMODE;
+    sai->Init.CompandingMode      = SAI_NOCOMPANDING;
+    sai->Init.PdmInit.Activation  = DISABLE;
+    sai->Init.PdmInit.MicPairsNbr = 0;
+    sai->Init.PdmInit.ClockEnable = SAI_PDM_CLOCK1_ENABLE;
+    sai->Init.DataSize            = SAI_DATASIZE_24;
+    sai->Init.FirstBit            = SAI_FIRSTBIT_MSB;
+    sai->Init.ClockStrobing       = SAI_CLOCKSTROBING_FALLINGEDGE;
+    
+    sai->FrameInit.FrameLength       = 64;
+    sai->FrameInit.ActiveFrameLength = 32;
+    sai->FrameInit.FSDefinition      = SAI_FS_STARTFRAME;
+    sai->FrameInit.FSPolarity        = SAI_FS_ACTIVE_LOW;
+    sai->FrameInit.FSOffset          = SAI_FS_FIRSTBIT;
+
+    sai->SlotInit.FirstBitOffset = 0;
+    sai->SlotInit.SlotSize       = SAI_SLOTSIZE_DATASIZE;
+    sai->SlotInit.SlotNumber     = 4;
+    sai->SlotInit.SlotActive     = SAI_SLOTACTIVE_ALL;
+    
+    if (HAL_SAI_Init(sai) != HAL_OK)
+    {
+        Error_Handler();
+    }
+}
+
+void DMA1_Stream7_IRQHandler(void)
+{ 
+    /* enter interrupt */
+    rt_interrupt_enter();
+    
+    HAL_DMA_IRQHandler(&hdma_spdifrx_rx);
+    
+    /* leave interrupt */
+    rt_interrupt_leave();
+}
+
+void DMA1_Stream2_IRQHandler(void)
+{
+    /* enter interrupt */
+    rt_interrupt_enter();
+    
+    HAL_DMA_IRQHandler(&hdma_sai4_a);
+    
+    /* leave interrupt */
+    rt_interrupt_leave();
+}
+
+void HAL_SPDIFRX_RxCpltCallback(SPDIFRX_HandleTypeDef *hspdif)
+{
+    rt_spdifrx.complate = SET;
+}
+
+static rt_err_t _init(rt_device_t dev)
+{
+    RT_ASSERT(dev != RT_NULL);
+    struct stm32_spdifrx *device = (struct stm32_spdifrx *)dev;
+    
+    device->spdifrx.Instance = SPDIFRX;
+    HAL_SPDIFRX_DeInit(&device->spdifrx); 
+    
+    device->spdifrx.Init.InputSelection     = SPDIFRX_INPUT_IN1;
+    device->spdifrx.Init.Retries            = SPDIFRX_MAXRETRIES_15;
+    device->spdifrx.Init.WaitForActivity    = SPDIFRX_WAITFORACTIVITY_ON;
+    device->spdifrx.Init.ChannelSelection   = SPDIFRX_CHANNEL_A;
+    device->spdifrx.Init.DataFormat         = SPDIFRX_DATAFORMAT_MSB;
+    device->spdifrx.Init.StereoMode         = SPDIFRX_STEREOMODE_ENABLE;
+    device->spdifrx.Init.PreambleTypeMask   = SPDIFRX_PREAMBLETYPEMASK_ON;
+    device->spdifrx.Init.ChannelStatusMask  = SPDIFRX_CHANNELSTATUS_ON;  
+    
+    if (HAL_SPDIFRX_Init(&device->spdifrx) != HAL_OK)
+    {
+        return RT_ERROR;
+    }
+    
+    sai4a_init(&device->sai4);
+    
+    rt_spdifrx.complate = RESET;
+    
+    return RT_EOK;
+}
+
+static rt_err_t _open(rt_device_t dev, rt_uint16_t oflag)
+{
+    RT_ASSERT(dev != RT_NULL);
+    
+    return RT_EOK;
+}
+
+static rt_err_t _close(rt_device_t dev)
+{
+    RT_ASSERT(dev != RT_NULL);
+    
+    return RT_EOK;
+}
+
+static rt_size_t _read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
+{
+    rt_uint32_t tickstart = 0;
+    
+    RT_ASSERT(dev != RT_NULL);
+    struct stm32_spdifrx *device = (struct stm32_spdifrx *)dev;
+    rt_err_t result = RT_EOK;
+    
+    result = HAL_SPDIFRX_ReceiveDataFlow_DMA(&device->spdifrx, (uint32_t *)buffer, size);
+    if (result != HAL_OK)
+    {
+        return 0;
+    }
+    
+    if(device->spdifrx.ErrorCode != HAL_SPDIFRX_ERROR_NONE)
+    {
+        return 0;
+    }
+    
+    tickstart = rt_tick_get();
+    while (rt_spdifrx.complate == RESET)
+    {
+        if (rt_tick_get() - tickstart > 0xFFFF)
+        {
+            return 0;
+        }
+    }
+    
+    rt_spdifrx.complate = RESET;
+    
+    return size;
+}
+
+static rt_size_t _write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
+{
+    RT_ASSERT(dev != RT_NULL);
+
+    struct stm32_spdifrx *device = (struct stm32_spdifrx *)dev;
+    rt_err_t result = RT_EOK;
+    
+    result = HAL_SAI_Transmit_DMA(&device->sai4, (rt_uint8_t *)buffer, size);
+    if (result != HAL_OK)
+    {
+        return RT_ERROR;
+    }
+    
+    return RT_EOK;
+}
+
+static rt_err_t _control(rt_device_t dev, int cmd, void *args)
+{
+    RT_ASSERT(dev != RT_NULL);
+
+    return RT_EOK;
+}
+
+int spdifrx_init(void)
+{
+    rt_spdifrx.dev.type      = RT_Device_Class_Miscellaneous;
+    rt_spdifrx.dev.init      = _init;
+    rt_spdifrx.dev.open      = _open;
+    rt_spdifrx.dev.close     = _close;
+    rt_spdifrx.dev.read      = _read;
+    rt_spdifrx.dev.write     = _write;
+    rt_spdifrx.dev.control   = _control;
+    rt_spdifrx.dev.user_data = RT_NULL;
+
+    rt_device_register(&rt_spdifrx.dev, "spdifrx", RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_REMOVABLE | RT_DEVICE_FLAG_STANDALONE);
+    rt_device_init(&rt_spdifrx.dev);
+    
+    LOG_I("spdifrx init success!");
+    
+    return RT_EOK; 
+}
+INIT_DEVICE_EXPORT(spdifrx_init);
+
+#ifdef FINSH_USING_MSH
+#include <finsh.h>
+
+#define __is_print(ch) ((unsigned int)((ch) - ' ') < 127u - ' ')
+static void dump_hex(const rt_uint8_t *ptr, rt_size_t buflen)
+{
+    unsigned char *buf = (unsigned char *)ptr;
+    int i, j;
+
+    for (i = 0; i < buflen; i += 16)
+    {
+        rt_kprintf("%08X: ", i);
+
+        for (j = 0; j < 16; j++)
+            if (i + j < buflen)
+                rt_kprintf("%02X ", buf[i + j]);
+            else
+                rt_kprintf("   ");
+        rt_kprintf(" ");
+
+        for (j = 0; j < 16; j++)
+            if (i + j < buflen)
+                rt_kprintf("%c", __is_print(buf[i + j]) ? buf[i + j] : '.');
+        rt_kprintf("\n");
+    }
+}
+
+static int spdifrx_sample(int argc, char **argv)
+{
+    extern SAI_HandleTypeDef hsai_block4_a;
+
+    if (argc != 1)
+    {
+        rt_kprintf("Usage:\n");
+        rt_kprintf("spdifrx_sample\n");
+        return -1;
+    }
+    
+    /* 16 bit Data Buffer for Transmission */ 
+    static rt_uint16_t tx_buffer[64] = {
+    0x5152, 0x5354, 0x5556, 0x5758, 0x595A, 0x5B5C, 0x5D5E, 0x5F60,
+    0x6162, 0x6364, 0x6566, 0x6768, 0x696A, 0x6B6C, 0x6D6E, 0x6F70,
+    0x7172, 0x7374, 0x7576, 0x7778, 0x797A, 0x7B7C, 0x7D7E, 0x7F80,
+    0x8182, 0x8384, 0x8586, 0x8788, 0x898A, 0x8B8C, 0x8D8E, 0x8F90,
+    0x5152, 0x5354, 0x5556, 0x5758, 0x595A, 0x5B5C, 0x5D5E, 0x5F60,
+    0x6162, 0x6364, 0x6566, 0x6768, 0x696A, 0x6B6C, 0x6D6E, 0x6F70,
+    0x7172, 0x7374, 0x7576, 0x7778, 0x797A, 0x7B7C, 0x7D7E, 0x7F80,
+    0x8182, 0x8384, 0x8586, 0x8788, 0x898A, 0x8B8C, 0x8D8E, 0x8F90};
+    
+    static rt_uint32_t *rx_buffer = NULL;
+    rt_uint8_t size = 64;
+    struct rt_device *dev = RT_NULL;
+    
+    dev = rt_device_find("spdifrx");
+    if (dev == RT_NULL)
+    {
+        rt_kprintf("can't find spdifrx device!\n");
+    }
+
+    rt_device_open(dev, RT_DEVICE_OFLAG_RDWR);
+    
+    rt_kprintf("spdifrx test tx data : \n");
+    dump_hex((rt_uint8_t *)tx_buffer, size);
+    
+    rx_buffer = (rt_uint32_t *)rt_malloc(size);
+    
+    rt_device_write(dev, 0, tx_buffer, size);
+    rt_device_read(dev, 0, rx_buffer, size);
+    
+    /* Compare the received data with the expected one */    
+    while (size--)
+    {
+        if (((rx_buffer[size] & 0x00ffff00) >>  8) != (tx_buffer[size]))
+        {
+            rt_kprintf("spdirex loopback mode test failed!\n");
+            
+            return RT_ERROR;
+        }
+    }
+    
+    rt_kprintf("spdifrx rx : \n");
+    dump_hex((rt_uint8_t *)rx_buffer, size);
+    
+    rt_kprintf("spdirex loopback mode test success!\n");
+    
+    return RT_EOK;
+}
+MSH_CMD_EXPORT(spdifrx_sample, spdifrx loopback test);
+#endif
+
+#endif

+ 0 - 0
bsp/stm32/stm32mp157a-st-ev1/board/ports/drv_spdifrx.h