board_at_mc105_v3.h 13 KB

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