Bugfix in debug.c, add plan/time printing to timer.c

TODO: Make the plan/time printing guarded somehow, add GPIO toggling