bsp.c 650 B

1234567891011121314151617181920212223242526272829303132333435363738394041424344
  1. #include "bsp/bsp.h"
  2. #include "foc/foc.h"
  3. void system_init(void){
  4. HAL_Init();
  5. SystemClock_Config();
  6. HAL_GPIO_init();
  7. HAL_NVIC_Init();
  8. HAL_PWM_Init(FOC_FS);
  9. HAL_ADC1_Init();
  10. HAL_EXIT_Enable();
  11. serial_init();
  12. }
  13. void system_reboot(void){
  14. }
  15. int get_hall_stat(int samples) {
  16. samples = 1 + 2 * samples;
  17. int h1 = 0, h2 = 0, h3 = 0;
  18. int tres = samples / 2;
  19. while (samples--) {
  20. h1 += READ_HALL1();
  21. h2 += READ_HALL2();
  22. h3 += READ_HALL3();
  23. }
  24. return (h1 > tres) | ((h2 > tres) << 1) | ((h3 > tres) << 2);
  25. }
  26. void wdog_reload(void){
  27. #if CONFIG_DEBUG == 0
  28. #endif
  29. }
  30. void wdog_enable(void)
  31. {
  32. #if CONFIG_DEBUG == 0
  33. #endif
  34. }