From 34f993d35afa001a3de17934f9a283ecf26c0533 Mon Sep 17 00:00:00 2001 From: "bernard.xiong" Date: Wed, 19 Aug 2009 14:06:56 +0000 Subject: [PATCH] update stm32 radio code; git-svn-id: https://rt-thread.googlecode.com/svn/trunk@23 bbd45198-f89e-11dd-88c7-29a3b14d5316 --- bsp/stm32_radio/wav.c | 105 +++++++++ bsp/stm32_radio/wm8753.c | 494 +++++++++++++++++++++++++++++++++++++++ 2 files changed, 599 insertions(+) create mode 100644 bsp/stm32_radio/wav.c create mode 100644 bsp/stm32_radio/wm8753.c diff --git a/bsp/stm32_radio/wav.c b/bsp/stm32_radio/wav.c new file mode 100644 index 0000000000..abf169cfb2 --- /dev/null +++ b/bsp/stm32_radio/wav.c @@ -0,0 +1,105 @@ +#include +#include +#include "stm32f10x_lib.h" + +rt_uint32_t wav_length; +rt_uint8_t* wav_buffer; + +#define WAV_MP_NUM 2 +#define WAV_MP_BUFSZ (1024 * 1) +#define STATIC_MEMPOOL +#ifdef STATIC_MEMPOOL +static rt_uint8_t mempool[(WAV_MP_BUFSZ + 4)* WAV_MP_NUM]; // 5k x 2 +static struct rt_mempool _mp; +#endif +static rt_mp_t mp; + +static rt_err_t wav_tx_done(rt_device_t dev, void *buffer) +{ + /* release memory block to memory pool */ + rt_mp_free(buffer); + + return RT_EOK; +} + +void wav(char* filename) +{ + int fd; + +#ifdef STATIC_MEMPOOL + rt_mp_init(&_mp, "wav", &mempool[0], sizeof(mempool), WAV_MP_BUFSZ); + mp = &_mp; +#else + mp = rt_mp_create("wav", WAV_MP_NUM, WAV_MP_BUFSZ); +#endif + + fd = open(filename, O_RDONLY, 0); + if (fd >= 0) + { + rt_uint8_t* buf; + rt_size_t len; + rt_device_t device; + + /* open audio device and set tx done call back */ + device = rt_device_find("snd"); + rt_device_set_tx_complete(device, wav_tx_done); + rt_device_open(device, RT_DEVICE_OFLAG_WRONLY); + + // buf = rt_mp_alloc(mp, RT_WAITING_FOREVER); + // len = read(fd, (char*)buf, WAV_MP_BUFSZ); + + do { + buf = rt_mp_alloc(mp, RT_WAITING_FOREVER); + rt_kprintf("read file"); + len = read(fd, (char*)buf, WAV_MP_BUFSZ); + rt_kprintf("...done!\n"); + if (len > 0) rt_device_write(device, 0, buf, len); + } while (len != 0); + + /* close device and file */ + rt_device_close(device); + close(fd); + + /* delete memory pool */ +#ifdef STATIC_MEMPOOL + rt_mp_detach(mp); +#else + rt_mp_delete(mp); +#endif + } +} +FINSH_FUNCTION_EXPORT(wav, wav test) + +/* DMA Test */ +#define BufferSize 32 +u8 SPI2_Buffer_Tx[BufferSize] = {0x51,0x52,0x53,0x54,0x55,0x56,0x57,0x58,0x59, + 0x5A,0x5B,0x5C,0x5D,0x5E,0x5F,0x60,0x61,0x62, + 0x63,0x64,0x65,0x66,0x67,0x68,0x69,0x6A,0x6B, + 0x6C,0x6D,0x6E,0x6F,0x70}; + +void wm(int cnt) +{ + rt_device_t device; + rt_uint8_t *buf; + + mp = rt_mp_create("wav", WAV_MP_NUM, WAV_MP_BUFSZ); + + device = rt_device_find("snd"); + rt_device_set_tx_complete(device, wav_tx_done); + rt_device_open(device, RT_DEVICE_OFLAG_WRONLY); + + while(cnt) + { + buf = rt_mp_alloc(mp, RT_WAITING_FOREVER); + rt_memcpy(buf, SPI2_Buffer_Tx, BufferSize); + + rt_device_write(device, 0, buf, BufferSize); + + cnt --; + } + + rt_device_close(device); + rt_mp_delete(mp); +} +FINSH_FUNCTION_EXPORT(wm, wm test) + diff --git a/bsp/stm32_radio/wm8753.c b/bsp/stm32_radio/wm8753.c new file mode 100644 index 0000000000..2a3bed8895 --- /dev/null +++ b/bsp/stm32_radio/wm8753.c @@ -0,0 +1,494 @@ +#include +#include +#include "stm32f10x_lib.h" + +/* + * WM8753 Driver + */ + +/* WM8753 register definitions */ +#define WM8753_DAC 0x01 +#define WM8753_ADC 0x02 +#define WM8753_PCM 0x03 +#define WM8753_HIFI 0x04 +#define WM8753_IOCTL 0x05 +#define WM8753_SRATE1 0x06 +#define WM8753_SRATE2 0x07 +#define WM8753_LDAC 0x08 +#define WM8753_RDAC 0x09 +#define WM8753_BASS 0x0a +#define WM8753_TREBLE 0x0b +#define WM8753_ALC1 0x0c +#define WM8753_ALC2 0x0d +#define WM8753_ALC3 0x0e +#define WM8753_NGATE 0x0f +#define WM8753_LADC 0x10 +#define WM8753_RADC 0x11 +#define WM8753_ADCTL1 0x12 +#define WM8753_3D 0x13 +#define WM8753_PWR1 0x14 +#define WM8753_PWR2 0x15 +#define WM8753_PWR3 0x16 +#define WM8753_PWR4 0x17 +#define WM8753_ID 0x18 +#define WM8753_INTPOL 0x19 +#define WM8753_INTEN 0x1a +#define WM8753_GPIO1 0x1b +#define WM8753_GPIO2 0x1c +#define WM8753_RESET 0x1f +#define WM8753_RECMIX1 0x20 +#define WM8753_RECMIX2 0x21 +#define WM8753_LOUTM1 0x22 +#define WM8753_LOUTM2 0x23 +#define WM8753_ROUTM1 0x24 +#define WM8753_ROUTM2 0x25 +#define WM8753_MOUTM1 0x26 +#define WM8753_MOUTM2 0x27 +#define WM8753_LOUT1V 0x28 +#define WM8753_ROUT1V 0x29 +#define WM8753_LOUT2V 0x2a +#define WM8753_ROUT2V 0x2b +#define WM8753_MOUTV 0x2c +#define WM8753_OUTCTL 0x2d +#define WM8753_ADCIN 0x2e +#define WM8753_INCTL1 0x2f +#define WM8753_INCTL2 0x30 +#define WM8753_LINVOL 0x31 +#define WM8753_RINVOL 0x32 +#define WM8753_MICBIAS 0x33 +#define WM8753_CLOCK 0x34 +#define WM8753_PLL1CTL1 0x35 +#define WM8753_PLL1CTL2 0x36 +#define WM8753_PLL1CTL3 0x37 +#define WM8753_PLL1CTL4 0x38 +#define WM8753_PLL2CTL1 0x39 +#define WM8753_PLL2CTL2 0x3a +#define WM8753_PLL2CTL3 0x3b +#define WM8753_PLL2CTL4 0x3c +#define WM8753_BIASCTL 0x3d +#define WM8753_ADCTL2 0x3f + +/* +SCLK PA3 SPI1_SCK +SDIN PA7 SPI1_MOSI +CSB PA2 SPI1_NSS +*/ +#define wm_sclk_0 GPIO_ResetBits(GPIOA,GPIO_Pin_3) +#define wm_sclk_1 GPIO_SetBits(GPIOA,GPIO_Pin_3) +#define wm_sdin_0 GPIO_ResetBits(GPIOA,GPIO_Pin_7) +#define wm_sdin_1 GPIO_SetBits(GPIOA,GPIO_Pin_7) +#define wm_csb_0 GPIO_ResetBits(GPIOA,GPIO_Pin_2) +#define wm_csb_1 GPIO_SetBits(GPIOA,GPIO_Pin_2) + +#define DATA_NODE_MAX 5 +/* data node for Tx Mode */ +struct wm8753_data_node +{ + rt_uint16_t *data_ptr; + rt_size_t data_size; +}; + +struct wm8753_device +{ + /* inherit from rt_device */ + struct rt_device parent; + + /* pcm data list */ + struct wm8753_data_node data_list[DATA_NODE_MAX]; + rt_uint16_t read_index, put_index; + + /* transmitted offset of current data node */ + rt_size_t offset; +}; +struct wm8753_device wm8753; + +static void NVIC_Configuration(void) +{ + NVIC_InitTypeDef NVIC_InitStructure; + NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0); + + /* SPI2 IRQ Channel configuration */ + NVIC_InitStructure.NVIC_IRQChannel = SPI2_IRQChannel; + NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1; + NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; + NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; + NVIC_Init(&NVIC_InitStructure); + + /* DMA1 IRQ Channel configuration */ + NVIC_InitStructure.NVIC_IRQChannel = DMA1_Channel5_IRQChannel; + NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1; + NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; + NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; + NVIC_Init(&NVIC_InitStructure); +} + +static void GPIO_Configuration(void) +{ + GPIO_InitTypeDef GPIO_InitStructure; + + /* Disable the JTAG interface and enable the SWJ interface */ + GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE); + + /* Configure GPIOA 2, 3, 7 */ + GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2 | GPIO_Pin_3 | GPIO_Pin_7; + GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; + GPIO_InitStructure.GPIO_Speed = GPIO_Speed_10MHz; + GPIO_Init(GPIOA,&GPIO_InitStructure); + + /* Configure SPI2 pins: CK, WS and SD */ + GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_15; + GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; + GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; + GPIO_Init(GPIOB, &GPIO_InitStructure); +} + +#define SPI2_DR_Address 0x4000380C +static void DMA_Configuration(rt_uint32_t addr, rt_size_t size) +{ + DMA_InitTypeDef DMA_InitStructure; + + /* DMA1 Channel2 configuration ----------------------------------------------*/ + DMA_Cmd(DMA1_Channel5, DISABLE); + DMA_InitStructure.DMA_PeripheralBaseAddr = (u32)SPI2_DR_Address; + DMA_InitStructure.DMA_MemoryBaseAddr = (u32)addr; + DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralDST; + DMA_InitStructure.DMA_BufferSize = size; + DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable; + DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable; + DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord; + DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord; + DMA_InitStructure.DMA_Priority = DMA_Priority_Medium; + DMA_InitStructure.DMA_Mode = DMA_Mode_Normal; + DMA_InitStructure.DMA_M2M = DMA_M2M_Disable; + DMA_Init(DMA1_Channel5, &DMA_InitStructure); + + /* Enable SPI2 DMA Tx request */ + SPI_I2S_DMACmd(SPI2, SPI_I2S_DMAReq_Tx, ENABLE); + + DMA_ITConfig(DMA1_Channel5, DMA_IT_TC, ENABLE); + DMA_Cmd(DMA1_Channel5, ENABLE); +} + +static void I2S_Configuration(void) +{ + I2S_InitTypeDef I2S_InitStructure; + + /* I2S peripheral configuration */ + I2S_InitStructure.I2S_Standard = I2S_Standard_LSB; + I2S_InitStructure.I2S_DataFormat = I2S_DataFormat_16b; + I2S_InitStructure.I2S_MCLKOutput = I2S_MCLKOutput_Disable; + I2S_InitStructure.I2S_AudioFreq = I2S_AudioFreq_44k; + I2S_InitStructure.I2S_CPOL = I2S_CPOL_High;// I2S_CPOL_Low + + /* I2S2 Master Transmitter to I2S3 Slave Receiver communication -----------*/ + /* I2S2 configuration */ + I2S_InitStructure.I2S_Mode = I2S_Mode_MasterTx;//I2S_Mode_MasterTx + I2S_Init(SPI2, &I2S_InitStructure); +} + +void wm8753_send(rt_uint16_t s_data) +{ + u8 i; + wm_sclk_0; + + for(i=0;i<16;i++) + { + if(s_data & 0x8000) + { + wm_sdin_1; + } + else + { + wm_sdin_0; + } + //wde(); + wm_sclk_1; + //wde(); + s_data <<= 1; + wm_sclk_0; + //wde(); + } + + wm_csb_0; + //wde(); + wm_csb_1; +} + +void wm8753_hw_write(rt_uint16_t reg, rt_uint16_t value) +{ + rt_uint32_t index; + + value = (reg << 9) | value; + + wm_sclk_0; + for(index = 0; index < 16; index++) + { + if(value & 0x8000) wm_sdin_1; + else wm_sdin_0; + + wm_sclk_1; + value <<= 1; + wm_sclk_0; + } + + wm_csb_0; + wm_csb_1; +} + +static rt_err_t wm8753_init (rt_device_t dev) +{ + wm8753_send(31<<9 | 0); // reset + + wm8753_send(20<<9 | (1<<7) | 1<<6 | 1<<3 | 1<<2 ); // 打开电源 处理部分 + //wm8753_send(21<<9 | 0x1FF); + wm8753_send(22<<9 | 1<<3 | 1<<7 | 1<<8 | 1<<5 | 1<<6 ); // 电源管理 功率输出部分 + wm8753_send(23<<9 | 1<<1 | 1 ); // 打开左右调音台电源 + + /* 设置时钟及PLL　 */ + #define MCLK1DIV2 0 + #define pll1_N 11 // 12 + #define pll1_K 0x1288CE // 0x126E97 //0x126E97 + + #if pll1_K > 0x3FFFFF + #warning MAX bit(21:0) + #endif + + wm8753_send(53<<9 | 1<<5 | MCLK1DIV2<<3 | 1<<2 | 1<<1 | 1 ); + wm8753_send(54<<9 | pll1_N<<5 | (pll1_K>>18) ); + wm8753_send(55<<9 | ( (pll1_K>>9)&0x1FF ) ); + wm8753_send(56<<9 | ( (pll1_K)&0x1FF ) ); + + wm8753_send(52<<9 | 1<<1 | 1 ); // 打开CLK输出 测试用 可以不设置 + /* 设置时钟及PLL　 */ + + /* 设置IIS及DAC */ + // wm8753_send(6<<9 | 0<<1 | 0 ); // 48K + wm8753_send(6<<9 | 1<<5 | 0 ); // 44.1K + wm8753_send(4<<9 | 0<<6 | 2 ); // 6.master IIS + wm8753_send(1<<9 | 0 ); // 关闭DAC静音 + /* 设置IIS及DAC */ + + /* 设置模拟通道及功放输出部分 */ + wm8753_send(34<<9 | 1<<8 | 1<<7 | 4<<4 ); // DAC LINE + wm8753_send(36<<9 | 1<<8 | 1<<7 | 4<<4 ); // DAC LINE + + wm8753_send(40<<9 | 1<<8 | 1<<7 | 110); // 耳机音量 + wm8753_send(41<<9 | 1<<8 | 1<<7 | 110); // 耳机音量 + + wm8753_send(45<<9 | 1<<2); // 设置ROUT反向 + wm8753_send(43<<9 | 1<<8 | 1<<7 | 70 ); //喇叭音量 + + return RT_EOK; +} + +#include +void vol(int v) +{ + wm8753_send(40<<9 | 1<<8 | 1<<7 | v); // 耳机音量 + wm8753_send(41<<9 | 1<<8 | 1<<7 | v); // 耳机音量 +} +FINSH_FUNCTION_EXPORT(vol, set volume) + +static rt_err_t wm8753_open(rt_device_t dev, rt_uint16_t oflag) +{ + /* enable I2S */ + I2S_Cmd(SPI2, ENABLE); + + return RT_EOK; +} + +static rt_err_t wm8753_close(rt_device_t dev) +{ + /* interrupt mode */ + if (dev->flag & RT_DEVICE_FLAG_INT_TX) + { + /* Disable the I2S2 */ + I2S_Cmd(SPI2, DISABLE); + } + + /* remove all data node */ + + return RT_EOK; +} + +static rt_err_t wm8753_control(rt_device_t dev, rt_uint8_t cmd, void *args) +{ + /* rate control */ + return RT_EOK; +} + +static rt_size_t wm8753_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size) +{ + struct wm8753_device* device; + struct wm8753_data_node* node; + rt_uint32_t level; + rt_uint16_t next_index; + + device = (struct wm8753_device*)dev; + RT_ASSERT(device != RT_NULL); + + next_index = device->put_index + 1; + if (next_index >= DATA_NODE_MAX) next_index = 0; + + /* check data_list full */ + if (next_index == device->read_index) + { + rt_set_errno(-RT_EFULL); + return 0; + } + + level = rt_hw_interrupt_disable(); + node = &device->data_list[device->put_index]; + device->put_index = next_index; + + // rt_kprintf("+\n"); + /* set node attribute */ + node->data_ptr = (rt_uint16_t*)buffer; + node->data_size = size >> 1; /* size is byte unit, convert to half word unit */ + +// #if 0 + { + /* sound patch */ + rt_uint32_t index; + for (index = 0; index < node->data_size; index ++) + { + ((rt_int16_t*)(node->data_ptr))[index] = (rt_int16_t)(node->data_ptr[index] + 0x8000); + } + } +// #endif + + next_index = device->read_index + 1; + if (next_index >= DATA_NODE_MAX) next_index = 0; + + /* check data list whether is empty */ + if (next_index == device->put_index) + { + if (dev->flag & RT_DEVICE_FLAG_INT_TX) + { + device->offset = 0; + /* enable I2S interrupt */ + SPI_I2S_ITConfig(SPI2, SPI_I2S_IT_TXE, ENABLE); + } + else if (dev->flag & RT_DEVICE_FLAG_DMA_TX) + { + DMA_Configuration((rt_uint32_t)node->data_ptr, node->data_size); + } + } + rt_hw_interrupt_enable(level); + + return size; +} + +rt_err_t wm8753_hw_init(void) +{ + rt_device_t dev; + + RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB, ENABLE); + RCC_APB1PeriphClockCmd(RCC_APB1Periph_SPI2, ENABLE); + RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE); + + NVIC_Configuration(); + GPIO_Configuration(); + I2S_Configuration(); + + dev = (rt_device_t)&wm8753; + dev->type = RT_Device_Class_Unknown; + dev->rx_indicate = RT_NULL; + dev->tx_complete = RT_NULL; + dev->init = wm8753_init; + dev->open = wm8753_open; + dev->close = wm8753_close; + dev->read = RT_NULL; + dev->write = wm8753_write; + dev->control = wm8753_control; + dev->private = RT_NULL; + + /* set read_index and put index to 0 */ + wm8753.read_index = 0; + wm8753.put_index = 0; + + wm_sclk_0; + wm_sclk_1; + wm_sclk_0; + + wm_sdin_0; + wm_sdin_1; + wm_sdin_0; + + wm_csb_0; + wm_csb_1; + + /* register the device */ + return rt_device_register(&wm8753.parent, "snd", + RT_DEVICE_FLAG_WRONLY | RT_DEVICE_FLAG_DMA_TX); +} + +void wm8753_isr() +{ + struct wm8753_data_node* node; + node = &wm8753.data_list[wm8753.read_index]; /* get current data node */ + + if (SPI_I2S_GetITStatus(SPI2, SPI_I2S_IT_TXE) == SET) + { + SPI_I2S_SendData(SPI2, node->data_ptr[wm8753.offset++]); + } + + if (wm8753.offset == node->data_size) + { + /* move to next node */ + rt_uint16_t next_index; + + next_index = wm8753.read_index + 1; + if (next_index >= DATA_NODE_MAX) next_index = 0; + + /* notify transmitted complete. */ + if (wm8753.parent.tx_complete != RT_NULL) + { + wm8753.parent.tx_complete (&wm8753.parent, wm8753.data_list[wm8753.read_index].data_ptr); + rt_kprintf("-\n"); + } + + wm8753.offset = 0; + wm8753.read_index = next_index; + if (next_index == wm8753.put_index) + { + /* no data on the list, disable I2S interrupt */ + SPI_I2S_ITConfig(SPI2, SPI_I2S_IT_TXE, DISABLE); + + rt_kprintf("*\n"); + } + } +} + +void wm8753_dma_isr() +{ + /* switch to next buffer */ + rt_uint16_t next_index; + void* data_ptr; + + next_index = wm8753.read_index + 1; + if (next_index >= DATA_NODE_MAX) next_index = 0; + + /* save current data pointer */ + data_ptr = wm8753.data_list[wm8753.read_index].data_ptr; + + wm8753.read_index = next_index; + if (next_index != wm8753.put_index) + { + /* enable next dma request */ + DMA_Configuration((rt_uint32_t)wm8753.data_list[wm8753.read_index].data_ptr, + wm8753.data_list[wm8753.read_index].data_size); + } + else + { + rt_kprintf("*\n"); + } + + /* notify transmitted complete. */ + if (wm8753.parent.tx_complete != RT_NULL) + { + wm8753.parent.tx_complete (&wm8753.parent, data_ptr); + // rt_kprintf("-\n"); + } +} +