Added update_buzzer() functionality and function call

uw-midsun · Apr 1, 2024 · a95a51a · a95a51a
1 parent b0924fc
commit a95a51a
Show file tree

Hide file tree

Showing 3 changed files with 18 additions and 4 deletions.
diff --git a/projects/centre_console/inc/cc_hw_defs.h b/projects/centre_console/inc/cc_hw_defs.h
@@ -81,6 +81,10 @@
 #define BATT_DISP8 \
   { .port = GPIO_PORT_A, .pin = 8 }
 
+// Buzzer
+#define FAULT_BUZZ \
+  { .port = GPIO_PORT_B, .pin = 7 }
+
 // All displays
 #define ALL_DISPLAYS                                                                              \
   {                                                                                               \

diff --git a/projects/centre_console/src/main.c b/projects/centre_console/src/main.c
@@ -52,6 +52,7 @@ void run_medium_cycle() {
   update_indicators(notif);
   monitor_cruise_control();
   fsm_run_cycle(drive);
+  update_buzzer();
   wait_tasks(1);
 
   update_drive_output(notif);

diff --git a/projects/centre_console/src/update_dashboard.c b/projects/centre_console/src/update_dashboard.c
@@ -4,7 +4,9 @@
 #include "centre_console_getters.h"
 #include "centre_console_setters.h"
 #include "drive_fsm.h"
+#include "gpio.h"
 #include "pca9555_gpio_expander.h"
+#include "pwm.h"
 #include "seg_display.h"
 
 // Multiplication factor to convert CAN drive output velocity (cm/s) to kph
@@ -172,10 +174,12 @@ void update_drive_output(uint32_t notif) {
 }
 
 void update_buzzer() {
-  if (get_battery_status_fault() && (1 << 15)) {
-    // set PB7 PMW high
-  } else if ((get_battery_status_fault() && (1 << 14))) {
-    // set PB7 PMW low
+  if (get_battery_status_fault() & (1 << 15)) {
+    pmw_set_dc(PWM_TIMER_4, 100);
+  } else if ((get_battery_status_fault() & (1 << 14))) {
+    pmw_set_dc(PWM_TIMER_4, 50);
+  } else {
+    pmw_set_dc(PWM_TIMER_4, 0);
   }
 }
 
@@ -189,5 +193,10 @@ StatusCode dashboard_init(void) {
   }
   seg_displays_init(&all_displays);
   pca9555_gpio_set_state(&s_output_leds[REGEN_LED], PCA9555_GPIO_STATE_HIGH);
+
+  gpio_init_();
+  gpio_init_pin(&FAULT_BUZZ, GPIO_ALTFN_PUSH_PULL, GPIO_STATE_HIGH);
+  pwm_init(PWM_TIMER_4, 40);
+
   return STATUS_CODE_OK;
 }