More unit testing
Merge branch 'stewart' of github.com:SafirSDK/safir_sdk_core into stewart