psd_check function

Check for positive semi-definiteness after a perturbation