static public bool OPK2RMat(OriAngle pOri, ref Matrix pRMat)
{
if (pRMat == null)
{
pRMat = new Matrix(3, 3);
}
if ((pRMat.row != 3) || (pRMat.col != 3))
{
return(false);
}
double dSOmg = Math.Sin((pOri.omg));
double dSPhi = Math.Sin((pOri.phi));
double dSKap = Math.Sin((pOri.kap));
double dCOmg = Math.Cos((pOri.omg));
double dCPhi = Math.Cos((pOri.phi));
double dCKap = Math.Cos((pOri.kap));
pRMat.SetNum(0, 0, dCPhi * dCKap);
pRMat.SetNum(0, 1, -dCPhi * dSKap);
pRMat.SetNum(0, 2, dSPhi);
pRMat.SetNum(1, 0, (dCOmg * dSKap + dSOmg * dSPhi * dCKap));
pRMat.SetNum(1, 1, (dCOmg * dCKap - dSOmg * dSPhi * dSKap));
pRMat.SetNum(1, 2, -dSOmg * dCPhi);
pRMat.SetNum(2, 0, (dSOmg * dSKap - dCOmg * dSPhi * dCKap));
pRMat.SetNum(2, 1, (dSOmg * dCKap + dCOmg * dSPhi * dSKap));
pRMat.SetNum(2, 2, dCOmg * dCPhi);
return(true);
}
public bool projectBackward(IFeatureClass pInputFeatureClass, IRasterLayer pDemLayer, string szXmlFilename,
ref IFeatureClass pOutputPolylineFeatureClass, ref IFeatureClass pOutputPointFeatureClass)
{
if (pInputFeatureClass == null || pDemLayer == null || string.IsNullOrEmpty(szXmlFilename) || pOutputPointFeatureClass == null || pOutputPolylineFeatureClass == null)
{
return(false);
}
#region 读取DEM文件
IRasterLayer pRasterLayer = pDemLayer;// new RasterLayerClass();
//pRasterLayer.CreateFromFilePath(szDemFilename);
IRaster pDemRaster = pRasterLayer.Raster;
IRasterProps pDemRasterProps = pDemRaster as IRasterProps;
#endregion
#region 读取相机姿态参数
ClsCameraPara cameraPara = ParseXmlFileToGetPara(szXmlFilename);
if (cameraPara == null)
{
return(false);
}
//根据姿态参数获得旋转矩阵
OriAngle oriAngle = new OriAngle();
Matrix pRotateMatrix = new Matrix(3, 3);
oriAngle.kap = cameraPara.dKappa;
oriAngle.omg = cameraPara.dOmg;
oriAngle.phi = cameraPara.dPhi;
if (!ClsGetCameraView.OPK2RMat(oriAngle, ref pRotateMatrix))
{
return(false);
}
#endregion
#region 得到曲线信息
List <ISegmentCollection> pSegmentCollection = new List <ISegmentCollection>();
List <IFeature> pFeatureList = new List <IFeature>();
IFeatureCursor pFCursor = pInputFeatureClass.Search(null, false);
IFeature pFeature = null;// pFCursor.NextFeature();
while ((pFeature = pFCursor.NextFeature()) != null)
{
IPolyline pPolyline = pFeature.Shape as IPolyline;
if (pPolyline == null)
{
//pFeature = pFCursor.NextFeature();
continue;
}
IFeature pTmpFeature = pFeature;
pFeatureList.Add(pTmpFeature);
ISegmentCollection pCurrentSegmentCollection = pPolyline as ISegmentCollection;
pSegmentCollection.Add(pCurrentSegmentCollection);
}
#endregion
#region 节点位置反投影
List <List <Pt2d> > ptImageFeaturePoints = new List <List <Pt2d> >();
List <List <Pt2d> > ptImageFeaturePointsForPointShp = new List <List <Pt2d> >();
ClsGetCameraView pGetCameraView = new ClsGetCameraView();
for (int i = 0; i < pSegmentCollection.Count; i++)
{
List <Pt2d> ptSingleImageFeaturePoints = new List <Pt2d>();
List <Pt2d> ptSingleImageFeaturePointsForPointShp = new List <Pt2d>();
for (int j = 0; j < pSegmentCollection[i].SegmentCount; j++)
{
ISegment pCurrentSegment = pSegmentCollection[i].get_Segment(j);
if (pCurrentSegment == null)
{
continue;
}
//直线
if (pCurrentSegment.GeometryType == esriGeometryType.esriGeometryLine)
{
ILine pLine = pCurrentSegment as ILine;
//起始点
IPoint ptFrom = pLine.FromPoint;
Pt2d ptFrom2d = getProjectBackwardPoint(ptFrom, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptFrom2d != null)
{
ptSingleImageFeaturePoints.Add(ptFrom2d);
ptSingleImageFeaturePointsForPointShp.Add(ptFrom2d);
}
//终止点
IPoint ptTo = pLine.ToPoint;
Pt2d ptTo2d = getProjectBackwardPoint(ptTo, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptTo2d != null)
{
if (j == pSegmentCollection[i].SegmentCount - 1) //最后一条直线段
{
ptSingleImageFeaturePointsForPointShp.Add(ptTo2d);
ptSingleImageFeaturePoints.Add(ptTo2d);
}
}
}
else if (pCurrentSegment.GeometryType == esriGeometryType.esriGeometryCircularArc) //圆弧
{
ICircularArc pCircularArc = pCurrentSegment as ICircularArc;
double dbCurveLength = pCircularArc.Length;
int nCount = 15;
double dbOffset = dbCurveLength / nCount;
for (int nCurrent = 0; nCurrent <= nCount; nCurrent++)
{
IPoint ptCurrent = new Point();
pCircularArc.QueryPoint(esriSegmentExtension.esriNoExtension, nCurrent * dbOffset, false, ptCurrent);
Pt2d ptCurrentImagePoint = getProjectBackwardPoint(ptCurrent, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptCurrentImagePoint != null)
{
ptSingleImageFeaturePoints.Add(ptCurrentImagePoint);
//只保留端点的信息，用于创建点SHP图层
if (nCurrent == 0 || nCurrent == nCount)
{
ptSingleImageFeaturePointsForPointShp.Add(ptCurrentImagePoint);
}
}
}
}
else
{
continue;
}
}
ptImageFeaturePoints.Add(ptSingleImageFeaturePoints);
ptImageFeaturePointsForPointShp.Add(ptSingleImageFeaturePointsForPointShp);
}
#endregion
#region 把节点位置信息写入
IDataset dataset = (IDataset)pOutputPolylineFeatureClass;
IWorkspace workspace = dataset.Workspace;
//Cast for an IWorkspaceEdit
IWorkspaceEdit workspaceEdit = workspace as IWorkspaceEdit;
workspaceEdit.StartEditing(true);
workspaceEdit.StartEditOperation();
//////////////////////////////////////////////////////////////////////////
//整条路线的添加
IFeatureCursor pOutFCursor = null;
for (int i = 0; i < ptImageFeaturePoints.Count; i++)
{
int nPtsCount = ptImageFeaturePoints[i].Count;
IFeatureBuffer pFeatureBuffer = pOutputPolylineFeatureClass.CreateFeatureBuffer();
pOutFCursor = pOutputPolylineFeatureClass.Insert(true);
IPolyline pPolyline = new PolylineClass();
IPointCollection pPointCollection = pPolyline as IPointCollection;
for (int j = 0; j < nPtsCount; j++)
{
IPoint pt = new PointClass();
pt.PutCoords(ptImageFeaturePoints[i][j].X, ptImageFeaturePoints[i][j].Y);
pPointCollection.AddPoint(pt);
}
if (!ClsGDBDataCommon.CopyFeatureFieldValue(pFeatureList[i], pFeatureBuffer as IFeature))
{
continue;
}
pFeatureBuffer.Shape = pPolyline as IGeometry;
object featureOID = pOutFCursor.InsertFeature(pFeatureBuffer);
}
if (pOutFCursor != null)
{
pOutFCursor.Flush();
}
//分段路线的添加
for (int i = 0; i < ptImageFeaturePoints.Count; i++)
{
int nPtsCount = ptImageFeaturePoints[i].Count;
for (int j = 0; j < nPtsCount - 1; j++)
{
IFeatureBuffer pFeatureBuffer = pOutputPolylineFeatureClass.CreateFeatureBuffer();
pOutFCursor = pOutputPolylineFeatureClass.Insert(true);
IPolyline pPolyline = new PolylineClass();
IPointCollection pPointCollection = pPolyline as IPointCollection;
IPoint pt = new PointClass();
pt.PutCoords(ptImageFeaturePoints[i][j].X, ptImageFeaturePoints[i][j].Y);
pPointCollection.AddPoint(pt);
pt.PutCoords(ptImageFeaturePoints[i][j + 1].X, ptImageFeaturePoints[i][j + 1].Y);
pPointCollection.AddPoint(pt);
if (!ClsGDBDataCommon.CopyFeatureFieldValue(pFeatureList[i], pFeatureBuffer as IFeature))
{
continue;
}
pFeatureBuffer.Shape = pPolyline as IGeometry;
object featureOID = pOutFCursor.InsertFeature(pFeatureBuffer);
}
}
if (pOutFCursor != null)
{
pOutFCursor.Flush();
}
//featureCursor.Flush();
workspaceEdit.StopEditOperation();
workspaceEdit.StopEditing(true);
#endregion
#region 点SHP文件的添加
IDataset pPointDataset = (IDataset)pOutputPointFeatureClass;
IWorkspace pPointWorkspace = pPointDataset.Workspace;
//Cast for an IWorkspaceEdit
IWorkspaceEdit pPointWorkspaceEdit = pPointWorkspace as IWorkspaceEdit;
pPointWorkspaceEdit.StartEditing(true);
pPointWorkspaceEdit.StartEditOperation();
IFeatureCursor pOutPointFCursor = null;
for (int i = 0; i < ptImageFeaturePointsForPointShp.Count; i++)
{
//int nSegmentCount = pSegmentCollection[i].SegmentCount;
//IMultipoint pMultiPoint = new MultipointClass();
for (int j = 0; j < ptImageFeaturePointsForPointShp[i].Count; j++)
{
IFeatureBuffer pFeatureBuffer = pOutputPointFeatureClass.CreateFeatureBuffer();
pOutPointFCursor = pOutputPointFeatureClass.Insert(true);
IPoint pt = new PointClass();
Pt2d pt2d = ptImageFeaturePointsForPointShp[i][j];
pt.PutCoords(pt2d.X, pt2d.Y);
//CopyFeatureField(pFeatureList[i], pFeatureBuffer);
pFeatureBuffer.Shape = pt as IGeometry;
object featureOID = pOutPointFCursor.InsertFeature(pFeatureBuffer);
}
}
if (pOutPointFCursor != null)
{
pOutPointFCursor.Flush();
}
//featureCursor.Flush();
pPointWorkspaceEdit.StopEditOperation();
pPointWorkspaceEdit.StopEditing(true);
#endregion
return(true);
}
public bool projectBackward(string szInputShpFilename, IRasterLayer pDemLayer, string szXmlFilename, string szOutShpFilename)
{
if (string.IsNullOrEmpty(szInputShpFilename) || pDemLayer == null || string.IsNullOrEmpty(szXmlFilename) || string.IsNullOrEmpty(szOutShpFilename))
{
return(false);
}
ClsGDBDataCommon processDataCommon = new ClsGDBDataCommon();
string strInputPath = System.IO.Path.GetDirectoryName(szInputShpFilename);
string strInputName = System.IO.Path.GetFileName(szInputShpFilename);
#region 读取SHP文件
IWorkspace pWorkspace = processDataCommon.OpenFromShapefile(strInputPath);
IFeatureWorkspace pFeatureWorkspace = pWorkspace as IFeatureWorkspace;
IFeatureClass pInputFC = pFeatureWorkspace.OpenFeatureClass(strInputName);
#endregion
#region 读取DEM文件
IRasterLayer pRasterLayer = pDemLayer;// new RasterLayerClass();
//pRasterLayer.CreateFromFilePath(szDemFilename);
IRaster pDemRaster = pRasterLayer.Raster;
IRasterProps pDemRasterProps = pDemRaster as IRasterProps;
#endregion
#region 得到曲线信息
List <ISegmentCollection> pSegmentCollection = new List <ISegmentCollection>();
List <IFeature> pFeatureList = new List <IFeature>();
IFeatureCursor pFCursor = pInputFC.Search(null, false);
IFeature pFeature = null;// pFCursor.NextFeature();
while ((pFeature = pFCursor.NextFeature()) != null)
{
IPolyline pPolyline = pFeature.Shape as IPolyline;
if (pPolyline == null)
{
//pFeature = pFCursor.NextFeature();
continue;
}
IFeature pTmpFeature = pFeature;
pFeatureList.Add(pTmpFeature);
ISegmentCollection pCurrentSegmentCollection = pPolyline as ISegmentCollection;
pSegmentCollection.Add(pCurrentSegmentCollection);
}
#endregion
#region 读取相机姿态参数
ClsCameraPara cameraPara = ParseXmlFileToGetPara(szXmlFilename);
if (cameraPara == null)
{
return(false);
}
//根据姿态参数获得旋转矩阵
OriAngle oriAngle = new OriAngle();
Matrix pRotateMatrix = new Matrix(3, 3);
oriAngle.kap = cameraPara.dKappa;
oriAngle.omg = cameraPara.dOmg;
oriAngle.phi = cameraPara.dPhi;
if (!ClsGetCameraView.OPK2RMat(oriAngle, ref pRotateMatrix))
{
return(false);
}
#endregion
#region 创建输出SHP文件
string strOutputPath = System.IO.Path.GetDirectoryName(szOutShpFilename);
string strOutputName = System.IO.Path.GetFileName(szOutShpFilename);
string strPointOutputName = System.IO.Path.GetFileNameWithoutExtension(szOutShpFilename) + "_point" + System.IO.Path.GetExtension(szOutShpFilename);
//设置空间参考
ISpatialReference pSpatialRef = new UnknownCoordinateSystemClass(); //没有这一句就报错，说尝试读取或写入受保护的内存。
pSpatialRef.SetDomain(MIN_INT, MAX_INT, MIN_INT, MAX_INT); //没有这句就抛异常来自HRESULT：0x8004120E。
pSpatialRef.SetZDomain(MIN_INT, MAX_INT);
//创建POLYLINE文件的字段
IFields pFields = pInputFC.Fields;
//创建点SHP文件的字段
IFields pPointFields = new FieldsClass();
IFieldsEdit pFieldsEdit = (IFieldsEdit)pPointFields;
//设置字段
IField pField = new FieldClass();
IFieldEdit pFieldEdit = (IFieldEdit)pField;
//创建类型为几何类型的字段
pFieldEdit.Name_2 = "shape";
pFieldEdit.Type_2 = esriFieldType.esriFieldTypeGeometry;
IGeometryDef pGeoDef = new GeometryDefClass();
IGeometryDefEdit pGeoDefEdit = (IGeometryDefEdit)pGeoDef;
pGeoDefEdit.GeometryType_2 = esriGeometryType.esriGeometryPoint;
pGeoDefEdit.HasM_2 = false;
pGeoDefEdit.HasZ_2 = false;
pGeoDefEdit.SpatialReference_2 = pSpatialRef;
//pFieldEdit.Name_2 = "SHAPE";
//pFieldEdit.Type_2 = esriFieldType.esriFieldTypeGeometry;
pFieldEdit.GeometryDef_2 = pGeoDef;
pFieldEdit.IsNullable_2 = true;
pFieldEdit.Required_2 = true;
pFieldsEdit.AddField(pField);
IFeatureClass pOutputFC = processDataCommon.CreateShapefile(strOutputPath, strOutputName, pFields, pSpatialRef);
IFeatureClass pOutputPointFC = processDataCommon.CreateShapefile(strOutputPath, strPointOutputName, pPointFields, pSpatialRef);
if (pOutputFC == null || pOutputPointFC == null)
{
return(false);
}
#endregion
#region 节点位置反投影
List <List <Pt2d> > ptImageFeaturePoints = new List <List <Pt2d> >();
List <List <Pt2d> > ptImageFeaturePointsForPointShp = new List <List <Pt2d> >();
ClsGetCameraView pGetCameraView = new ClsGetCameraView();
for (int i = 0; i < pSegmentCollection.Count; i++)
{
List <Pt2d> ptSingleImageFeaturePoints = new List <Pt2d>();
List <Pt2d> ptSingleImageFeaturePointsForPointShp = new List <Pt2d>();
for (int j = 0; j < pSegmentCollection[i].SegmentCount; j++)
{
ISegment pCurrentSegment = pSegmentCollection[i].get_Segment(j);
if (pCurrentSegment == null)
{
continue;
}
//直线
if (pCurrentSegment.GeometryType == esriGeometryType.esriGeometryLine)
{
ILine pLine = pCurrentSegment as ILine;
//起始点
IPoint ptFrom = pLine.FromPoint;
Pt2d ptFrom2d = getProjectBackwardPoint(ptFrom, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptFrom2d != null)
{
ptSingleImageFeaturePoints.Add(ptFrom2d);
ptSingleImageFeaturePointsForPointShp.Add(ptFrom2d);
}
//终止点
IPoint ptTo = pLine.ToPoint;
Pt2d ptTo2d = getProjectBackwardPoint(ptTo, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptTo2d != null)
{
ptSingleImageFeaturePoints.Add(ptTo2d);
if (j == pSegmentCollection[i].SegmentCount - 1) //最后一条直线段
{
ptSingleImageFeaturePointsForPointShp.Add(ptTo2d);
}
}
}
else if (pCurrentSegment.GeometryType == esriGeometryType.esriGeometryCircularArc) //圆弧
{
ICircularArc pCircularArc = pCurrentSegment as ICircularArc;
double dbCurveLength = pCircularArc.Length;
int nCount = 15;
double dbOffset = dbCurveLength / nCount;
for (int nCurrent = 0; nCurrent < nCount; nCurrent++)
{
IPoint ptCurrent = new Point();
pCircularArc.QueryPoint(esriSegmentExtension.esriNoExtension, nCurrent * dbOffset, false, ptCurrent);
Pt2d ptCurrentImagePoint = getProjectBackwardPoint(ptCurrent, pDemRaster, pGetCameraView, pRotateMatrix, cameraPara);
if (ptCurrentImagePoint != null)
{
ptSingleImageFeaturePoints.Add(ptCurrentImagePoint);
//只保留端点的信息，用于创建点SHP图层
if (nCurrent == 0 || nCurrent == nCount - 1)
{
ptSingleImageFeaturePointsForPointShp.Add(ptCurrentImagePoint);
}
}
}
}
else
{
continue;
}
}
ptImageFeaturePoints.Add(ptSingleImageFeaturePoints);
ptImageFeaturePointsForPointShp.Add(ptSingleImageFeaturePointsForPointShp);
}
#endregion
#region 写入POLYLINE节点信息
IDataset dataset = (IDataset)pOutputFC;
IWorkspace workspace = dataset.Workspace;
//Cast for an IWorkspaceEdit
IWorkspaceEdit workspaceEdit = workspace as IWorkspaceEdit;
workspaceEdit.StartEditing(true);
workspaceEdit.StartEditOperation();
//////////////////////////////////////////////////////////////////////////
//整条路线的添加
IFeatureCursor pOutFCursor = null;
for (int i = 0; i < ptImageFeaturePoints.Count; i++)
{
int nPtsCount = ptImageFeaturePoints[i].Count;
IFeatureBuffer pFeatureBuffer = pOutputFC.CreateFeatureBuffer();
pOutFCursor = pOutputFC.Insert(true);
IPolyline pPolyline = new PolylineClass();
IPointCollection pPointCollection = pPolyline as IPointCollection;
for (int j = 0; j < nPtsCount; j++)
{
IPoint pt = new PointClass();
pt.PutCoords(ptImageFeaturePoints[i][j].X, ptImageFeaturePoints[i][j].Y);
pPointCollection.AddPoint(pt);
}
if (!ClsGDBDataCommon.CopyFeatureFieldValue(pFeatureList[i], pFeatureBuffer as IFeature))
{
continue;
}
pFeatureBuffer.Shape = pPolyline as IGeometry;
object featureOID = pOutFCursor.InsertFeature(pFeatureBuffer);
}
pOutFCursor.Flush();
//分段路线的添加
for (int i = 0; i < ptImageFeaturePoints.Count; i++)
{
int nPtsCount = ptImageFeaturePoints[i].Count;
for (int j = 0; j < nPtsCount - 1; j++)
{
IFeatureBuffer pFeatureBuffer = pOutputFC.CreateFeatureBuffer();
pOutFCursor = pOutputFC.Insert(true);
IPolyline pPolyline = new PolylineClass();
IPointCollection pPointCollection = pPolyline as IPointCollection;
IPoint pt = new PointClass();
pt.PutCoords(ptImageFeaturePoints[i][j].X, ptImageFeaturePoints[i][j].Y);
pPointCollection.AddPoint(pt);
pt.PutCoords(ptImageFeaturePoints[i][j + 1].X, ptImageFeaturePoints[i][j + 1].Y);
pPointCollection.AddPoint(pt);
if (!ClsGDBDataCommon.CopyFeatureFieldValue(pFeatureList[i], pFeatureBuffer as IFeature))
{
continue;
}
pFeatureBuffer.Shape = pPolyline as IGeometry;
object featureOID = pOutFCursor.InsertFeature(pFeatureBuffer);
}
}
pOutFCursor.Flush();
//featureCursor.Flush();
workspaceEdit.StopEditOperation();
workspaceEdit.StopEditing(true);
#endregion
#region 点SHP文件的添加
IDataset pPointDataset = (IDataset)pOutputPointFC;
IWorkspace pPointWorkspace = pPointDataset.Workspace;
//Cast for an IWorkspaceEdit
IWorkspaceEdit pPointWorkspaceEdit = pPointWorkspace as IWorkspaceEdit;
pPointWorkspaceEdit.StartEditing(true);
pPointWorkspaceEdit.StartEditOperation();
IFeatureCursor pOutPointFCursor = null;
for (int i = 0; i < ptImageFeaturePointsForPointShp.Count; i++)
{
//int nSegmentCount = pSegmentCollection[i].SegmentCount;
//IMultipoint pMultiPoint = new MultipointClass();
for (int j = 0; j < ptImageFeaturePointsForPointShp[i].Count; j++)
{
IFeatureBuffer pFeatureBuffer = pOutputPointFC.CreateFeatureBuffer();
pOutPointFCursor = pOutputPointFC.Insert(true);
IPoint pt = new PointClass();
Pt2d pt2d = ptImageFeaturePointsForPointShp[i][j];
pt.PutCoords(pt2d.X, pt2d.Y);
//CopyFeatureField(pFeatureList[i], pFeatureBuffer);
pFeatureBuffer.Shape = pt as IGeometry;
object featureOID = pOutPointFCursor.InsertFeature(pFeatureBuffer);
}
}
pOutPointFCursor.Flush();
//featureCursor.Flush();
pPointWorkspaceEdit.StopEditOperation();
pPointWorkspaceEdit.StopEditing(true);
#endregion
return(true);
}
public void calImagePos(IRaster pRaster, Pt2d[] ptGeoPos, string szXmlFile, out Pt2d[] ptImagePos)
{
ptImagePos = null;
if (pRaster == null)
{
return;
}
try
{
ClsCameraPara cameraPara = ParseXmlFileToGetPara(szXmlFile);
if (cameraPara == null)
{
return;
}
ClsGetCameraView getCameraView = new ClsGetCameraView();
Pt2i ptLeftTop = new Pt2i();
IRasterProps pProps = pRaster as IRasterProps;
int nWidth = pProps.Width;
int nHeight = pProps.Height;
double[,] dbData = new double[nWidth, nHeight];
Point2D ptTmpLeftTop = new Point2D();
ptTmpLeftTop.X = 0;
ptTmpLeftTop.Y = 0;
if (!getCameraView.readBlockDataToFile(ptTmpLeftTop, ref dbData, pRaster))
{
return;
}
//double[,] dbData = getCameraView.getSubDem(pRaster, new Pt3d(), 0, ref ptLeftTop);
int nCount = ptGeoPos.Length;
ptImagePos = new Pt2d[nCount];
for (int i = 0; i < nCount; i++)
{
Pt2d pt2d = new Pt2d();
OriAngle oriAngle = new OriAngle();
oriAngle.kap = cameraPara.dKappa;
oriAngle.omg = cameraPara.dOmg;
oriAngle.phi = cameraPara.dPhi;
Matrix pRMat = new Matrix(3, 3);
ClsGetCameraView.OPK2RMat(oriAngle, ref pRMat);
double dbTmpZ = double.NaN;
getCameraView.GetGeoZ(pRaster, dbData, ptLeftTop, ptGeoPos[i].X, ptGeoPos[i].Y, ref dbTmpZ);
if (dbTmpZ == double.NaN)
{
ptImagePos[i] = null;
continue;
}
double dbX, dbY, dbZ;
dbX = pRMat.getNum(0, 0) * (ptGeoPos[i].X - cameraPara.dX) + pRMat.getNum(1, 0) * (ptGeoPos[i].Y - cameraPara.dY)
+ pRMat.getNum(2, 0) * (dbTmpZ - cameraPara.dZ);
dbY = pRMat.getNum(0, 1) * (ptGeoPos[i].X - cameraPara.dX) + pRMat.getNum(1, 1) * (ptGeoPos[i].Y - cameraPara.dY)
+ pRMat.getNum(2, 1) * (dbTmpZ - cameraPara.dZ);
dbZ = pRMat.getNum(0, 2) * (ptGeoPos[i].X - cameraPara.dX) + pRMat.getNum(1, 2) * (ptGeoPos[i].Y - cameraPara.dY)
+ pRMat.getNum(2, 2) * (dbTmpZ - cameraPara.dZ);
Pt2d ptImageTmp = new Pt2d();
ptImageTmp.X = (int)Math.Round(-cameraPara.dFocus * dbX / dbZ);
ptImageTmp.Y = (int)Math.Round(-cameraPara.dFocus * dbY / dbZ);
ptImagePos[i] = ptImageTmp;
}
return;
}
catch (System.Exception ee)
{
MessageBox.Show(ee.Message, "提示", MessageBoxButtons.OK, MessageBoxIcon.Information);
}
}
public OriAngle ori; //!<外方位角元素
public ExOriPara()
{
pos = new Pt3d();
ori = new OriAngle();
}