Add simpler freertos heap implementation