main.c 5.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192
  1. /**
  2. * @copyright None
  3. * @file main.c
  4. * @author Comment Vivre
  5. * @date 2024-08-26
  6. * @brief None
  7. */
  8. #include <MyProject.h>
  9. #include <SanityCheck.h>
  10. uint8 data g_1mTick = 0; ///< 1ms滴答信号,每隔1ms在SYSTICK定时器被置1,需在大循环使用处清零
  11. /**
  12. @brief Function Definition
  13. */
  14. static void HardwareInit(void);
  15. static void SoftwareInit(void);
  16. void VREFConfigInit(void);
  17. static void DebugSet(void);
  18. /**
  19. @brief SPI Debug调试小工具
  20. @date 2022-07-14
  21. */
  22. static void DebugSet(void)
  23. {
  24. #if (DBG_MODE == DBG_SPI_HW) // 硬件调试模式
  25. SPI_Init();
  26. Set_DBG_DMA(&HARD_SPIDATA);
  27. #elif (DBG_MODE == DBG_SPI_SW) // 软件调试模式
  28. SPI_Init();
  29. Set_DBG_DMA((uint16)spidebug);
  30. #elif (DBG_MODE == DBG_UART)
  31. UART2_Init();
  32. Conf_DMA(1, XDATA_UART1, (uint16)GetAddr_UARTDBG(), BUFFLEN);
  33. #endif
  34. }
  35. /**
  36. @brief 硬件初始化,初始化需要使用的硬件设备配置,FOC必须配置的是运放电压、运放初始化、ADC初始化、Driver初始化
  37. 其他的可根据实际需求加。
  38. @date 2022-07-14
  39. */
  40. static void HardwareInit(void)
  41. {
  42. // 为提高芯片的抗干扰能力,降低芯片功耗,请在具体项目时,将不需要用的GPIO默认都配置为输入上拉。
  43. // 具体配置可在GPIO_Default_Init设置。
  44. // GPIO_Default_Init();
  45. /************************硬件外设初始化**************************/
  46. /* ADC参考电压电压配置 */
  47. VREFConfigInit();
  48. /* 硬件过流,比较器初始化,用于硬件过流比较保护 */
  49. CMP3_Init();
  50. GPIO_Init();
  51. ADC_Init(); /* 初始化需要在Driver之前 */
  52. Driver_Init();
  53. AMP_Init();
  54. // Timer3_Init();
  55. // Timer2_Init();
  56. /******温度配置初始化**********/
  57. TSD_Init();
  58. /* 比较器中断配置,与CMP3硬件配置间隔一段时间等待硬件稳定 */
  59. CMP3_Interrupt_Init();
  60. /* SYSTICK定时器配置 */
  61. ClrBit(IP2, PTIM41); // 1ms定时中断优先级别为1
  62. SetBit(IP2, PTIM40);
  63. SetBit(DRV_SR, SYSTIE);
  64. EA = 1;
  65. }
  66. /**
  67. @brief 部分变量初始化,上电运行一次
  68. @date 2022-07-14
  69. */
  70. static void SoftwareInit(void)
  71. {
  72. // 电机状态机时序变量
  73. McStaSet.SetMode = 0;
  74. // 电机目标方向
  75. #if (FR_MODE == CW)
  76. mcFocCtrl.FR = CW;
  77. #else
  78. mcFocCtrl.FR = CCW;
  79. #endif // end IRMODE
  80. /* -----电流偏置校准变量初始化----- */
  81. mcCurOffset.IuOffsetSum = 16383;
  82. mcCurOffset.IvOffsetSum = 16383;
  83. mcCurOffset.Iw_busOffsetSum = 16383;
  84. mcPwmInput.TimerARR = 65535;
  85. mcState = mcReady;
  86. mcFaultSource = FaultNoSource;
  87. }
  88. /**
  89. @brief 参考电压,偏置电压配置
  90. @date 2022-07-14
  91. */
  92. void VREFConfigInit(void)
  93. {
  94. #if (HW_ADC_VREF == VREF3_0)
  95. {
  96. SetBit(VREF_VHALF_CR, VRVSEL1); // 00-->4.5V 01-->VDD5
  97. ClrBit(VREF_VHALF_CR, VRVSEL0); // 10-->3.0V 11-->4.0V
  98. }
  99. #elif (HW_ADC_VREF == VREF4_0)
  100. {
  101. SetBit(VREF_VHALF_CR, VRVSEL1); // 00-->4.5V 01-->VDD5
  102. SetBit(VREF_VHALF_CR, VRVSEL0); // 10-->3.0V 11-->4.0V
  103. }
  104. #elif (HW_ADC_VREF == VREF4_5)
  105. {
  106. ClrBit(VREF_VHALF_CR, VRVSEL1); // 00-->4.5V 01-->VDD5
  107. ClrBit(VREF_VHALF_CR, VRVSEL0); // 10-->3.0V 11-->4.0V
  108. }
  109. #elif (HW_ADC_VREF == VREF5_0)
  110. {
  111. ClrBit(VREF_VHALF_CR, VRVSEL1); // 00-->4.5V 01-->VDD5
  112. SetBit(VREF_VHALF_CR, VRVSEL0); // 10-->3.0V 11-->4.0V
  113. }
  114. #endif
  115. // VHALF电压配置 00:1/8VREF 01:1/4VREF 10:25/64VREF 11:1/2VREF(default)
  116. #if (HW_VHALF_SEL == VHALF1_8)
  117. {
  118. ClrBit(VREF_VHALF_CR, VHALFSEL1);
  119. ClrBit(VREF_VHALF_CR, VHALFSEL0);
  120. }
  121. #elif (HW_VHALF_SEL == VHALF1_4)
  122. {
  123. ClrBit(VREF_VHALF_CR, VHALFSEL1);
  124. SetBit(VREF_VHALF_CR, VHALFSEL0);
  125. }
  126. #elif (HW_VHALF_SEL == VHALF25_64)
  127. {
  128. SetBit(VREF_VHALF_CR, VHALFSEL1);
  129. ClrBit(VREF_VHALF_CR, VHALFSEL0);
  130. }
  131. #elif (HW_VHALF_SEL == VHALF1_2)
  132. {
  133. SetBit(VREF_VHALF_CR, VHALFSEL1);
  134. SetBit(VREF_VHALF_CR, VHALFSEL0);
  135. }
  136. #else
  137. #error " VHALF MODE Err "
  138. #endif
  139. #if (VREF_OUT_EN)
  140. {
  141. SetBit(P3_AN, PIN5); // VREF Voltage -->P35 Output 是否输出到P35引脚,需同步配置输出
  142. SetBit(P3_OE, PIN5); // VREF Voltage -->P35 Output 是否输出到P35引脚
  143. }
  144. #endif
  145. #if (VHALF_EN)
  146. SetBit(VREF_VHALF_CR, VHALFEN); // VREF_VHALF_CR = 0x11;
  147. #endif
  148. SetBit(VREF_VHALF_CR, VREFEN);
  149. }
  150. /**
  151. @brief 主函数,大循环运行偏置电流采集函数,电机状态机控制函数,以及环路响应函数
  152. @date 2022-07-14
  153. */
  154. void main(void)
  155. {
  156. uint16 PowerUpCnt = 0;
  157. /* ----- 上电空指令延时 等待系统稳定 ----- */
  158. for (PowerUpCnt = 0; PowerUpCnt < SystemPowerUpTime; PowerUpCnt++);
  159. SoftwareInit(); // 部分变量初始化
  160. HardwareInit(); // 硬件初始化
  161. while (1)
  162. {
  163. /* -----获取电流采样偏置电压----- */
  164. if (!mcCurOffset.OffsetFlag)
  165. {
  166. GetCurrentOffset();
  167. }
  168. else
  169. {
  170. /* -----电机控制状态机----- */
  171. MC_Control();
  172. if (g_1mTick)
  173. {
  174. TickCycle_1ms();
  175. g_1mTick = 0;
  176. }
  177. }
  178. }
  179. }