add utils including priority queue

Signed-off-by: Beni Lev <beniloew@gmail.com>