You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

161 lines
5.2KB

  1. // Copyright 2015 Olivier Gillet.
  2. //
  3. // Author: Olivier Gillet (ol.gillet@gmail.com)
  4. //
  5. // Permission is hereby granted, free of charge, to any person obtaining a copy
  6. // of this software and associated documentation files (the "Software"), to deal
  7. // in the Software without restriction, including without limitation the rights
  8. // to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  9. // copies of the Software, and to permit persons to whom the Software is
  10. // furnished to do so, subject to the following conditions:
  11. //
  12. // The above copyright notice and this permission notice shall be included in
  13. // all copies or substantial portions of the Software.
  14. //
  15. // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16. // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17. // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  18. // AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19. // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20. // OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  21. // THE SOFTWARE.
  22. //
  23. // See http://creativecommons.org/licenses/MIT/ for more information.
  24. //
  25. // -----------------------------------------------------------------------------
  26. //
  27. // Driver for DAC.
  28. #include "marbles/drivers/dac.h"
  29. #include <algorithm>
  30. namespace marbles {
  31. /* static */
  32. Dac* Dac::instance_;
  33. void Dac::Init(int sample_rate, size_t block_size) {
  34. instance_ = this;
  35. block_size_ = block_size;
  36. callback_ = NULL;
  37. InitializeGPIO();
  38. InitializeAudioInterface(sample_rate);
  39. InitializeDMA(block_size);
  40. }
  41. void Dac::InitializeGPIO() {
  42. RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOC, ENABLE);
  43. RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);
  44. // Initialize SS pin.
  45. GPIO_InitTypeDef gpio_init;
  46. gpio_init.GPIO_Mode = GPIO_Mode_AF;
  47. gpio_init.GPIO_OType = GPIO_OType_PP;
  48. gpio_init.GPIO_Speed = GPIO_Speed_25MHz;
  49. gpio_init.GPIO_PuPd = GPIO_PuPd_NOPULL;
  50. gpio_init.GPIO_Pin = GPIO_Pin_15;
  51. GPIO_Init(GPIOA, &gpio_init);
  52. // Initialize MOSI and SCK pins.
  53. gpio_init.GPIO_Pin = GPIO_Pin_10 | GPIO_Pin_12;
  54. GPIO_Init(GPIOC, &gpio_init);
  55. GPIO_PinAFConfig(GPIOC, GPIO_PinSource10, GPIO_AF_SPI3);
  56. GPIO_PinAFConfig(GPIOC, GPIO_PinSource12, GPIO_AF_SPI3);
  57. GPIO_PinAFConfig(GPIOA, GPIO_PinSource15, GPIO_AF_SPI3);
  58. }
  59. void Dac::InitializeAudioInterface(int sample_rate) {
  60. RCC_I2SCLKConfig(RCC_I2S2CLKSource_PLLI2S);
  61. RCC_PLLI2SCmd(DISABLE);
  62. // Best results for multiples of 32kHz.
  63. RCC_PLLI2SConfig(258, 3);
  64. RCC_PLLI2SCmd(ENABLE);
  65. while (RCC_GetFlagStatus(RCC_FLAG_PLLI2SRDY) == RESET);
  66. RCC_APB1PeriphClockCmd(RCC_APB1Periph_SPI3, ENABLE);
  67. SPI_I2S_DeInit(SPI3);
  68. I2S_InitTypeDef i2s_init;
  69. i2s_init.I2S_Mode = I2S_Mode_MasterTx;
  70. i2s_init.I2S_Standard = I2S_Standard_PCMShort;
  71. i2s_init.I2S_DataFormat = I2S_DataFormat_32b;
  72. i2s_init.I2S_MCLKOutput = I2S_MCLKOutput_Disable;
  73. i2s_init.I2S_AudioFreq = sample_rate * kNumDacChannels >> 1;
  74. i2s_init.I2S_CPOL = I2S_CPOL_Low;
  75. I2S_Init(SPI3, &i2s_init);
  76. I2S_Cmd(SPI3, ENABLE);
  77. }
  78. void Dac::InitializeDMA(size_t block_size) {
  79. RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_DMA1, ENABLE);
  80. DMA_Cmd(DMA1_Stream5, DISABLE);
  81. DMA_DeInit(DMA1_Stream5);
  82. DMA_InitTypeDef dma_init;
  83. dma_init.DMA_Channel = DMA_Channel_0;
  84. dma_init.DMA_PeripheralBaseAddr = (uint32_t)&(SPI3->DR);
  85. dma_init.DMA_Memory0BaseAddr = (uint32_t)(&tx_dma_buffer_[0]);
  86. dma_init.DMA_DIR = DMA_DIR_MemoryToPeripheral;
  87. dma_init.DMA_BufferSize = 2 * block_size * kNumDacChannels * 2;
  88. dma_init.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
  89. dma_init.DMA_MemoryInc = DMA_MemoryInc_Enable;
  90. dma_init.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;
  91. dma_init.DMA_MemoryDataSize = DMA_PeripheralDataSize_HalfWord;
  92. dma_init.DMA_Mode = DMA_Mode_Circular;
  93. dma_init.DMA_Priority = DMA_Priority_High;
  94. dma_init.DMA_FIFOMode = DMA_FIFOMode_Disable;
  95. dma_init.DMA_FIFOThreshold = DMA_FIFOThreshold_1QuarterFull;
  96. dma_init.DMA_MemoryBurst = DMA_MemoryBurst_Single;
  97. dma_init.DMA_PeripheralBurst = DMA_PeripheralBurst_Single;
  98. DMA_Init(DMA1_Stream5, &dma_init);
  99. // Enable the interrupts.
  100. DMA_ITConfig(DMA1_Stream5, DMA_IT_TC | DMA_IT_HT, ENABLE);
  101. // Enable the IRQ.
  102. NVIC_EnableIRQ(DMA1_Stream5_IRQn);
  103. // Start DMA from/to codec.
  104. SPI_I2S_DMACmd(SPI3, SPI_I2S_DMAReq_Tx, ENABLE);
  105. }
  106. void Dac::Start(FillBufferCallback callback) {
  107. callback_ = callback;
  108. DMA_Cmd(DMA1_Stream5, ENABLE);
  109. }
  110. void Dac::Stop() {
  111. DMA_Cmd(DMA1_Stream5, DISABLE);
  112. }
  113. void Dac::Fill(size_t offset) {
  114. // Fill the buffer.
  115. IOBuffer::Slice slice = (*callback_)(block_size_);
  116. uint16_t* p = &tx_dma_buffer_[offset * block_size_ * kNumDacChannels * 2];
  117. for (size_t i = 0; i < block_size_; ++i) {
  118. for (size_t j = 0; j < kNumDacChannels; ++j) {
  119. uint16_t sample = slice.block->cv_output[j][slice.frame_index + i];
  120. *p++ = 0x1000 | (j << 9) | (sample >> 8);
  121. *p++ = sample << 8;
  122. }
  123. }
  124. }
  125. } // namespace marbles
  126. extern "C" {
  127. void DMA1_Stream5_IRQHandler(void) {
  128. uint32_t flags = DMA1->HISR;
  129. DMA1->HIFCR = DMA_FLAG_TCIF5 | DMA_FLAG_HTIF5;
  130. if (flags & DMA_FLAG_TCIF5) {
  131. marbles::Dac::GetInstance()->Fill(1);
  132. } else if (flags & DMA_FLAG_HTIF5) {
  133. marbles::Dac::GetInstance()->Fill(0);
  134. }
  135. }
  136. }