Threshold is set against matrix norm
Added diagnostic tests
Added debugging logs
Added diagnostic
Linear combination is false by default (like before)
Added extra header loggers
Make QP tests pass again
Small fix for ASSERT macro
Part of previous commit