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