Merged i2c-helper in Main

2025-01-12 00:16:00 +01:00
parent f4792de050
commit b5c7e5b4c1
396 changed files with 182143 additions and 14 deletions
--- a/stone-dispencer-control/firmware-stone-dispencer/src/headSystem/stoneDispencer.cpp
+++ b/stone-dispencer-control/firmware-stone-dispencer/src/headSystem/stoneDispencer.cpp
@@ -0,0 +1,19 @@
+#include "headSystem.hpp"
+#include "FreeRTOS.h"
+#include "task.h"
+
+STONE_STATE HeadSystem::dropSequence() {
+    gpio_put(LED1_PIN, 1);
+    if(!preLoad()) {
+        this->stoneState = EMPTY;
+        return this->stoneState;
+    }
+
+    bool prev_head_state = headUp;
+    setHeadUp(false);
+    STONE_STATE res = dropStone();
+    setHeadUp(prev_head_state);
+    this->stoneState = res;
+    gpio_put(LED2_PIN, 0);
+    return res;
+}