Fixing issue with uninitialzied sigma points