board_at_mc105_v3.h 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389
  1. #ifndef _BOARD_MC_V3_H__
  2. #define _BOARD_MC_V3_H__
  3. #if defined (GD32F30X_HD) || defined (GD32F30X_XD) || defined (GD32F30X_CL)
  4. #include "gd32f30x.h"
  5. #elif defined GD32E10x
  6. #include "gd32e10x.h"
  7. #endif
  8. #define CONFIG_MOS_MAX_VOL 145.0F
  9. #define CONFIG_HW_MAX_DC_VOLTAGE 110.0F
  10. #define CONFIG_RATED_DC_VOL (96.0f) /* 母线最大电压 V*/
  11. #define CONFIG_MIN_DC_VOL (36.0f)
  12. #define CONFIG_HW_MAX_DC_CURRENT 200.0f
  13. #define CONFIG_HW_MAX_CHRG_CURRENT (-100.0f)
  14. #define CONFIG_HW_MAX_MOTOR_RPM 9000.0f
  15. #define CONFIG_HW_MAX_PHASE_CURR 500.0F
  16. #define CONFIG_HW_MAX_PHASE_VOL (CONFIG_MOS_MAX_VOL - 20.0F)
  17. #define CONFIG_MAX_TORQUE CONFIG_HW_MAX_PHASE_CURR
  18. #define CONFIG_MAX_LOCK_TORQUE 20
  19. #define CONFIG_MAX_ACTIVE_EMF 5000.0F
  20. //#define CONFIG_BEEP
  21. #define CONFIG_STALL_MAX_CURRENT 100.0f //最大堵转相电流电流
  22. #define CONFIG_STALL_MAX_TIME 3000 //ms, 超过最大堵转电流持续时间,判断堵转
  23. #define CONFIG_UNDER_VOL_RPM 1000
  24. #define CONFIG_UNDER_VOL_PHASE_CURR 100.0F
  25. #define CONFIG_UNDER_VOL_DC_CURR 15.0F
  26. #define CONFIG_CURR_LP_WC (600.0F)
  27. #define CONFIG_CURR_LP_CEOF (CONFIG_CURR_LP_WC*2*3.14F/(float)FOC_PWM_FS)
  28. #define CONFIG_HIGH_VOL_MODE_MIN_VOL (60.0F)
  29. #define CONFIG_LADRC_OBSERVER
  30. //#define CONFIG_FORCE_HIGH_VOL_MODE
  31. #ifdef CONFIG_SENSORLESS_TOW_SAMPLES
  32. #define CONFIG_SENSORLESS_TS (FOC_CTRL_US/2.0f)
  33. #else
  34. #define CONFIG_SENSORLESS_TS FOC_CTRL_US
  35. #endif
  36. //#define CONFIG_FORCE_HIGH_VOL_MODE 1
  37. #define SCHED_TIMER TMR5
  38. #define SCHED_TIMER_RCU CRM_TMR5_PERIPH_CLOCK
  39. #define SCHED_TIMER_IRQ TMR5_GLOBAL_IRQn
  40. #define SCHED_TIMER_IRQHandler TMR5_GLOBAL_IRQHandler
  41. #define PWM_DEAD_TIME_NS 400u
  42. #define PWM_TOFF_DELAY_MAX 240u
  43. #define PWM_TON_DELAY_MIN 200u
  44. #define HW_DEAD_TIME_NS 210u
  45. #define HW_RISE_TIME_NS 150u
  46. #define HW_NOISE_TIME_NS 300u
  47. #define CONFIG_HW_DeadTime NS_2_TCLK(HW_DEAD_TIME_NS + PWM_DEAD_TIME_NS + (PWM_TOFF_DELAY_MAX - PWM_TON_DELAY_MIN))/* ����ʱ�� */
  48. #define TDead NS_2_TCLK(HW_DEAD_TIME_NS + PWM_DEAD_TIME_NS)/* ����ʱ�� */
  49. #define TRise NS_2_TCLK(HW_RISE_TIME_NS)/* MOS ����ʱ��*/
  50. #define TNoise NS_2_TCLK(HW_NOISE_TIME_NS)/* MOS��������Ŀ�������ʱ�� */
  51. #define TADC ((uint16_t)((ADC_TRIG_CONV_LATENCY_CYCLES + ADC_SAMPLING_CYCLES) *2 * TIM_CLOCK_MHz) / ADC_CLOCK_MHz + 1u)/* ADC ����ʱ�� */
  52. #define TSampleMIN (TDead + TRise + TADC) //采样需要的总时间
  53. #define TSampleBefore (TDead + TRise) //采样开始前需要等待的时间
  54. #define ADC_REFERENCE_VOLTAGE (3.3F)
  55. #define ADC_FULL_MAX (4095.0F)
  56. /* MOS驱动 */
  57. #define MOS_PWM_TIMER TMR1
  58. #define PWM_MODE TMR_OUTPUT_CONTROL_PWM_MODE_A
  59. #define PWM_CRM_CLK CRM_TMR1_PERIPH_CLOCK
  60. #define PWM_U_P_GROUP GPIOA
  61. #define PWM_U_P_PIN GPIO_PINS_8
  62. #define PWM_U_P_RCU CRM_GPIOA_PERIPH_CLOCK
  63. #define PWM_U_P_MODE GPIO_MODE_MUX
  64. #define PWM_U_N_GROUP GPIOB
  65. #define PWM_U_N_PIN GPIO_PINS_13
  66. #define PWM_U_N_RCU CRM_GPIOB_PERIPH_CLOCK
  67. #define PWM_U_N_MODE GPIO_MODE_MUX
  68. #define PWM_V_P_GROUP GPIOA
  69. #define PWM_V_P_PIN GPIO_PINS_9
  70. #define PWM_V_P_RCU CRM_GPIOA_PERIPH_CLOCK
  71. #define PWM_V_P_MODE GPIO_MODE_MUX
  72. #define PWM_V_N_GROUP GPIOB
  73. #define PWM_V_N_PIN GPIO_PINS_14
  74. #define PWM_V_N_RCU CRM_GPIOB_PERIPH_CLOCK
  75. #define PWM_V_N_MODE GPIO_MODE_MUX
  76. #define PWM_W_P_GROUP GPIOA
  77. #define PWM_W_P_PIN GPIO_PINS_10
  78. #define PWM_W_P_RCU CRM_GPIOA_PERIPH_CLOCK
  79. #define PWM_W_P_MODE GPIO_MODE_MUX
  80. #define PWM_W_N_GROUP GPIOB
  81. #define PWM_W_N_PIN GPIO_PINS_15
  82. #define PWM_W_N_RCU CRM_GPIOB_PERIPH_CLOCK
  83. #define PWM_W_N_MODE GPIO_MODE_MUX
  84. #define PWM_BRAKE_GROUP GPIOB
  85. #define PWM_BRAKE_PIN GPIO_PINS_12
  86. #define PWM_BRAKE_RCU CRM_GPIOB_PERIPH_CLOCK
  87. #define PWM_BRAKE_MODE GPIO_MODE_INPUT
  88. #define HALL_SENSOR_CEOF 0.32F
  89. /* 高边电流传感器采样 */
  90. #define HIGH_SIDE_CURRENT_SENSOR
  91. #define V_PHASE_I_CHAN ADC_CHANNEL_14
  92. #define W_PHASE_I_CHAN ADC_CHANNEL_10
  93. #define V_PHASE_ADC_GROUP GPIOC
  94. #define V_PHASE_ADC_PIN GPIO_PINS_4
  95. #define V_PHASE_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  96. #define V_PHASE_ADC_MODE GPIO_MODE_ANALOG
  97. #define W_PHASE_ADC_GROUP GPIOC
  98. #define W_PHASE_ADC_PIN GPIO_PINS_0
  99. #define W_PHASE_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  100. #define W_PHASE_ADC_MODE GPIO_MODE_ANALOG
  101. #define ADC_TO_CURR_ceof1 (HALL_SENSOR_CEOF)
  102. #define ADC_TO_CURR_ceof2 (HALL_SENSOR_CEOF)
  103. #define CONFIG_PWM_UV_SWAP 1
  104. //#define CONFIG_HW_MUTISAMPLE ADC_OVERSAMPLING_RATIO_MUL8
  105. //#define CONFIG_HW_MUTISAMPLE_SHIFT ADC_OVERSAMPLING_SHIFT_3B
  106. //#define CONFIG_SW_MUTISAMPLE 1
  107. /* 母线电压采集 */
  108. #define VBUS_V_CHAN ADC_CHANNEL_12 //adc012
  109. #define VBUS_V_ADC_GROUP GPIOC
  110. #define VBUS_V_ADC_PIN GPIO_PINS_2
  111. #define VBUS_V_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  112. #define VBUS_V_ADC_MODE GPIO_MODE_ANALOG
  113. #define VBUS_VOL_CEOF (ADC_REFERENCE_VOLTAGE*41/ADC_FULL_MAX)
  114. #define ACC_V_CHAN ADC_CHANNEL_11 //adc012
  115. #define ACC_V_ADC_GROUP GPIOC
  116. #define ACC_V_ADC_PIN GPIO_PINS_1
  117. #define ACC_V_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  118. #define ACC_V_ADC_MODE GPIO_MODE_ANALOG
  119. #define ACC_VOL_CEOF (ADC_REFERENCE_VOLTAGE*41/ADC_FULL_MAX)
  120. #define VBUS_I_CHAN ADC_CHANNEL_0 //adc012
  121. #define VBUS_I_ADC_GROUP GPIOA
  122. #define VBUS_I_ADC_PIN GPIO_PINS_0
  123. #define VBUS_I_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  124. #define VBUS_I_ADC_MODE GPIO_MODE_ANALOG
  125. #define VBUS_I_CEOF (HALL_SENSOR_CEOF)
  126. #define CONFIG_VBUS_I_POSITIVE 1
  127. /* MOS 温度采集 */
  128. #define MOS_TEMP_ADC_CHAN ADC_CHANNEL_8
  129. #define MOS_TEMP_ADC_GROUP GPIOB
  130. #define MOS_TEMP_ADC_PIN GPIO_PINS_0
  131. #define MOS_TEMP_ADC_RCU CRM_GPIOB_PERIPH_CLOCK
  132. #define MOS_TEMP_ADC_MODE GPIO_MODE_ANALOG
  133. #define MOS_TEMP_R(adc) ((adc)/ADC_FULL_MAX / ((1.0f - (adc)/ADC_FULL_MAX)/(10.0f*1000.0f)))
  134. /* 电机温度采集 */
  135. #define MOTOR_TEMP_ADC_CHAN ADC_CHANNEL_5
  136. #define MOTOR_TEMP_ADC_GROUP GPIOA
  137. #define MOTOR_TEMP_ADC_PIN GPIO_PINS_5
  138. #define MOTOR_TEMP_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  139. #define MOTOR_TEMP_ADC_MODE GPIO_MODE_ANALOG
  140. #define MOTOR_TEMP_R(adc) ((adc)/ADC_FULL_MAX / ((1.0f - (adc)/ADC_FULL_MAX)/2000.0f))
  141. /* 是否有母线电流采集 */
  142. //#define NO_SAMPLE_IDC //如果硬件没有采集母线电流,定义一下
  143. /* 转把信号电压采集 */
  144. #define THROTTLE_CHAN ADC_CHANNEL_4
  145. #define THROTTLE_V_ADC_GROUP GPIOA
  146. #define THROTTLE_V_ADC_PIN GPIO_PINS_4
  147. #define THROTTLE_V_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  148. #define THROTTLE_V_ADC_MODE GPIO_MODE_ANALOG
  149. #define THROTTLE_VOL_CEOF (ADC_REFERENCE_VOLTAGE*(15.1f/10.0f)/ADC_FULL_MAX)
  150. /* 第二路转把信号电压采集 */
  151. #define THROTTLE2_CHAN ADC_CHANNEL_7
  152. #define THROTTLE2_V_ADC_GROUP GPIOA
  153. #define THROTTLE2_V_ADC_PIN GPIO_PINS_7
  154. #define THROTTLE2_V_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  155. #define THROTTLE2_V_ADC_MODE GPIO_MODE_ANALOG
  156. /* 转把供电5V电压采集 */
  157. #define THROTTLE_5V_CHAN ADC_CHANNEL_6
  158. #define THROTTLE_5V_ADC_GROUP GPIOA
  159. #define THROTTLE_5V_ADC_PIN GPIO_PINS_6
  160. #define THROTTLE_5V_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  161. #define THROTTLE_5V_ADC_MODE GPIO_MODE_ANALOG
  162. /* 第二路供电5V电压采集 */
  163. #define THROTTLE2_5V_CHAN ADC_CHANNEL_9
  164. #define THROTTLE2_5V_ADC_GROUP GPIOB
  165. #define THROTTLE2_5V_ADC_PIN GPIO_PINS_1
  166. #define THROTTLE2_5V_ADC_RCU CRM_GPIOB_PERIPH_CLOCK
  167. #define THROTTLE2_5V_ADC_MODE GPIO_MODE_ANALOG
  168. /* UVW三相对地电压采集 */
  169. #define U_VOL_ADC_CHAN ADC_CHANNEL_15
  170. #define U_VOL_ADC_GROUP GPIOC
  171. #define U_VOL_ADC_PIN GPIO_PINS_5
  172. #define U_VOL_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  173. #define U_VOL_ADC_MODE GPIO_MODE_ANALOG
  174. #define V_VOL_ADC_CHAN ADC_CHANNEL_1 //adc012
  175. #define V_VOL_ADC_GROUP GPIOA
  176. #define V_VOL_ADC_PIN GPIO_PINS_1
  177. #define V_VOL_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  178. #define V_VOL_ADC_MODE GPIO_MODE_ANALOG
  179. #define W_VOL_ADC_CHAN ADC_CHANNEL_2 //adc012
  180. #define W_VOL_ADC_GROUP GPIOA
  181. #define W_VOL_ADC_PIN GPIO_PINS_2
  182. #define W_VOL_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  183. #define W_VOL_ADC_MODE GPIO_MODE_ANALOG
  184. #define UVW_VOL_CEOF (ADC_REFERENCE_VOLTAGE*(41.0f)/ADC_FULL_MAX)
  185. /* 模拟5v电压采集 */
  186. #define DC5V_ADC_CHAN ADC_CHANNEL_3 //adc012
  187. #define DC5V_ADC_GROUP GPIOA
  188. #define DC5V_ADC_PIN GPIO_PINS_3
  189. #define DC5V_ADC_RCU CRM_GPIOA_PERIPH_CLOCK
  190. #define DC5V_ADC_MODE GPIO_MODE_ANALOG
  191. /* 0v电压采集,主要是用来给上一次的采集放电 */
  192. #define ZERO_ADC_CHAN ADC_CHANNEL_13 //adc012
  193. #define ZERO_ADC_GROUP GPIOC
  194. #define ZERO_ADC_PIN GPIO_PINS_3
  195. #define ZERO_ADC_RCU CRM_GPIOC_PERIPH_CLOCK
  196. #define ZERO_ADC_MODE GPIO_MODE_ANALOG
  197. /* 刹车手把输入 */
  198. #define GPIO_BREAK_MODE GPIO_LOW_BRK_MODE
  199. #define GPIO_BRAKE_IN_GROUP GPIOB
  200. #define GPIO_BRAKE_IN_PIN GPIO_PINS_3
  201. #define GPIO_BRAKE_IN_RCU CRM_GPIOC_PERIPH_CLOCK
  202. #define GPIO_BRAKE_IN_MODE GPIO_MODE_INPUT
  203. #define GPIO_BRAKE_IRQ EXINT3_IRQn
  204. #define GPIO_BRAKE_EXTI EXINT_LINE_3
  205. #define GPIO_BRAKE_EXIT_SRC_GROUP GPIO_PORT_SOURCE_GPIOB
  206. #define GPIO_BRAKE_EXIT_SRC_PIN GPIO_PINS_SOURCE3
  207. #define GPIO_BRAKE_PIN_REMAP SWJTAG_CONF_010
  208. /* 锁电机线, 使用查询模式 */
  209. #define GPIO_MLOCK_IN_GROUP GPIOC
  210. #define GPIO_MLOCK_IN_PIN GPIO_PINS_13
  211. #define GPIO_MLOCK_IN_RCU CRM_GPIOC_PERIPH_CLOCK
  212. #define GPIO_MLOCK_IN_MODE GPIO_MODE_INPUT
  213. /* 触发U相检测 */
  214. #define GPIO_UDEC_OUT_GROUP GPIOB
  215. #define GPIO_UDEC_OUT_PIN GPIO_PINS_7
  216. #define GPIO_UDEC_OUT_RCU CRM_GPIOB_PERIPH_CLOCK
  217. #define GPIO_UDEC_OUT_MODE GPIO_MODE_OUTPUT
  218. /* 风扇 PWM */
  219. #define GPIO_FAN_OUT_GROUP GPIOC
  220. #define GPIO_FAN_OUT_PIN GPIO_PINS_8
  221. #define GPIO_FAN_OUT_RCU CRM_GPIOC_PERIPH_CLOCK
  222. #define GPIO_FAN_OUT_MODE GPIO_MODE_MUX
  223. #define FAN_PWM_TIMER TMR8
  224. #define FAN_PWM_CHAN TMR_SELECT_CHANNEL_3
  225. #define FAN_TIMER_RCU CRM_TMR8_PERIPH_CLOCK
  226. /* 风扇1检测 */
  227. #define GPIO_FAN1_IN_GROUP GPIOC
  228. #define GPIO_FAN1_IN_PIN GPIO_PINS_11
  229. #define GPIO_FAN1_IN_RCU CRM_GPIOC_PERIPH_CLOCK
  230. #define GPIO_FAN1_IN_MODE GPIO_MODE_INPUT
  231. #define GPIO_FAN1_IRQ EXINT15_10_IRQn
  232. #define GPIO_FAN1_EXTI EXINT_LINE_11
  233. #define GPIO_FAN1_EXIT_SRC_GROUP GPIO_PORT_SOURCE_GPIOC
  234. #define GPIO_FAN1_EXIT_SRC_PIN GPIO_PINS_SOURCE11
  235. /* LED 灯控制 */
  236. #define GPIO_LED_OUT_GROUP GPIOC
  237. #define GPIO_LED_OUT_PIN GPIO_PINS_14
  238. #define GPIO_LED_OUT_RCU CRM_GPIOC_PERIPH_CLOCK
  239. #define GPIO_LED_OUT_MODE GPIO_MODE_OUTPUT
  240. /* 刹车灯控制,能量回收的时候需要电量刹车灯 */
  241. #define GPIO_BRAKE_LIGHT_OUT_GROUP GPIOD
  242. #define GPIO_BRAKE_LIGHT_OUT_PIN GPIO_PINS_2
  243. #define GPIO_BRAKE_LIGHT_OUT_RCU CRM_GPIOD_PERIPH_CLOCK
  244. #define GPIO_BRAKE_LIGHT_OUT_MODE GPIO_MODE_OUTPUT
  245. /* CAN 定义 */
  246. #define CAN_TX_GROUP GPIOB
  247. #define CAN_TX_PIN GPIO_PINS_9
  248. #define CAN_RX_GROUP GPIOB
  249. #define CAN_RX_PIN GPIO_PINS_8
  250. #define CAN_PIN_RCU CRM_GPIOB_PERIPH_CLOCK
  251. #define CAN_REMAP CAN_MUX_10
  252. /* 是否用编码器 */
  253. #define USE_ENCODER_ABI
  254. #define ENCODER_TYPE ENCODER_MT
  255. /* 编码器 */
  256. #define ENC_A_GROUP GPIOB
  257. #define ENC_A_PIN GPIO_PINS_4
  258. #define ENC_A_RCU CRM_GPIOB_PERIPH_CLOCK
  259. #define ENC_A_MODE GPIO_MODE_INPUT
  260. #define ENC_B_GROUP GPIOB
  261. #define ENC_B_PIN GPIO_PINS_5
  262. #define ENC_B_RCU CRM_GPIOB_PERIPH_CLOCK
  263. #define ENC_B_MODE GPIO_MODE_INPUT
  264. #define TIMER2_PB4_PB5_REMAP TMR3_MUX_10
  265. #define ENC_PWM_GROUP GPIOA
  266. #define ENC_PWM_PIN GPIO_PINS_15
  267. #define ENC_PWM_RCU CRM_GPIOA_PERIPH_CLOCK
  268. #define ENC_PWM_MODE GPIO_MODE_MUX
  269. #define TIMER1_PA15_REMAP TMR2_MUX_01
  270. #define ENC_I_GROUP GPIOB /*测量编码器的ABI的I信号,360度同步一次*/
  271. #define ENC_I_PIN GPIO_PINS_6
  272. #define ENC_I_RCU CRM_GPIOB_PERIPH_CLOCK
  273. #define ENC_I_MODE GPIO_MODE_INPUT
  274. #define ENC_I_IRQ EXINT9_5_IRQn
  275. #define ENC_I_EXTI EXINT_LINE_6
  276. #define ENC_I_EXIT_SRC_GROUP GPIO_PORT_SOURCE_GPIOB
  277. #define ENC_I_EXIT_SRC_PIN GPIO_PINS_SOURCE6
  278. #define ENC_TIMER TMR3 /* 测量编码器的ABI信号的AB信号 */
  279. #define ENC_TIMER_RCU CRM_TMR3_PERIPH_CLOCK
  280. #define ENC_TIMER_IRQ TMR3_GLOBAL_IRQn
  281. #define ENC_TIMER_IRQHandler TMR3_GLOBAL_IRQHandler
  282. #define ENC_PWM_TIMER TMR2 /* 测量绝对编码器PWM输出的占空比,获取转子angle*/
  283. #define ENC_PWM_TIMER_RCU CRM_TMR2_PERIPH_CLOCK
  284. #define ENC_PWM_TIMER_IRQ TMR2_GLOBAL_IRQn
  285. #define ENC_PWM_TIMER_CHAN TMR_SELECT_CHANNEL_1
  286. #define ENC_PWM_TIMER_IRQ_CH TMR_C1_INT
  287. #define ENC_PWM_TIMER_INT_FLG TMR_C1_FLAG
  288. #define ENC_PWM_IRQHandler TMR2_GLOBAL_IRQHandler
  289. /* board id, 0x01=>v3, 0x02=>v4 */
  290. #define BOOT_PIN_0_GROUP GPIOC
  291. #define BOOT_PIN_0_PIN GPIO_PINS_6
  292. #define BOOT_PIN_1_GROUP GPIOC
  293. #define BOOT_PIN_1_PIN GPIO_PINS_7
  294. #define ENC_MAX_interpolation 1.0F
  295. #define ENC_FILTER_NR 15
  296. #ifdef CONFIG_PWM_UV_SWAP
  297. #define ENCODER_CC_INVERT 1
  298. #endif
  299. /* 编码器参数 */
  300. #define ENC_MAX_RES 4096.0f
  301. #define ENC_Duty_2_Pluse_Nr(duty) (duty * ENC_MAX_RES) //通过占空比计算有几个脉冲
  302. #define ENC_Pluse_Nr_2_angle(Nr) (360.0f/(float)ENC_MAX_RES * (Nr))
  303. #define ENC_PWM_Min_P 0.0f//(1.0f/(131.0f + 1.0f))
  304. #define ENC_PWM_Max_P 1.0f
  305. #if ENCODER_TYPE==ENCODER_MPS
  306. #define ENC_Duty(d, t) ((1.0f/128.0f) * (130.0f * (d)/(t) - 1.0f))
  307. #elif ENCODER_TYPE==ENCODER_MT
  308. /*min. 994 hz*/
  309. #define ENC_PWM_MAX_RES 4119.0F
  310. #define ENC_PWM_INIT_WIDTH 16.0F //PWM 起始宽度
  311. #define ENC_PWM_END_WIDTH 8.0F
  312. //#define ENC_PWM_Min_P (ENC_PWM_INIT_WIDTH/(ENC_PWM_MAX_RES + 1.0f))
  313. //#define ENC_PWM_Max_P ((ENC_PWM_MAX_RES-ENC_PWM_END_WIDTH)/(ENC_PWM_MAX_RES - 1.0f))
  314. #define PWM_Duty(d, t) ((d)/(t))
  315. #define ENC_Duty(d, t) ((PWM_Duty(d, t)*ENC_PWM_MAX_RES - ENC_PWM_INIT_WIDTH)/(ENC_PWM_MAX_RES - ENC_PWM_END_WIDTH - ENC_PWM_INIT_WIDTH))
  316. #else
  317. #error "Postion sensor ERROR"
  318. #endif
  319. #define DEBUG_PORT_UART2
  320. #define CONFIG_MOT_TYPE MOTOR_BLUESHARK_ZD_100
  321. //#define CONFIG_DQ_STEP_RESPONSE
  322. #endif /*_BOARD_MC_V3_H__ */