lankun/sjy01-image-proc
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

计算分辨率

Browse Source
This commit is contained in:
nuknal
2024-06-07 13:03:01 +08:00
parent cf5012f2a8
commit c046da2321
6 changed files with 240 additions and 105 deletions
Download Patch File Download Diff File Expand all files Collapse all files

45
pkg/calculator/intersection.go
View File

@@ -14,7 +14,13 @@ const (
nPixels = 9344 // 像素数
)
func Intersection(q Quaternion, satPos []float64, satTime time.Time, ucam int) (float64, float64) {
type IntersectionPoint struct {
Lat float64
Lon float64
H float64
}
func Intersection(q Quaternion, satPos84 []float64, satTime time.Time, ucam int) IntersectionPoint {
alpha := FOV * math.Pi / 180.0
alpha = -alpha/2.0 + float64(ucam)*(alpha/float64(nPixels))
direction := []float64{0, math.Tan(alpha), -1.3}
@@ -33,11 +39,42 @@ func Intersection(q Quaternion, satPos []float64, satTime time.Time, ucam int) (
x, y, z := ECItoECEF(eciDirection[0], eciDirection[1], eciDirection[2], satTime)
ecefDirection := []float64{x, y, z}
intersection := intersectWithEllipsoid(satPos, ecefDirection)
lat, lon, _ := ECEFToGeodetic(intersection[0], intersection[1], intersection[2])
intersection := intersectWithEllipsoid(satPos84, ecefDirection)
lat, lon, h := ECEFToGeodetic(intersection[0], intersection[1], intersection[2])
return IntersectionPoint{Lat: lat, Lon: lon, H: h}
return lat, lon
}
func Intersection2(Qsat2orbit, Qorbit2eci Quaternion, satPos84 []float64, satTime time.Time, ucam int) IntersectionPoint {
alpha := FOV * math.Pi / 180.0
alpha = -alpha/2.0 + float64(ucam)*(alpha/float64(nPixels))
direction := []float64{0, math.Tan(alpha), -1.3} // 卫星（相机）坐标系下CCD成像方向向量
// -------- 转到轨道坐标系 --------
Rsat2orbit := Qsat2orbit.ToRotationMatrix()
Rsat2orbitT := &mat.Dense{}
Rsat2orbitT.Inverse(Rsat2orbit)
var r0 mat.VecDense
r0.MulVec(Rsat2orbit, mat.NewVecDense(3, direction))
dOrbit := r0.RawVector().Data
// -------- 转到ECI坐标系 --------
Rorbit2eci := Qorbit2eci.ToRotationMatrix()
Rorbit2eciT := &mat.Dense{}
Rorbit2eciT.Inverse(Rorbit2eci)
var r1 mat.VecDense
r1.MulVec(Rorbit2eci, mat.NewVecDense(3, dOrbit))
dECI := r1.RawVector().Data
// -------- 转到ECEF坐标系 --------
x, y, z := ECItoECEF(dECI[0], dECI[1], dECI[2], satTime)
dECEF := []float64{x, y, z}
// -------- 计算交点 --------}
intersection := intersectWithEllipsoid(satPos84, dECEF)
lat, lon, h := ECEFToGeodetic(intersection[0], intersection[1], intersection[2])
return IntersectionPoint{Lat: lat, Lon: lon, H: h}
}
// 计算与椭球表面的交点