main.c 5.6 KB

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