相机偏置矩阵

2024-09-04 15:15:25 +08:00
parent 884dee3c82
commit abe5ecbdec
5 changed files with 51 additions and 32 deletions
--- a/pkg/calculator/intersection.go
+++ b/pkg/calculator/intersection.go
@@ -23,7 +23,7 @@ func Camera2GroundPoint(q Quaternion, satPos84 []float64, satTime time.Time, uca
 	direction := CameraDirectionVec(0, float64(ucam))

 	// -------- 相机坐标系下CCD成像方向向量转到卫星坐标系 --------
-	Rcam := CameraRotMatrix(CameraRoll*math.Pi/180.0, CameraPitch*math.Pi/180.0, 0)
+	Rcam := CameraRotMatrix(CameraRoll*math.Pi/180.0, CameraPitch*math.Pi/180.0, CameraYaw*math.Pi/180.0)
 	var dCam mat.VecDense
 	dCam.MulVec(Rcam, mat.NewVecDense(3, direction))