From ad5e615add95a558f8eb741297de94ccfcf41091 Mon Sep 17 00:00:00 2001
From: tanneberger <github@tanneberger.me>
Date: Fri, 13 Sep 2024 19:27:11 +0200
Subject: [PATCH] next point

---
 src/environment.c                       |  3 +++
 src/hardware/riot/riot_implementation.c |  5 +++--
 src/scheduler.c                         | 14 ++++++++++----
 3 files changed, 16 insertions(+), 6 deletions(-)

diff --git a/src/environment.c b/src/environment.c
index 081ae3c1..790ec63f 100644
--- a/src/environment.c
+++ b/src/environment.c
@@ -14,6 +14,7 @@ void Environment_start(Environment *self) {
 }
 
 int Environment_wait_until(Environment *self, instant_t wakeup_time) {
+  puts("wait until env");
   hardware_wait_for(self->current_tag.time, wakeup_time);
   return 0;
 }
@@ -28,5 +29,7 @@ void Environment_ctor(Environment *self, Reactor *main) {
   self->running = false;
   self->wait_until = Environment_wait_until;
   self->calculate_levels = Environment_calculate_levels;
+  self->current_tag.time = 0;
+  self->current_tag.microstep = 0;
   Scheduler_ctor(&self->scheduler, self);
 }
diff --git a/src/hardware/riot/riot_implementation.c b/src/hardware/riot/riot_implementation.c
index 8861744c..6b42ff65 100644
--- a/src/hardware/riot/riot_implementation.c
+++ b/src/hardware/riot/riot_implementation.c
@@ -12,13 +12,14 @@ void hardware_wait_for(instant_t current_time, instant_t wake_up_time) {
   //ztimer_t timeout = { .callback=callback, .arg="Hello ztimer!" };
   //ztimer_set(ZTIMER_SEC, &timeout, 2);
 
+  puts("riot sleep");
   if (IS_USED(MODULE_ZTIMER)) {
+    puts("calculating delta");
     int64_t time_delta = wake_up_time - current_time;
     int64_t usec = time_delta / 1000;
-
-    printf("sleeping microseconds %lli\n", usec);
     ztimer_sleep(ZTIMER_USEC, usec);
   } else {
+    puts("boring sleep");
     uint32_t loops = coreclk() / 20;
     for (volatile uint32_t i = 0; i < loops; i++) { }
   }
diff --git a/src/scheduler.c b/src/scheduler.c
index 199b9358..c9c52a13 100644
--- a/src/scheduler.c
+++ b/src/scheduler.c
@@ -23,26 +23,29 @@ void Scheduler_prepare_timestep(Scheduler *self) {
 void Scheduler_run(Scheduler *self) {
   puts("entering main-loop");
 
-  while(true) {}
-
   while (!self->event_queue_.empty(&self->event_queue_)) {
     // fetch tag from next event in queue
+    puts("fetching next tag");
     tag_t next_tag = self->event_queue_.next_tag(&self->event_queue_);
 
     // sleep until this time
-    puts("waiting until");
+    puts("waiting");
     self->env_->wait_until(self->env_, next_tag.time);
 
     puts("processing tag");
     // process this tag
     do {
+      puts("prepare time");
       self->prepare_time_step(self);
+
+      puts("pop event queue");
       Event event = self->event_queue_.pop(&self->event_queue_);
       self->env_->current_tag = event.tag;
       event.trigger->is_present = true;
 
       if (event.trigger->update_value) {
         // e.g. Timer Event
+        puts("call update_value function");
         event.trigger->update_value(event.trigger);
       }
 
@@ -51,14 +54,17 @@ void Scheduler_run(Scheduler *self) {
         self->reaction_queue_.insert(&self->reaction_queue_, event.trigger->effects[i]);
       }
 
+      puts("finished pushing events");
+      while(true) {}
     } while (lf_tag_compare(next_tag, self->event_queue_.next_tag(&self->event_queue_)) == 0);
 
+    puts("done processing events");
+
     while (!self->reaction_queue_.empty(&self->reaction_queue_)) {
       Reaction *reaction = self->reaction_queue_.pop(&self->reaction_queue_);
       reaction->body(reaction);
     }
   }
-  printf("Scheduler out of events. Shutting down.\n");
 }
 
 void Scheduler_recursive_level(Reactor *reactor, int current_level) {