core_dac.c 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161
  1. /*
  2. * Copyright (c) 2022 OpenLuat & AirM2M
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a copy of
  5. * this software and associated documentation files (the "Software"), to deal in
  6. * the Software without restriction, including without limitation the rights to
  7. * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
  8. * the Software, and to permit persons to whom the Software is furnished to do so,
  9. * subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in all
  12. * copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
  16. * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
  17. * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
  18. * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  19. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  20. */
  21. #include "user.h"
  22. typedef struct
  23. {
  24. CBFuncEx_t Callback;
  25. void *pParam;
  26. uint16_t *TxData;
  27. uint32_t Pos;
  28. uint32_t MaxLen;
  29. uint32_t Freq;
  30. uint8_t DMATxStream;
  31. uint8_t IsBusy;
  32. uint8_t IsInit;
  33. }DAC_ResourceStruct;
  34. static DAC_ResourceStruct prvDAC;
  35. static int32_t DAC_DMADoneCB(void *pData, void *pParam)
  36. {
  37. uint32_t TxLevel;
  38. if (prvDAC.MaxLen > prvDAC.Pos)
  39. {
  40. TxLevel = ((prvDAC.MaxLen - prvDAC.Pos) > 4090)?4000:(prvDAC.MaxLen - prvDAC.Pos);
  41. DMA_ClearStreamFlag(prvDAC.DMATxStream);
  42. DMA_ForceStartStream(prvDAC.DMATxStream, &prvDAC.TxData[prvDAC.Pos], TxLevel, DAC_DMADoneCB, NULL, 1);
  43. prvDAC.Pos += TxLevel;
  44. }
  45. else
  46. {
  47. prvDAC.IsBusy = 0;
  48. prvDAC.Callback(pParam, prvDAC.pParam);
  49. }
  50. }
  51. static int32_t DAC_DummyCB(void *pData, void *pParam)
  52. {
  53. // DBG("!");
  54. return 0;
  55. }
  56. void DAC_DMAInit(uint8_t DAC_ID, uint8_t Stream)
  57. {
  58. DMA_InitTypeDef DMA_InitStruct;
  59. DMA_BaseConfig(&DMA_InitStruct);
  60. DMA_InitStruct.DMA_Peripheral = SYSCTRL_PHER_CTRL_DMA_CHx_IF_DAC;
  61. DMA_InitStruct.DMA_PeripheralBurstSize = DMA_BurstSize_4;
  62. DMA_InitStruct.DMA_PeripheralBaseAddr = (uint32_t)&DAC->DAC_DATA;
  63. DMA_InitStruct.DMA_Priority = DMA_Priority_3;
  64. DMA_InitStruct.DMA_MemoryBurstSize = DMA_BurstSize_4;
  65. DMA_InitStruct.DMA_MemoryDataSize = DMA_DataSize_HalfWord;
  66. DMA_InitStruct.DMA_PeripheralDataSize = DMA_DataSize_HalfWord;
  67. DMA_ConfigStream(Stream, &DMA_InitStruct);
  68. prvDAC.DMATxStream = Stream;
  69. prvDAC.IsInit = 1;
  70. }
  71. void DAC_Setup(uint8_t DAC_ID, uint32_t Freq, uint32_t OutRMode)
  72. {
  73. uint32_t Ctrl;
  74. DAC->DAC_CR1 |= (1 << 4);
  75. while (DAC->DAC_CR1 & (1 << 29));
  76. switch(Freq)
  77. {
  78. case 44100:
  79. DAC->DAC_TIMER = 543;
  80. break;
  81. default:
  82. DAC->DAC_TIMER = ((SystemCoreClock >> 3) / Freq) - 1;
  83. break;
  84. }
  85. DAC->DAC_FIFO_THR = 10;
  86. DAC->DAC_CR1 = (OutRMode << 5) | 0x18;
  87. }
  88. void DAC_Send(uint8_t DAC_ID, const uint16_t *Data, uint32_t Len, CBFuncEx_t Callback, void *pParam)
  89. {
  90. uint32_t TxLevel;
  91. PM_SetHardwareRunFlag(PM_HW_DAC_0 + DAC_ID, 1);
  92. // PM_SetHardwareRunFlag(PM_HW_DAC_0, 1);
  93. if (prvDAC.IsBusy)
  94. {
  95. DMA_PrintReg(prvDAC.DMATxStream);
  96. return;
  97. }
  98. prvDAC.IsBusy = 1;
  99. prvDAC.TxData = Data;
  100. prvDAC.MaxLen = Len;
  101. prvDAC.Pos = 0;
  102. if (Callback)
  103. {
  104. prvDAC.Callback = Callback;
  105. }
  106. else
  107. {
  108. prvDAC.Callback = DAC_DummyCB;
  109. }
  110. prvDAC.pParam = pParam;
  111. TxLevel = ((prvDAC.MaxLen - prvDAC.Pos) > 4090)?4000:(prvDAC.MaxLen - prvDAC.Pos);
  112. DMA_ClearStreamFlag(prvDAC.DMATxStream);
  113. DMA_ForceStartStream(prvDAC.DMATxStream, &prvDAC.TxData[prvDAC.Pos], TxLevel, DAC_DMADoneCB, DAC_ID, 1);
  114. prvDAC.Pos += TxLevel;
  115. DAC->DAC_CR1 &= ~(1 << 4);
  116. DAC->DAC_CR1 |= 0x04;
  117. ADC0->ADC_CR1 &= ~(1 << 8);
  118. }
  119. uint8_t DAC_CheckRun(uint8_t DAC_ID)
  120. {
  121. return (DAC->DAC_CR1 & (1 << 29)) >> 29;
  122. }
  123. void DAC_Stop(uint8_t DAC_ID)
  124. {
  125. if (!prvDAC.IsInit) return;
  126. DMA_StopStream(prvDAC.DMATxStream);
  127. prvDAC.Callback = DAC_DummyCB;
  128. if (DAC->DAC_CR1 & (1 << 4))
  129. {
  130. }
  131. else
  132. {
  133. while ( DAC->DAC_CR1 & (1 << 29) ){;}
  134. }
  135. DAC_ForceStop(DAC_ID);
  136. }
  137. void DAC_ForceStop(uint8_t DAC_ID)
  138. {
  139. DMA_StopStream(prvDAC.DMATxStream);
  140. DAC->DAC_CR1 |= (1 << 4);
  141. DAC->DAC_CR1 &= ~0x04;
  142. PM_SetHardwareRunFlag(PM_HW_DAC_0 + DAC_ID, 0);
  143. prvDAC.IsBusy = 0;
  144. // PM_SetHardwareRunFlag(PM_HW_DAC_0, 0);
  145. }