Implementation of S-CoSenS for RIOT OS
Add queue occupation counter (for debugging and profiling)