|
|
###########################################################################
|
|
|
############################### 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)
|
|
|
|
