Fix compilation error in VS2012
Fix compilation error in VS2012

- The complex, fatal line was...
    Vector diagonalVector = b.diagonal();

simquest/opensurgsim,simquest/opensurgsim,simquest/opensurgsim,simquest/opensurgsim