Removed the error checking from the matrix squareroot
Removed the error checking from the matrix squareroot

ethz-asl/Schweizer-Messer,ethz-asl/Schweizer-Messer,ethz-asl/Schweizer-Messer,ethz-asl/Schweizer-Messer