CESIUM空間中AB兩點A繞B點的地面法向量旋轉任意角度后新的A點坐標(A’)

var A = new Cesium.Cartesian3(675679.994355399, 4532763.148054989, 4426298.210847025);
var B = new Cesium.Cartesian3(675520.4303984543, 4532803.837842555, 4425994.113846752);
 
 
// 計算B的地面法向量
var chicB = Cesium.Cartographic.fromCartesian(B);
chicB.height = 0;
var dB = Cesium.Cartographic.toCartesian(chicB);
var normaB = Cesium.Cartesian3.normalize(Cesium.Cartesian3.subtract(dB, B, new Cesium.Cartesian3()), new Cesium.Cartesian3());
 
// 構造基於B的法向量旋轉90度的矩陣
var Q = Cesium.Quaternion.fromAxisAngle(normaB, Cesium.Math.toRadians(90));
var m3 = Cesium.Matrix3.fromQuaternion(Q);
var m4 = Cesium.Matrix4.fromRotationTranslation(m3);
 
// 計算A點相對B點的坐標A1
var A1 = Cesium.Cartesian3.subtract(A, B, new Cesium.Cartesian3());
 
//對A1應用旋轉矩陣
var p = Cesium.Matrix4.multiplyByPoint(m4, A1, new Cesium.Cartesian3());
// 新的A的坐標
var p2 = Cesium.Cartesian3.add(p, B, new Cesium.Cartesian3());
 
viewer.entities.add({
    polyline: {
        positions: [B, A],
        width: 5,
        material: Cesium.Color.RED
    },
});
 
 
viewer.entities.add({
    polyline: {
        positions: [B, p2],
        width: 5,
        material: Cesium.Color.BLUE
    },
 
});