New implementation of mainimal scheduler

Now uses a chained list of functions. Each function has a periodicity
converted into number of ticks.
A each clock interrupt (from Timer1) the remaining tick counter of each function
is updated. When it reaches 0, the function is executed and the counter is reinitialized.
Test_sched updated with new implementation of scheduler
Add a method to deregister a function from scheduler