efront 3.20.4 → 3.20.8

package/coms/basic/matrix.js

@@ -1,306 +0,0 @@
-// 空间变换算法
-// function [dots]=xrs(dots,wyh)
-// % 转动，缩放，平移，依次进行
-// % wyh.mid为变换中心
-// % wyh.ppt为转动轴的方向
-// % wyh.alph为转动角度
-// % wyh.scrl为缩放系数，反射可设轴向系数为-1
-// % wyh.drag为平移向量
-// wyh.alph=pi*wyh.alph/180;
-// if size(dots,2)==3
-//     if numel(wyh.ppt) == 2 
-//         theta = pi*wyh.ppt(1)/180;
-//         phi = pi*wyh.ppt(2)/180;
-//         rot_u = [cos(phi)*cos(theta); cos(phi)*sin(theta); sin(phi)];
-//     elseif numel(wyh.ppt) == 3 
-//         rot_u = wyh.ppt(:)/norm(wyh.ppt);
-//     end
-//     x_u = rot_u(1);
-//     y_u = rot_u(2);
-//     z_u = rot_u(3);
-//     cosa = cos(wyh.alph);
-//     sina = sin(wyh.alph);
-//     vera = 1 - cosa;
-//     rot = [cosa+x_u^2*vera x_u*y_u*vera-z_u*sina x_u*z_u*vera+y_u*sina; ...
-//         x_u*y_u*vera+z_u*sina cosa+y_u^2*vera y_u*z_u*vera-x_u*sina; ...
-//         x_u*z_u*vera-y_u*sina y_u*z_u*vera+x_u*sina cosa+z_u^2*vera]';
-// else
-//     rot=[cos(wyh.alph),-sin(wyh.alph);sin(wyh.alph),cos(wyh.alph)];
-// end
-// for cx=1:size(dots,1)
-//     dots(cx,:)=(dots(cx,:)-wyh.mid).*wyh.scrl*rot+wyh.mid+wyh.drag;
-// end
-// end
-"use strict";
-var notMatchLength = new Error("矩阵长度不一致");
-
-function transform(B, dots) {
-    var dimention = Math.sqrt(B.length - 1) | 0;
-    if (dots.length % dimention !== 0) throw notMatchLength;
-    if (dots === B) B = B.slice(0);
-    var ds = dots.slice(0);
-    var dim2 = B.length % dimention !== 0 ? dimention + 1 : dimention;
-    for (var cx = 0, dx = dots.length; cx < dx; cx += dimention) {
-        for (var cy = 0, dy = dimention; cy < dy; cy++) {
-            var sum = 0;
-            var start = dim2 * cy;
-            for (var ct = 0, dt = dimention; ct < dt; ct++) {
-                sum += ds[cx + ct] * B[start + ct];
-            }
-            sum += B[start + dimention];
-            dots[cx + cy] = sum;
-        }
-    }
-    return dots;
-};
-
-function translate(A, delta) {
-    var [dim2, dim] = size(A);
-    var inc = 0;
-    for (var cx = dim, dx = dim * dim2; cx < dx; cx += dim2) {
-        A[cx] = (A[cx] || 0) + delta[inc++];
-    }
-    return A;
-}
-
-function 负(a) {
-    return -a;
-}
-
-function multiply(A, B) {
-    if (A.length !== B.length) throw notMatchLength;
-    var dim = Math.sqrt(A.length) | 0;
-    if (dim * dim !== A.length) throw notMatchLength;
-    var X = A.slice(0);
-    for (var cx = 0, dx = A.length; cx < dx; cx += dim) {
-        for (var cy = 0, dy = dim; cy < dy; cy++) {
-            var sum = 0;
-            for (var ct = 0, dt = dim; ct < dt; ct++) {
-                sum += B[cx + ct] * X[ct * dim + cy];
-            }
-            A[cx + cy] = sum;
-        }
-    }
-    return A;
-}
-
-function inner(vec1, vec2) {
-    if (vec1.length !== vec2.length) throw notMatchLength;
-    var sum = 0;
-    for (var cx = 0, dx = vec1.length; cx < dx; cx++) {
-        sum += vec1[cx] * vec2[cx];
-    }
-    return sum;
-}
-function cross(vec1, vec2) {
-    if (vec1.length !== vec2.length) throw notMatchLength;
-    var c = new Array(vec1.length);
-    for (var cx = 0, dx = vec1.length; cx < dx; cx++) {
-        var s = 0, f = 1;
-        for (var cy = 1, dy = dx; cy < dy; cy++) {
-            var c1 = cx + cy;
-            var c2 = c1 + f;
-            if (c1 >= dx) c1 -= dx;
-            if (c2 >= dx) c2 -= dx;
-            f = 0 - f;
-            s += vec1[c1] * vec2[c2];
-        }
-        c[cx] = s;
-    }
-    return c;
-}
-function times(vector, factor) {
-    for (var cx = 0, dx = vector.length; cx < dx; cx++) {
-        vector[cx] *= factor;
-    }
-    return vector;
-}
-
-function olinde(v, vector) {
-    // 罗德里格旋转公式
-    // https://baike.baidu.com/item/%E7%BD%97%E5%BE%B7%E9%87%8C%E6%A0%BC%E6%97%8B%E8%BD%AC%E5%85%AC%E5%BC%8F/18878562
-    // https://www.cnblogs.com/flyinggod/p/8144100.html 旋转矩阵、欧拉角、四元数理论及其转换关系
-    var theta = norm(vector);
-    var k = times(vector.slice(0), 1 / theta);
-    var cosa = Math.cos(theta);
-    var sina = Math.sin(theta);
-    var inna = inner(k, v);
-    var aa = inna * (1 - cosa);
-    var kv = cross(k, v);
-    for (var cx = 0, dx = k.length; cx < dx; cx++) {
-        v[cx] = v[cx] * cosa + aa * k[cx] + sina * kv[cx];
-    }
-    return v;
-}
-
-function matrix2d(theta) {
-    var cosa = Math.cos(theta);
-    var sina = Math.sin(theta);
-    return new Matrix(
-        cosa, -sina, 0,
-        sina, cosa, 0,
-        0, 0, 1
-    );
-}
-
-function matrix3d(factor) {
-    var theta = norm(factor);
-    var vec = times(factor, 1 / theta);
-    var cosa = Math.cos(theta);
-    var sina = Math.sin(theta);
-    var vera = 1 - cosa;
-    var [x_u, y_u, z_u] = factor ? [0, 0, 1] : vec;
-
-    return new Matrix(
-        cosa + x_u * x_u * vera, x_u * y_u * vera + z_u * sina, x_u * z_u * vera - y_u * sina, 0,
-        x_u * y_u * vera - z_u * sina, cosa + y_u * y_u * vera, y_u * z_u * vera + x_u * sina, 0,
-        x_u * z_u * vera + y_u * sina, y_u * z_u * vera - x_u * sina, cosa + z_u * z_u * vera, 0,
-        0, 0, 0, 1
-    );
-}
-var norm = function (vector) {
-    var sum = 0;
-    for (var cx = 0, dx = vector.length; cx < dx; cx++) {
-        sum += vector[cx] * vector[cx];
-    }
-    return Math.sqrt(sum);
-};
-
-var 逆 = function (A) {
-    var dim = Math.sqrt(A.length) | 0;
-    if (dim * dim !== A.length) throw notMatchLength;
-    var E = new Array(A.length).fill(0);
-    for (var cx = 0, dx = dim; cx < dx; cx++)E[cx * dim + cx] = 1;
-    var X = A.splice(0, A.length);
-    A.push.apply(A, E);
-    for (var cx = 0, dx = dim; cx < dx; cx++) {
-        var start = cx * dim + cx;
-        var max_ct, v = 0;
-        for (var ct = start, dt = cx * dim + dim; ct < dt; ct++) {
-            var v0 = Math.abs(X[ct]);
-            if (v0 > v) {
-                max_ct = ct;
-                v = v0;
-            }
-        }
-        ct = max_ct;
-        if (ct !== start) {
-            var delta = ct - start;
-            var ratio = (1 - X[start]) / X[ct];
-            for (var cy = cx, dy = X.length; cy < dy; cy += dim) {
-                X[cy] += X[cy + delta] * ratio;
-                A[cy] += A[cy + delta] * ratio;
-            }
-        }
-        if (X[start] !== 1) {
-            var ratio = 1 / X[start];
-            for (var cy = cx, dy = X.length; cy < dy; cy += dim) {
-                X[cy] *= ratio;
-                A[cy] *= ratio;
-            }
-        }
-        for (var ct = start + 1, dt = start + dim - cx; ct < dt; ct++) {
-            if (X[ct] === 0) continue;
-            var ratio = -X[ct];
-            var delta = start - ct;
-            for (var cy = cx + ct - start, dy = X.length; cy < dy; cy += dim) {
-                X[cy] += X[cy + delta] * ratio;
-                A[cy] += A[cy + delta] * ratio;
-            }
-        }
-    }
-    for (var cx = dim - 1; cx >= 0; cx--) {
-        var start = cx * dim + cx;
-        for (var ct = start - 1, dt = start - cx; ct >= dt; ct--) {
-            if (X[ct] === 0) continue;
-            var ratio = -X[ct];
-            var delta = start - ct;
-            for (var cy = cx + ct - start, dy = X.length; cy < dy; cy += dim) {
-                X[cy] += X[cy + delta] * ratio;
-                A[cy] += A[cy + delta] * ratio;
-            }
-        }
-    }
-    return A;
-};
-
-function size(A) {
-    var dim = Math.sqrt(A.length - 1) | 0;
-    var dim2 = dim;
-    if (A.length % dim !== 0) {
-        dim2++;
-    }
-    if ((dim + 1) * dim2 !== A.length) throw notMatchLength;
-    return [dim2, dim];
-}
-
-class Matrix extends Array {
-    static create2d(theta = 0) {
-        return matrix2d(theta);
-    }
-    static create3d(factor = [0, 0, 0]) {
-        return matrix3d(factor);
-    }
-    size() {
-        return size(this);
-    }
-    dirty() {
-        this._invert = null;
-    }
-    _invert = null;
-    get invert() {
-        if (this._invert) return this._invert;
-        return this._invert = this.slice().inverse();
-    }
-    transpose() {
-        var [size] = this.size();
-        for (var cx = 0, dx = size; cx < dx; cx++) {
-            for (var cy = cx + 1, dy = dx; cy < dy; cy++) {
-                var i = cx * size + cy;
-                var j = cy * size + cx;
-                var tmp = this[i];
-                this[i] = this[j];
-                this[j] = tmp;
-            }
-        }
-        return this;
-    }
-    inverse() {
-        this.dirty();
-        return 逆(this);
-    }
-    rotate(factor, center) {
-        this.dirty();
-        if (center) this.translate(center.map(负));
-        if (factor.length) {
-            this.multiply(matrix3d(factor));
-        }
-        else {
-            this.multiply(matrix2d(factor));
-        }
-        if (center) this.translate(center);
-        return this;
-    }
-    translate(vector) {
-        this.dirty();
-        return translate(this, vector);
-    }
-    scale(ratio) {
-        this.dirty();
-        times(this, ratio);
-        this[this.length - 1] = 1;
-        return this;
-    }
-    multiply(a) {
-        this.dirty();
-        return multiply(this, a);
-    }
-    transform(dots) {
-        if (dots instanceof Array) return transform(this, dots);
-        if (arguments.length > 1) {
-            var a = Array.prototype.slice.apply(arguments, 0);
-            return transform(this, a);
-        }
-        return dots;
-    }
-}