first commit

Author: spin7ion

README.md

@@ -0,0 +1,13 @@
+# Flipper servotester application
+
+Application uses A7 pin for servo PWM output. Has different modes: Manual, Center, Auto.
+
+## Installation instructions
+
+Go to the [releases](https://github.com/spin7ion/flipper-servotester/releases), download apps.zip and extract it in your SD card.
+
+## Build instructions
+
+- Clone the [official flipper zero firmware](https://github.com/flipperdevices/flipperzero-firmware)
+- Add the content of this repo to the `applications_user` folder
+- Follow [official instructions](https://github.com/flipperdevices/flipperzero-firmware/blob/dev/documentation/AppsOnSDCard.md)

servotester/application.fam

@@ -0,0 +1,15 @@
+App(
+    appid="servotester",
+    name="Servotester",
+    apptype=FlipperAppType.EXTERNAL,
+    entry_point="servotester_app",
+    cdefines=["APP_SERVOTESTER"],
+    requires=[
+        "gui",
+    ],
+    stack_size=1 * 1024,
+    order=90,
+	fap_icon="servotester.png",
+    fap_category="GPIO",
+    fap_author="Alexander Semion"
+)

servotester/servotester.c

@@ -0,0 +1,177 @@
+#include <furi.h>
+#include <furi_hal.h>
+#include <furi_hal_clock.h>
+#include <furi_hal_pwm.h>
+#include <gui/gui.h>
+#include <input/input.h>
+#include <notification/notification_messages.h>
+#include <stdio.h>
+
+#define DEFAULT_FREQ 50
+#define DEFAULT_DUTY 1
+
+uint16_t pWidth = 1500;
+int8_t dir = 1;
+
+enum Modes {
+    Manual,
+    Center,
+    Auto,
+};
+
+const char* const modes_text[Auto + 1] = {
+    "Manual",
+    "Center",
+    "Auto",
+};
+
+uint8_t mode = Manual;
+
+typedef enum {
+    EventTypeTick,
+    EventTypeInput,
+} EventType;
+
+typedef struct {
+    EventType type;
+    InputEvent input;
+} ServoTesterEvent;
+
+static void draw_callback(Canvas* canvas, void* ctx) {
+    UNUSED(ctx);
+
+    char temp_str[36];
+
+    canvas_clear(canvas);
+    canvas_set_font(canvas, FontPrimary);
+
+    canvas_draw_frame(canvas, 0, 0, 128, 64);
+    canvas_draw_str(canvas, 35, 10, "Servo tester");
+    canvas_draw_line(canvas, 14, 30, 114, 30);
+    canvas_draw_line(canvas, 14, 30, 14, 20);
+    canvas_draw_line(canvas, 114, 30, 114, 20);
+
+    /*
+        14-1000
+        104-2000
+
+
+
+        (pWidth-1000)/10+10 === 0-1
+        
+
+    */
+    canvas_draw_frame(canvas, (pWidth - 1000) / 10.2 + 14, 20, 3, 10);
+
+    snprintf(temp_str, sizeof(temp_str), "%i us", pWidth);
+
+    canvas_draw_str(canvas, 50, 40, temp_str);
+
+    canvas_draw_str(canvas, 50, 50, modes_text[mode]);
+}
+
+static void input_callback(InputEvent* input_event, void* ctx) {
+    furi_assert(ctx);
+    FuriMessageQueue* event_queue = ctx;
+    ServoTesterEvent event = {.type = EventTypeInput, .input = *input_event};
+    furi_message_queue_put(event_queue, &event, FuriWaitForever);
+}
+
+static void timer_callback(FuriMessageQueue* event_queue) {
+    furi_assert(event_queue);
+
+    ServoTesterEvent event = {.type = EventTypeTick};
+    furi_message_queue_put(event_queue, &event, 0);
+}
+
+void setServoPWM(uint32_t freq, uint32_t compare) {
+    uint32_t freq_div = 64000000LU / freq;
+    uint32_t prescaler = freq_div / 0x10000LU;
+    uint32_t period = freq_div / (prescaler + 1);
+
+    LL_TIM_SetPrescaler(TIM1, prescaler);
+    LL_TIM_SetAutoReload(TIM1, period - 1);
+    LL_TIM_OC_SetCompareCH1(TIM1, compare);
+}
+
+void updatePwm() {
+    setServoPWM(DEFAULT_FREQ, pWidth * 3.2);
+}
+
+int32_t servotester_app(void* p) {
+    UNUSED(p);
+
+    ServoTesterEvent event;
+
+    FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(ServoTesterEvent));
+
+    ViewPort* view_port = view_port_alloc();
+
+    // callbacks init
+    view_port_draw_callback_set(view_port, draw_callback, NULL);
+    view_port_input_callback_set(view_port, input_callback, event_queue);
+
+    Gui* gui = furi_record_open(RECORD_GUI);
+    gui_add_view_port(gui, view_port, GuiLayerFullscreen);
+
+    FuriTimer* timer = furi_timer_alloc(timer_callback, FuriTimerTypePeriodic, event_queue);
+    furi_timer_start(timer, 5);
+
+    //GPIO init
+    furi_hal_power_enable_otg();
+    furi_hal_pwm_start(FuriHalPwmOutputIdTim1PA7, 50, 4);
+    setServoPWM(DEFAULT_FREQ, pWidth * 3.2);
+
+    while(1) {
+        furi_check(furi_message_queue_get(event_queue, &event, FuriWaitForever) == FuriStatusOk);
+        if(event.type == EventTypeInput) {
+            if(event.input.key == InputKeyBack) {
+                furi_hal_power_disable_otg();
+                furi_hal_pwm_stop(FuriHalPwmOutputIdTim1PA7);
+                break;
+            } else if(event.input.key == InputKeyOk) {
+                if(event.input.type == InputTypeRelease) {
+                    if(mode == Auto) {
+                        mode = Manual;
+                    } else {
+                        mode++;
+                    }
+
+                    if(mode == Center) {
+                        pWidth = 1500;
+                        updatePwm();
+                    }
+                }
+            } else if(event.input.key == InputKeyLeft) {
+                if(pWidth > 1000) pWidth--;
+                updatePwm();
+            } else if(event.input.key == InputKeyRight) {
+                if(pWidth < 2000) pWidth++;
+                updatePwm();
+            } else if(event.input.key == InputKeyDown) {
+                if(pWidth >= 1010) pWidth -= 10;
+                updatePwm();
+            } else if(event.input.key == InputKeyUp) {
+                if(pWidth <= 1990) pWidth += 10;
+                updatePwm();
+            }
+        } else if(event.type == EventTypeTick) {
+            if(mode == Auto) {
+                pWidth += dir;
+                if(pWidth > 1990 || pWidth < 1010) {
+                    dir = dir * -1;
+                }
+                updatePwm();
+            }
+        }
+    }
+
+    furi_timer_free(timer);
+    furi_message_queue_free(event_queue);
+
+    gui_remove_view_port(gui, view_port);
+    view_port_free(view_port);
+    furi_record_close(RECORD_GUI);
+
+    return 0;
+}