555 U(dimension), S(dimension), V(dimension);
560 std::tie(U, S, V) = impl::svd_NxN(A);
564 std::tie(U, S, V) = impl::svd_2x2(A);
572 for (
Index i = 0; i < dimension; ++i) {
575 for (
Index j = 0; j < dimension; ++j) {
584 if (S(0, 0) < S(1, 1)) {
585 std::swap(S(0, 0), S(1, 1));
586 std::swap(U(0, 0), U(0, 1));
587 std::swap(U(1, 0), U(1, 1));
588 std::swap(V(0, 0), V(0, 1));
589 std::swap(V(1, 0), V(1, 1));
595 return std::make_tuple(U, S, V);
1257 assert(dimension == 3);
1279 ii[3][2] = { { 1, 2 }, { 2, 0 }, { 0, 1 } };
1286 trA = (1.0/3.0) *
I1(A);
1325 rhs = (J3 / 2.0) * T(std::sqrt(t1 * t1 * t1));
1328 theta = pi / 2.0 * (1.0 - (rhs < 0 ? -1.0 : 1.0));
1330 if (std::abs(rhs) <= 1.0) theta = std::acos(rhs);
1333 thetad3 = theta / 3.0;
1335 if (thetad3 > pi / 6.0) thetad3 += 2.0 * pi / 3.0;
1338 D(2,2) = 2.0 * std::cos(thetad3) * std::sqrt(-J2 / 3.0);
1342 R = Ap - D(2,2) * I;
1346 a(0) = R(0,0)*R(0,0) + R(1,0)*R(1,0) + R(2,0)*R(2,0);
1347 a(1) = R(0,1)*R(0,1) + R(1,1)*R(1,1) + R(2,1)*R(2,1);
1348 a(2) = R(0,2)*R(0,2) + R(1,2)*R(1,2) + R(2,2)*R(2,2);
1364 a(k) = std::sqrt(a(k));
1365 for (
int i(0); i < dimension; ++i)
1371 for (
int i(0); i < dimension; ++i)
1373 d0 += R(i,k) * R(i,ii[k][0]);
1374 d1 += R(i,k) * R(i,ii[k][1]);
1378 for (
int i(0); i < dimension; ++i)
1380 R(i,ii[k][0]) -= d0 * R(i,k);
1381 R(i,ii[k][1]) -= d1 * R(i,k);
1386 for (
int i(0); i < dimension; ++i)
1388 a(0) += R(i,ii[k][0]) * R(i,ii[k][0]);
1389 a(1) += R(i,ii[k][1]) * R(i,ii[k][1]);
1393 if (std::abs(a(1)) > std::abs(a(0))) p = 1;
1396 a(p) = std::sqrt(a(p));
1399 for (
int i(0); i < dimension; ++i)
1403 V(0,2) = R(1,k) * R(2,k2) - R(2,k) * R(1,k2);
1404 V(1,2) = R(2,k) * R(0,k2) - R(0,k) * R(2,k2);
1405 V(2,2) = R(0,k) * R(1,k2) - R(1,k) * R(0,k2);
1409 mag = std::sqrt(V(0,2) * V(0,2) + V(1,2) * V(1,2) + V(2,2) * V(2,2));
1417 rk(R(0,k), R(1,k), R(2,k));
1420 rk2(R(0,k2), R(1,k2), R(2,k2));
1430 rm(0,0) =
dot(rk,ak);
1431 rm(0,1) =
dot(rk,ak2);
1432 rm(1,1) =
dot(rk2,ak2);
1436 b = 0.5 * (rm(0,0) - rm(1,1));
1439 fac = (b < 0 ? -1.0 : 1.0);
1442 arg = b * b + rm(0,1) * rm(0,1);
1445 D(0,0) = rm(1,1) + b;
1447 D(0,0) = rm(1,1) + b - fac * std::sqrt(b * b + rm(0,1) * rm(0,1));
1449 D(1,1) = rm(0,0) + rm(1,1) - D(0,0);
1458 a(0) = rm(0,0) * rm(0,0) + rm(0,1) * rm(0,1);
1459 a(1) = rm(0,1) * rm(0,1) + rm(1,1) * rm(1,1);
1462 if (a(1) > a(0)) k3 = 1;
1470 V(0,0) = rm(0,k3) * rk2(0) - rm(1,k3) * rk(0);
1471 V(1,0) = rm(0,k3) * rk2(1) - rm(1,k3) * rk(1);
1472 V(2,0) = rm(0,k3) * rk2(2) - rm(1,k3) * rk(2);
1475 mag = std::sqrt(V(0,0) * V(0,0) + V(1,0) * V(1,0) + V(2,0) * V(2,0));
1481 V(0,1) = V(1,0) * V(2,2) - V(2,0) * V(1,2);
1482 V(1,1) = V(2,0) * V(0,2) - V(0,0) * V(2,2);
1483 V(2,1) = V(0,0) * V(1,2) - V(1,0) * V(0,2);
1486 mag = std::sqrt(V(0,1) * V(0,1) + V(1,1) * V(1,1) + V(2,1) * V(2,1));
1492 for (
int i(0); i < dimension; ++i)
1496 return std::make_pair(V, D);