init:全链路闭环控制调通

project/code/Beep.c

@@ -0,0 +1,33 @@
+#include "Beep.h"
+#include "zf_driver_gpio.h"
+
+static int beep_time=0;
+static int beep_T;
+void beep_init(int t){
+    //gpio_init(P33_10, GPO, 0, GPO_PUSH_PULL); // 蜂鸣器初始化
+    gpio_init(A14, GPO, 0, GPO_PUSH_PULL);
+    beep_T=t;
+}
+void beep_on(void){
+    // pwm_set_duty(ATOM2_CH0_P33_10,5000);
+    //gpio_set_level(P33_10,1);
+    gpio_set_level(A14,1);
+}
+void beep_off(void){
+    // pwm_set_duty(ATOM2_CH0_P33_10,0);
+    //gpio_set_level(P33_10,0);
+    gpio_set_level(A14,0);
+}
+void beep_on_time(int ms){
+	beep_time=ms/beep_T;
+}
+
+void beep_actuator(void){
+    if(beep_time>0){
+        beep_on();
+        beep_time--;
+    }
+    else{
+        beep_off();
+    }
+}