|
|
###########################################################################
|
|
|
############################### SERVIDOR###################################
|
|
|
######################### SIMULADOR DE PEDESTAL############################
|
|
|
###########################################################################
|
|
|
import time
|
|
|
import math
|
|
|
import numpy
|
|
|
import struct
|
|
|
from time import sleep
|
|
|
import zmq
|
|
|
import pickle
|
|
|
port="5556"
|
|
|
context = zmq.Context()
|
|
|
socket = context.socket(zmq.PUB)
|
|
|
socket.bind("tcp://*:%s"%port)
|
|
|
###### PARAMETROS DE ENTRADA################################
|
|
|
print("PEDESTAL RESOLUCION 0.01")
|
|
|
print("MAXIMA VELOCIDAD DEL PEDESTAL")
|
|
|
ang_elev = 4.12
|
|
|
ang_azi = 30
|
|
|
velocidad= input ("Ingresa velocidad:")
|
|
|
velocidad= float(velocidad)
|
|
|
print (velocidad)
|
|
|
############################################################
|
|
|
sleep(3)
|
|
|
print("Start program")
|
|
|
t1 = time.time()
|
|
|
count=0
|
|
|
while(True):
|
|
|
tmp_vuelta = int(360/velocidad)
|
|
|
t1=t1+tmp_vuelta*count
|
|
|
count= count+1
|
|
|
muestras_seg = 100
|
|
|
t2 = time.time()
|
|
|
for i in range(tmp_vuelta):
|
|
|
for j in range(muestras_seg):
|
|
|
tmp_variable = (i+j/100.0)
|
|
|
ang_azi = (tmp_variable)*float(velocidad)
|
|
|
seconds = t1+ tmp_variable
|
|
|
topic=10001
|
|
|
print ("Azim°: ","%.4f"%ang_azi,"Time:" ,"%.5f"%seconds)
|
|
|
seconds_dec=(seconds-int(seconds))*1e6
|
|
|
ang_azi_dec= (ang_azi-int(ang_azi))*1e3
|
|
|
ang_elev_dec=(ang_elev-int(ang_elev))*1e3
|
|
|
sleep(0.0088)
|
|
|
socket.send_string("%d %d %d %d %d %d %d"%(topic,ang_elev,ang_elev_dec,ang_azi,ang_azi_dec,seconds,seconds_dec))
|
|
|
t3 = time.time()
|
|
|
print ("Total time for 1 vuelta in Seconds",t3-t2)
|
|
|
|
