1234567891011121314151617181920212223242526272829303132333435363738 |
- void testThreeStar_DW()
- {
- double ref_llh[3] = { 112.9043, 9.55549, 0 };
- double main_sat[3] = { -41627130.333, 6291290.744, -2672292.823 };
- double neigh_sat1[3] = { -24196959 , 34540119, -37186 };
- //double neigh_sat2[3] = { 4738483, 41885781, 17606 };
- double neigh_sat2[3] = { 109.4082, 18.3878, 0 };//如果是2星1地,这里输入CDB站址坐标(经纬高)
- double Ref_Station_LLH[3] = { 112.9043, 9.55549, 0 };//ckz坐标
- //double target_dto1 = -0.015951469492725;
- //double target_dto2 = -0.003776303087869;
- //double ref_dto1 = -0.010094828958135;
- //double ref_dto2 = -0.003418405196386;
- double target_dto1 = -0.012351141858723;
- double target_dto2 = -0.250032322626937;
- double ref_dto1 = -0.018988008565341;
- double ref_dto2 = -0.264358558464538;//**如果是2星1的,这里输入的是样本主x参估结果
- double target_llh[3];
- vec_copy(Ref_Station_LLH, target_llh, 3);
- bool flag = 1;//8***如果是3x定位,这个为0;如果是2x1d,为1.
- DW_Analysis(main_sat, neigh_sat1, neigh_sat2, Ref_Station_LLH, target_dto1, target_dto2, ref_dto1, ref_dto2, target_llh, flag);
- for (int idx = 0; idx < 3; ++idx)
- {
- std::cout << target_llh[idx] << std::endl;
- }
- }
|