Tests updated, fixed bug in an assert.
Merge branch 'stewart' of github.com:SafirSDK/safir_sdk_core into stewart