rpc
This commit is contained in:
@@ -1,8 +1,6 @@
|
||||
package calculator
|
||||
|
||||
import (
|
||||
"math"
|
||||
|
||||
"gonum.org/v1/gonum/mat"
|
||||
"gonum.org/v1/gonum/spatial/r3"
|
||||
)
|
||||
@@ -28,38 +26,3 @@ func OrbitToECMatrix(pos, vec []float64) *mat.Dense {
|
||||
|
||||
return m
|
||||
}
|
||||
|
||||
// IntersectionECEF 计算卫星与相机的交点,返回经纬度和高度
|
||||
// FIXME: 该计算方法有误,待修正
|
||||
func IntersectionECEF(Qsat2orbit Quaternion, satPos84, vec84 []float64, ucam int) (IntersectionPoint, error) {
|
||||
alpha := FOV * math.Pi / 180.0
|
||||
alpha = -alpha/2.0 + float64(ucam)*(alpha/float64(PANPixels))
|
||||
direction := []float64{0, math.Tan(alpha), -1.3} // 卫星(相机)坐标系下CCD成像方向向量
|
||||
|
||||
// -------- 相机坐标系下CCD成像方向向量转到卫星坐标系 --------
|
||||
Rcam := CameraRotMatrix(CameraRoll*math.Pi/180.0, CameraPitch*math.Pi/180.0, 0)
|
||||
var dCam mat.VecDense
|
||||
dCam.MulVec(Rcam, mat.NewVecDense(3, direction))
|
||||
|
||||
// -------- 转到轨道坐标系 --------
|
||||
Rsat2orbit := Qsat2orbit.ToRotationMatrix()
|
||||
var r0 mat.VecDense
|
||||
r0.MulVec(Rsat2orbit, &dCam)
|
||||
dOrbit := r0.RawVector().Data
|
||||
|
||||
// -------- 转到ECEF坐标系 --------
|
||||
Rorbit2ecef := OrbitToECMatrix(satPos84, vec84)
|
||||
var r1 mat.VecDense
|
||||
r1.MulVec(Rorbit2ecef, mat.NewVecDense(3, dOrbit))
|
||||
dECEF := r1.RawVector().Data
|
||||
|
||||
// -------- 计算交点 --------}
|
||||
intersection, err := intersectWithEllipsoid(satPos84, dECEF)
|
||||
if err != nil {
|
||||
return IntersectionPoint{}, err
|
||||
}
|
||||
|
||||
lat, lon, h := ECEFToGeodetic(intersection[0], intersection[1], intersection[2])
|
||||
|
||||
return IntersectionPoint{Lat: lat, Lon: lon, H: h}, err
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user