[Drivers]Add some drivers.It need implement in the future.

make/source.mk

@@ -20,14 +20,16 @@ COMMON_SRC           = \
                     drivers/drv_system.c \
                     drivers/drv_uart.c \
                     drivers/drv_watchdog.c \
-                    drivers/multi_timer.c \
+                    drivers/drv_scheduler.c \
+                    drivers/drv_ws2812.c \
                     motor/motor_adc.c \
                     motor/motor_comparator.c \
                     motor/motor_pwm.c \
                     motor/motor_rtctl.c \
                     motor/motor_rtctl_test.c \
                     motor/motor_signal.c \
                     motor/motor_telemetry.c \
+                    motor/motor_beeper.c \
                     motor/motor_timer.c
 
 VPATH               := $(VPATH):$(SRC_DIR)

src/main/drivers/multi_timer.c → src/main/drivers/drv_scheduler.c

@@ -1,63 +1,63 @@
-#include "include.h"
-
-static struct Timer* head_handle = NULL;
-
-static volatile uint32_t _timer_ticks = 0;
-
-void timer_init(struct Timer* handle, void(*timeout_cb)(), uint32_t timeout, uint32_t repeat)
-{
-    // memset(handle, sizeof(struct Timer), 0);
-    handle->timeout_cb = timeout_cb;
-    handle->timeout = _timer_ticks + timeout;
-    handle->repeat = repeat;
-}
-
-int timer_start(struct Timer* handle)
-{
-    struct Timer* target = head_handle;
-    while(target) {
-        if(target == handle) {
-            return -1;
-        }
-        target = target->next;
-    }
-    handle->next = head_handle;
-    head_handle = handle;
-
-    return 0;
-}
-
-void timer_stop(struct Timer* handle)
-{
-    struct Timer** curr;
-
-    for(curr = &head_handle; *curr; ) {
-        struct Timer* entry = *curr;
-        if (entry == handle) {
-            *curr = entry->next;
-        } else {
-            curr = &entry->next;
-        }
-    }
-}
-
-void timer_loop(void)
-{
-    struct Timer* target;
-
-    for(target = head_handle; target; target = target->next) {
-        if(_timer_ticks >= target->timeout) {
-            if(target->repeat == 0) {
-                timer_stop(target);
-            } else {
-                target->timeout = _timer_ticks + target->repeat;
-            }
-            target->timeout_cb();
-        }
-    }
-}
-
-void timer_ticks(void)
-{
-    _timer_ticks++;
-}
+#include "include.h"
+
+static struct Timer* head_handle = NULL;
+
+static volatile uint32_t _timer_ticks = 0;
+
+void timer_init(struct Timer* handle, void(*timeout_cb)(), uint32_t timeout, uint32_t repeat)
+{
+    // memset(handle, sizeof(struct Timer), 0);
+    handle->timeout_cb = timeout_cb;
+    handle->timeout = _timer_ticks + timeout;
+    handle->repeat = repeat;
+}
+
+int timer_start(struct Timer* handle)
+{
+    struct Timer* target = head_handle;
+    while(target) {
+        if(target == handle) {
+            return -1;
+        }
+        target = target->next;
+    }
+    handle->next = head_handle;
+    head_handle = handle;
+
+    return 0;
+}
+
+void timer_stop(struct Timer* handle)
+{
+    struct Timer** curr;
+
+    for(curr = &head_handle; *curr; ) {
+        struct Timer* entry = *curr;
+        if (entry == handle) {
+            *curr = entry->next;
+        } else {
+            curr = &entry->next;
+        }
+    }
+}
+
+void timer_loop(void)
+{
+    struct Timer* target;
+
+    for(target = head_handle; target; target = target->next) {
+        if(_timer_ticks >= target->timeout) {
+            if(target->repeat == 0) {
+                timer_stop(target);
+            } else {
+                target->timeout = _timer_ticks + target->repeat;
+            }
+            target->timeout_cb();
+        }
+    }
+}
+
+void timer_ticks(void)
+{
+    _timer_ticks++;
+}

src/main/drivers/multi_timer.h → src/main/drivers/drv_scheduler.h

@@ -1,16 +1,16 @@
-#pragma once
-
-#include "stdint.h"
-
-typedef struct Timer {
-    uint32_t timeout;
-    uint32_t repeat;
-    void (*timeout_cb)(void);
-    struct Timer* next;
-} Timer;
-
-void timer_init(struct Timer* handle, void(*timeout_cb)(), uint32_t timeout, uint32_t repeat);
-int  timer_start(struct Timer* handle);
-void timer_stop(struct Timer* handle);
-void timer_ticks(void);
-void timer_loop(void);
+#pragma once
+
+#include "stdint.h"
+
+typedef struct Timer {
+    uint32_t timeout;
+    uint32_t repeat;
+    void (*timeout_cb)(void);
+    struct Timer* next;
+} Timer;
+
+void timer_init(struct Timer* handle, void(*timeout_cb)(), uint32_t timeout, uint32_t repeat);
+int  timer_start(struct Timer* handle);
+void timer_stop(struct Timer* handle);
+void timer_ticks(void);
+void timer_loop(void);

src/main/drivers/drv_ws2812.c

@@ -0,0 +1 @@
+#include "include.h"

src/main/drivers/drv_ws2812.h

@@ -0,0 +1 @@
+#pragma once

src/main/include.h

@@ -45,11 +45,12 @@
 
 #include "irq.h"
 
-#include "drivers/multi_timer.h"
+#include "drivers/drv_scheduler.h"
 #include "drivers/drv_system.h"
 #include "drivers/drv_uart.h"
 #include "drivers/drv_led.h"
 #include "drivers/drv_watchdog.h"
+#include "drivers/drv_ws2812.h"
 
 #include "motor/motor_adc.h"
 #include "motor/motor_comparator.h"
@@ -59,10 +60,11 @@
 #include "motor/motor_timer.h"
 #include "motor/motor_rtctl.h"
 #include "motor/motor_rtctl_test.h"
+#include "motor/motor_beeper.h"
 
 #include "control/rpmctl.h"
 #include "control/control.h"
 
 #include "config/config.h"
 #include "config/config_master.h"
-#include "config/config_eeprom.h"
+#include "config/config_eeprom.h"

src/main/motor/motor_beeper.c

@@ -0,0 +1 @@
+#include "include.h"

src/main/motor/motor_beeper.h

@@ -0,0 +1 @@
+#pragma once