Utilities

I've added a lot of utilities and smaller functions that somehow are part of my ll star algorithm.