Implemented RTOS glue for heap insert/pop
Heap somewhat functional

Doesn't sort properly.
Heap implementation works

It is slow