first_observ = firstObs.split()
appPos_XYZ = appPosXYZ.split()
ant_HEN = antHEN.split()
typ_observ = ts1.split()
pocet_kan = int(typ_observ[0])
typ_observ.remove(typ_observ[0])
# print "pocet kanalov:", pocet_kan
# print "suradnice XYZ:", appPos_XYZ
# print "pocet a signaly:", typ_observ
# print "prva observacia:", first_observ
# print "interval observacii", interval
# print "vysky anteny", ant_HEN
X = float(appPos_XYZ[0])
Y = float(appPos_XYZ[1])
Z = float(appPos_XYZ[2])
BLH_stanica = modul2.fXYZ_to_LatLonH(X, Y, Z)
B = BLH_stanica[0]
L = BLH_stanica[1]
H = BLH_stanica[2]
H_geoid = H - modul2.fhel_to_geoid(B, L)
dr = "PG23"
## ##########################################################
## nacitanie udajov z navigacnej spravy
hlavicka_nav = []
for data in subor_nav:
hlavicka_nav.append(data)
if "END" in data:
break
telo_nav = subor_nav[len(hlavicka_nav):]
# print telo_nav
hodnoty = []
##cas_eph = EPH[1]
##Rx = X_eph - poloha[0]
##Ry = Y_eph - poloha[1]
##Rz = Z_eph - poloha[2]
##vektor = math.sqrt(math.pow(Rx, 2) + math.pow(Ry, 2) + math.pow(Rz, 2))
##if vektor > vektor_max:
## vektor_max = vektor
##if vektor < vektor_min:
## vektor_min = vektor
##zapis = cd_eph + "\t" + str(cd_nav) + "\t" + str(cas_eph) + "\t" + str(cas_nav) + "\t" + str(
## Dt) + "\t" + str(X_eph) + "\t" + str(Y_eph) + "\t" + str(Z_eph) + "\t"
##zapis1 = zapis + str(poloha[0]) + "\t" + str(poloha[1]) + "\t" + str(poloha[2]) + "\t"
##zapis2 = zapis1 + str(Rx) + "\t" + str(Ry) + "\t" + str(Rz) + "\t" + str(vektor) + "\n"
##xls.write(zapis2) # zapis vyslednych hodnot xls
BLHd = modul2.fXYZ_to_LatLonH(poloha[0], poloha[1], poloha[2])
zapis_txt = cd_nav + " " + str(cas_nav + Dt) + " " + str(
cas_nav) + " " + str(Dt) + " " + str(poloha[0]) + " " + str(
poloha[1]) + " " + str(
poloha[2]) + "\n" # zapis vyslednych hodnot txt
txt.write(zapis_txt)
## vypocet elevacneho uhlu
Xd = poloha[0]
Yd = poloha[1]
Zd = poloha[2]
dx = Xd - X
dy = Yd - Y
dz = Zd - Z
l1 = math.sqrt(math.pow(dx, 2) +
math.pow(dy, 2)) # priemet druzice do vysky ref.stanice
l2 = math.sqrt(math.pow(dx, 2) + math.pow(dy, 2) + math.pow(dz, 2))
Dt = data_all[j][2]
cas_obs = data_obs[0][3]
cas = cas_nav + Dt
if cas != cas_obs:
continue
zoznam_druzic = data_obs[0][4]
cd_nav = data_all[j][0][1:]
Xd1 = data_all[j][3]
Yd1 = data_all[j][4]
Zd1 = data_all[j][5]
##print cd_nav, cas_nav
elev_uhol_rad = data_all[j][-1]
elev_uhol_stupne = math.degrees(elev_uhol_rad)
sin_elev_uhol = math.sin(elev_uhol_rad)
# print sin_elev_uhol
BLH = modul2.fXYZ_to_LatLonH(Xd1, Yd1, Zd1)
Bd = BLH[0]
Ld = BLH[1]
Hd = BLH[2]
#Hd_geoid = Hd - modul2.fhel_to_geoid(Bd, Ld)
Bd_rad = math.radians(Bd) # Latitude Zemepisna sirka fi y
Ld_rad = math.radians(Ld) # Longitude Zemepisna dlzka lambda x
B_rad = math.radians(B)
L_rad = math.radians(L)
sigma = math.acos(math.sin(B_rad)*math.sin(Bd_rad) + math.cos(B_rad)*math.cos(Bd_rad)*math.cos(L_rad-Ld_rad))
#print sigma
d = sigma * r
sina = (math.cos(B_rad)/math.sin(sigma))*math.sin(L_rad-Ld_rad)
#print sina
azimut = math.degrees(math.asin(sina)) #print azimut
#print ortodroma
Dt = data_all[j][2]
cas_obs = data_obs[0][3]
cas = cas_nav + Dt
if cas != cas_obs:
continue
zoznam_druzic = data_obs[0][4]
cd_nav = data_all[j][0][1:]
Xd1 = data_all[j][3]
Yd1 = data_all[j][4]
Zd1 = data_all[j][5]
##print cd_nav, cas_nav
elev_uhol_rad = data_all[j][-1]
elev_uhol_stupne = math.degrees(elev_uhol_rad)
sin_elev_uhol = math.sin(elev_uhol_rad)
# print sin_elev_uhol
BLH = modul2.fXYZ_to_LatLonH(Xd1, Yd1, Zd1)
Bd = BLH[0]
Ld = BLH[1]
Hd = BLH[2]
#Hd_geoid = Hd - modul2.fhel_to_geoid(Bd, Ld)
Bd_rad = math.radians(Bd) # Latitude Zemepisna sirka fi y
Ld_rad = math.radians(Ld) # Longitude Zemepisna dlzka lambda x
B_rad = math.radians(B)
L_rad = math.radians(L)
azimut2 = modul2.fCalculateAzimuth(X, Y, Xd1, Yd1)
n = 0
m = 3
for c in range(len(zoznam_druzic) / 3):
cd_obs = zoznam_druzic[n:m]
n = n + 3
m = m + 3
def fKruh(x, y, z):
r = 65.0
i = 0
cesta_vystup_txt_kruh_xyz = "../data/vystup/kruznica_xyz.txt"
txt_kruh_xyz = open(cesta_vystup_txt_kruh_xyz, "w")
txt_kruh_xyz.write("ID X Y Z\n")
cesta_vystup_txt_kruh_blh = "../data/vystup/kruznica_blh.txt"
txt_kruh_blh = open(cesta_vystup_txt_kruh_blh, "w")
txt_kruh_blh.write("ID L B H\n")
idLH = 1
idLD = 1
idPH = 1
idPD = 1
blh = modul2.fXYZ_to_LatLonH(x, y, z)
zapis_xyz = str(0) + " " + str(x).replace(".", ",") + " " + str(y).replace(
".", ",") + " " + str(z).replace(".", ",") + "\n"
zapis_blh = str(0) + " " + str(blh[1]).replace(".", ",") + " " + str(
blh[0]).replace(".", ",") + " " + str(blh[2]).replace(".", ",") + "\n"
txt_kruh_xyz.write(zapis_xyz)
txt_kruh_xyz.write(zapis_blh)
LH = []
LD = []
PH = []
PD = []
while i <= r:
yy = m.sqrt((r * r) - (i * i))
ykLH = y + yy
xkLH = x + i
ykPH = y + yy
xkPH = x - i
ykPD = y - yy
xkPD = x - i
ykLD = y - yy
xkLD = x + i
blhLH = modul2.fXYZ_to_LatLonH(xkLH, ykLH, z)
blhLD = modul2.fXYZ_to_LatLonH(xkLD, ykLD, z)
blhPH = modul2.fXYZ_to_LatLonH(xkPH, ykPH, z)
blhPD = modul2.fXYZ_to_LatLonH(xkPD, ykPD, z)
zaznamLH = [idLH, xkLH, ykLH]
zaznamLD = [idLD, xkLD, ykLD]
zaznamPH = [idPH, xkPH, ykPH]
zaznamPD = [idPD, xkPD, ykPD]
LH.append(zaznamLH)
LD.append(zaznamLD)
PH.append(zaznamPH)
PD.append(zaznamPD)
zapis1 = str(idLH) + " " + str(xkLH).replace(".", ",") + " " + str(ykLH).replace(".", ",") \
+ " " + str(z).replace(".", ",") + "\n"
zapis2 = str(idPH) + " " + str(xkPH).replace(".", ",") + " " + str(ykPH).replace(".", ",") \
+ " " + str(z).replace(".", ",") + "\n"
zapis3 = str(idPD) + " " + str(xkPD).replace(".", ",") + " " + str(ykPD).replace(".", ",") \
+ " " + str(z).replace(".", ",") + "\n"
zapis4 = str(idLD) + " " + str(xkLD).replace(".", ",") + " " + str(ykLD).replace(".", ",") \
+ " " + str(z).replace(".", ",") + "\n"
zapis5 = str(idLH) + " " + str(blhLH[1]).replace(".", ",") + " " + str(blhLH[0]).replace(".", ",") \
+ " " + str(blhLH[2]).replace(".", ",") + "\n"
zapis6 = str(idLD) + " " + str(blhLD[1]).replace(".", ",") + " " + str(blhLD[0]).replace(".", ",") \
+ " " + str(blhLD[2]).replace(".", ",") + "\n"
zapis7 = str(idPH) + " " + str(blhPH[1]).replace(".", ",") + " " + str(blhPH[0]).replace(".", ",") \
+ " " + str(blhPH[2]).replace(".", ",") + "\n"
zapis8 = str(idPD) + " " + str(blhPD[1]).replace(".", ",") + " " + str(blhPD[0]).replace(".", ",") \
+ " " + str(blhPD[2]).replace(".", ",") + "\n"
txt_kruh_xyz.write(zapis1)
txt_kruh_xyz.write(zapis2)
txt_kruh_xyz.write(zapis3)
txt_kruh_xyz.write(zapis4)
txt_kruh_blh.write(zapis5)
txt_kruh_blh.write(zapis6)
txt_kruh_blh.write(zapis7)
txt_kruh_blh.write(zapis8)
idLH = idLH + 1
idLD = idLD + 1
idPH = idPH + 1
idPD = idPD + 1
i = i + 0.01
txt_kruh_xyz.close()
txt_kruh_blh.close()
return LH, LD, PH, PD