Exemplo n.º 1
0
    @Override
    public double apply(Variable v, Map<Object, Object> cache) {
      Double detJ = null;
      double[][] J = null;
      if (cache != null) {
        detJ = (Double) cache.get(1);
        J = (double[][]) cache.get(2);
      }
      if (detJ == null || J == null) {
        J = new double[3][3];
        J[0][0] = x_r.apply(v);
        J[0][1] = x_s.apply(v);
        J[0][2] = x_t.apply(v);
        J[1][0] = y_r.apply(v);
        J[1][1] = y_s.apply(v);
        J[1][2] = y_t.apply(v);
        J[2][0] = z_r.apply(v);
        J[2][1] = z_s.apply(v);
        J[2][2] = z_t.apply(v);
        // @see ./doc/invA33.png
        detJ = Utils.determinant(J);
        if (cache != null) {
          cache.put(1, detJ);
          cache.put(2, J);
        }
      }

      if ("r".equals(rst)) {
        if ("x".equals(xyz)) return (J[1][1] * J[2][2] - J[1][2] * J[2][1]) / detJ;
        else if ("y".equals(xyz)) return (J[0][2] * J[2][1] - J[0][1] * J[2][2]) / detJ;
        else if ("z".equals(xyz)) return (J[0][1] * J[1][2] - J[0][2] * J[1][1]) / detJ;
      } else if ("s".equals(rst)) {
        if ("x".equals(xyz)) return (J[1][2] * J[2][0] - J[1][0] * J[2][2]) / detJ;
        else if ("y".equals(xyz)) return (J[0][0] * J[2][2] - J[0][2] * J[2][0]) / detJ;
        else if ("z".equals(xyz)) return (J[0][2] * J[1][0] - J[0][0] * J[1][2]) / detJ;
      } else {
        if ("x".equals(xyz)) return (J[1][0] * J[2][1] - J[1][1] * J[2][0]) / detJ;
        else if ("y".equals(xyz)) return (J[0][1] * J[2][0] - J[0][0] * J[2][1]) / detJ;
        else if ("z".equals(xyz)) return (J[0][0] * J[1][1] - J[0][1] * J[1][0]) / detJ;
      }
      throw new FutureyeException("");
    }
Exemplo n.º 2
0
    @Override
    public double[] applyAll(VariableArray valAry, Map<Object, Object> cache) {
      double[] detJ = null;
      double[][][] J = null;
      int len = valAry.length();
      double[] rlt = new double[len];
      if (cache != null) {
        detJ = (double[]) cache.get(1);
        J = (double[][][]) cache.get(2);
      }
      if (detJ == null || J == null) {
        J = new double[3][3][len];
        J[0][0] = x_r.applyAll(valAry, cache);
        J[0][1] = x_s.applyAll(valAry, cache);
        J[0][2] = x_t.applyAll(valAry, cache);
        J[1][0] = y_r.applyAll(valAry, cache);
        J[1][1] = y_s.applyAll(valAry, cache);
        J[1][2] = y_t.applyAll(valAry, cache);
        J[2][0] = z_r.applyAll(valAry, cache);
        J[2][1] = z_s.applyAll(valAry, cache);
        J[2][2] = z_t.applyAll(valAry, cache);
        // @see ./doc/invA33.png
        detJ = Utils.determinant(J);
        if (cache != null) {
          cache.put(1, detJ);
          cache.put(2, J);
        }
      }

      if ("r".equals(rst)) {
        if ("x".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[1][1][i] * J[2][2][i] - J[1][2][i] * J[2][1][i]) / detJ[i];
        else if ("y".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][2][i] * J[2][1][i] - J[0][1][i] * J[2][2][i]) / detJ[i];
        else if ("z".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][1][i] * J[1][2][i] - J[0][2][i] * J[1][1][i]) / detJ[i];
      } else if ("s".equals(rst)) {
        if ("x".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[1][2][i] * J[2][0][i] - J[1][0][i] * J[2][2][i]) / detJ[i];
        else if ("y".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][0][i] * J[2][2][i] - J[0][2][i] * J[2][0][i]) / detJ[i];
        else if ("z".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][2][i] * J[1][0][i] - J[0][0][i] * J[1][2][i]) / detJ[i];
      } else if ("t".equals(rst)) {
        if ("x".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[1][0][i] * J[2][1][i] - J[1][1][i] * J[2][0][i]) / detJ[i];
        else if ("y".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][1][i] * J[2][0][i] - J[0][0][i] * J[2][1][i]) / detJ[i];
        else if ("z".equals(xyz))
          for (int i = 0; i < len; i++)
            rlt[i] = (J[0][0][i] * J[1][1][i] - J[0][1][i] * J[1][0][i]) / detJ[i];
      } else {
        throw new FutureyeException();
      }
      return rlt;
    }