地理坐标转换为地面摄影坐标.c

用于摄影测量与遥感中的地理坐标与地面摄影坐标的转换

#include <math.h>
#include <stdio.h>
main()
{
//double zbzh_dm(double dlzb[],double syzb[],double A); /*地理坐标转换为地面摄影坐标*/
 int i;
 double dlzb[5][3]={1014.158,1966.875,78.578,660.497,1907.757,74.670,2203.432,524.685,73.562,2464.063,646.672,58.171,698.373,1818.27,763.85};
 double syzb[5][3];
 double A=2.134; //航向方位角
 for(i=0;i<4;i++)
    {syzb[i][0]=dlzb[i][0]*cos(A)+dlzb[i][1]*sin(A);
     syzb[i][1]=dlzb[i][0]*sin(A)-dlzb[i][1]*cos(A);
     syzb[i][2]=dlzb[i][2];
    }
 for(i=0;i<4;i++)
  {printf("地面摄影坐标Xtp是%f\n地面摄影坐标Ytp是%f\n地面摄影坐标Ztp是%f\n",syzb[i][0],syzb[i][1],syzb[i][2]);
  }
  syzb[4][0]=dlzb[4][0]*cos(A)+dlzb[4][1]*sin(A);//像主点的地面摄影系下的坐标
  syzb[4][1]=dlzb[4][0]*sin(A)-dlzb[4][1]*cos(A);
  syzb[4][2]=dlzb[4][2];
  printf("地面摄影坐标Xstp是%f\n地面摄影坐标Ystp是%f\n地面摄影坐标Zstp是%f\n",syzb[i][0],syzb[i][1],syzb[i][2]);
  //return;
}