[add] spdifrx driver.
This commit is contained in:
thread-liu
parent
dbd67507d9
commit
b71d496b83
|
|
@ -100,6 +100,9 @@ if GetDepend(['BSP_USING_FDCAN']):
|
||||||
if GetDepend(['BSP_USING_QSPI']):
|
if GetDepend(['BSP_USING_QSPI']):
|
||||||
src += ['STM32MP1xx_HAL_Driver/Src/stm32mp1xx_hal_qspi.c']
|
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',
|
path = [cwd + '/STM32MP1xx_HAL_Driver/Inc',
|
||||||
cwd + '/CMSIS/Device/ST/STM32MP1xx/Include',
|
cwd + '/CMSIS/Device/ST/STM32MP1xx/Include',
|
||||||
cwd + '/CMSIS/Core/Include',
|
cwd + '/CMSIS/Core/Include',
|
||||||
|
|
|
||||||
|
|
@ -62,7 +62,7 @@
|
||||||
/*#define HAL_MMC_MODULE_ENABLED */
|
/*#define HAL_MMC_MODULE_ENABLED */
|
||||||
/*#define HAL_RTC_MODULE_ENABLED */
|
/*#define HAL_RTC_MODULE_ENABLED */
|
||||||
/*#define HAL_SMBUS_MODULE_ENABLED */
|
/*#define HAL_SMBUS_MODULE_ENABLED */
|
||||||
/*#define HAL_SPDIFRX_MODULE_ENABLED */
|
#define HAL_SPDIFRX_MODULE_ENABLED
|
||||||
#define HAL_SPI_MODULE_ENABLED
|
#define HAL_SPI_MODULE_ENABLED
|
||||||
/*#define HAL_SRAM_MODULE_ENABLED */
|
/*#define HAL_SRAM_MODULE_ENABLED */
|
||||||
/*#define HAL_TAMP_MODULE_ENABLED */
|
/*#define HAL_TAMP_MODULE_ENABLED */
|
||||||
|
|
|
||||||
|
|
@ -29,6 +29,7 @@
|
||||||
DMA_HandleTypeDef hdma_sai2_a = {0};
|
DMA_HandleTypeDef hdma_sai2_a = {0};
|
||||||
DMA_HandleTypeDef hdma_sai2_b = {0};
|
DMA_HandleTypeDef hdma_sai2_b = {0};
|
||||||
DMA_HandleTypeDef hdma_sai4_a = {0};
|
DMA_HandleTypeDef hdma_sai4_a = {0};
|
||||||
|
DMA_HandleTypeDef hdma_spdifrx_rx = {0};
|
||||||
/* USER CODE END TD */
|
/* USER CODE END TD */
|
||||||
|
|
||||||
/* Private define ------------------------------------------------------------*/
|
/* 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.
|
* @brief This function is executed in case of error occurrence.
|
||||||
* @retval None
|
* @retval None
|
||||||
|
|
|
||||||
|
|
@ -75,6 +75,9 @@ menu "Onboard Peripheral Drivers"
|
||||||
bool "Enable Audio Device (WM8994)"
|
bool "Enable Audio Device (WM8994)"
|
||||||
select RT_USING_AUDIO
|
select RT_USING_AUDIO
|
||||||
select BSP_USING_PMIC
|
select BSP_USING_PMIC
|
||||||
|
select BSP_USING_SDMMC
|
||||||
|
select BSP_USING_SD_CARD
|
||||||
|
select SD_USING_DFS
|
||||||
select BSP_USING_I2C
|
select BSP_USING_I2C
|
||||||
select BSP_USING_I2C2
|
select BSP_USING_I2C2
|
||||||
default n
|
default n
|
||||||
|
|
@ -105,6 +108,11 @@ menu "On-chip Peripheral Drivers"
|
||||||
select RT_USING_SPI
|
select RT_USING_SPI
|
||||||
default n
|
default n
|
||||||
|
|
||||||
|
config BSP_USING_SPDIFRX
|
||||||
|
bool "Enable spdifrx"
|
||||||
|
select BSP_USING_AUDIO
|
||||||
|
default n
|
||||||
|
|
||||||
menuconfig BSP_USING_UART
|
menuconfig BSP_USING_UART
|
||||||
bool "Enable UART"
|
bool "Enable UART"
|
||||||
select RT_USING_SERIAL
|
select RT_USING_SERIAL
|
||||||
|
|
|
||||||
|
|
@ -46,6 +46,9 @@ if GetDepend(['BSP_USING_FDCAN']):
|
||||||
if GetDepend(['BSP_USING_QSPI']):
|
if GetDepend(['BSP_USING_QSPI']):
|
||||||
src += Glob('ports/drv_qspi_flash.c')
|
src += Glob('ports/drv_qspi_flash.c')
|
||||||
|
|
||||||
|
if GetDepend(['BSP_USING_SPDIFRX']):
|
||||||
|
src += Glob('ports/drv_spdifrx.c')
|
||||||
|
|
||||||
if GetDepend(['BSP_USING_OPENAMP']):
|
if GetDepend(['BSP_USING_OPENAMP']):
|
||||||
src += Glob('CubeMX_Config/CM4/Src/ipcc.c')
|
src += Glob('CubeMX_Config/CM4/Src/ipcc.c')
|
||||||
src += Glob('CubeMX_Config/CM4/Src/openamp.c')
|
src += Glob('CubeMX_Config/CM4/Src/openamp.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
|
||||||
Loading…
Reference in New Issue