Add unit tests for all helper functions

[apollo-sturdy]

All helper functions or those functions that do calculations etc should have unit tests. I.e. where it makes sense.