implemented current lamps

angrycompany16 · Mar 4, 2024 · ca1bc5e · ca1bc5e
1 parent 2ff623e
commit ca1bc5e
Show file tree

Hide file tree

Showing 4 changed files with 17 additions and 29 deletions.
diff --git a/skeleton_project/source/FSM.c b/skeleton_project/source/FSM.c
@@ -73,7 +73,6 @@ void FSM_behaviour(FSM* p_fsm, time_t* p_timer, Queue* p_main_queue){
             elevio_motorDirection(DIRN_STOP);
             break;
         case BLOCKED_EMPTY:
-            // Ikke endre dør-lys?
             p_fsm->moving = false;
             elevio_motorDirection(DIRN_STOP);
             break;

diff --git a/skeleton_project/source/lamp.c b/skeleton_project/source/lamp.c
@@ -1,28 +1,11 @@
 #include "lamp.h"
-/*
-Lamp* lamp_init(){
 
-    Lamp* p_lamp = (Lamp*)malloc(sizeof(Lamp));
-
-    if (p_lamp!= NULL) {
-        *p_lamp = BUTTON_HALL_DOWN;
-        // *p_lamp = ; Lyse i etasjen heisen starter i?
-    } else {
-        printf("Error allocating memory for button\n");
-    }
-
-    return p_lamp;
-}
-
-void lamp_deinit(Lamp* p_lamp) {
-    free(p_lamp);
-}
-*/
-
-void toggle(Lamp_2 m_lamp, int floor, bool enable){
+void lamp_toggle(Lamp m_lamp, int floor, bool enable){
     switch(m_lamp){
         case LAMP_CURRENT:
-            // hvordan håndtere disse lysene?
+            while (elevio_floorSensor() != -1) {
+                elevio_floorIndicator(floor);
+            }
             break;
         case LAMP_UP:
             elevio_buttonLamp(floor, BUTTON_HALL_UP, enable);

diff --git a/skeleton_project/source/lamp.h b/skeleton_project/source/lamp.h
@@ -12,13 +12,8 @@ typedef enum{
     LAMP_CAB,
     LAMP_STOP,
     LAMP_DOOR
-} Lamp_2;
+} Lamp;
 
-//Lamp* lamp_init(void);
-//void lamp_deinit(Lamp* p_lamp);
-
-void lamp_toggle(Lamp_2 m_lamp, int floor, bool enable);
-
-// ikke pointers pga kun enums??
+void lamp_toggle(Lamp m_lamp, int floor, bool enable);
 
 // L3 og L4!
diff --git a/skeleton_project/source/run.c b/skeleton_project/source/run.c
@@ -64,6 +64,17 @@ void run(
         // printf("Floor sensor: %d\n", elevio_floorSensor());
         if (elevio_floorSensor() != -1) {
             p_fsm->current_floor = elevio_floorSensor();
+            // Oppdatere current-lys (cursed løsning? hehe)
+            lamp_toggle(LAMP_CURRENT, p_fsm->current_floor, true);
+
+            if (*target_floor > p_fsm->current_floor){ // beveger seg oppover
+                lamp_toggle(LAMP_CURRENT, p_fsm->current_floor - 1, false);
+            } else {
+                lamp_toggle(LAMP_CURRENT, p_fsm->current_floor + 1, false);
+            }
+            // evt:
+            // lamp_toggle(LAMP_CURRENT, p_fsm->current_floor + 1, false);
+            // lamp_toggle(LAMP_CURRENT, p_fsm->current_floor - 1, false);
         }
 
         if (*target_floor == elevio_floorSensor()) {