positive_definite function

Checks if a squared matrix is positive definite and turn it to positive definied if necessary