| @@ -0,0 +1,48 | |||||
|
|
1 | ########################################################################### | |||
|
|
2 | ############################### SERVIDOR################################### | |||
|
|
3 | ######################### SIMULADOR DE PEDESTAL############################ | |||
|
|
4 | ########################################################################### | |||
|
|
5 | import time | |||
|
|
6 | import math | |||
|
|
7 | import numpy | |||
|
|
8 | import struct | |||
|
|
9 | from time import sleep | |||
|
|
10 | import zmq | |||
|
|
11 | import pickle | |||
|
|
12 | port="5556" | |||
|
|
13 | context = zmq.Context() | |||
|
|
14 | socket = context.socket(zmq.PUB) | |||
|
|
15 | socket.bind("tcp://*:%s"%port) | |||
|
|
16 | ###### PARAMETROS DE ENTRADA################################ | |||
|
|
17 | print("PEDESTAL RESOLUCION 0.01") | |||
|
|
18 | print("MAXIMA VELOCIDAD DEL PEDESTAL") | |||
|
|
19 | ang_elev = 4.12 | |||
|
|
20 | ang_azi = 30 | |||
|
|
21 | velocidad= input ("Ingresa velocidad:") | |||
|
|
22 | velocidad= float(velocidad) | |||
|
|
23 | print (velocidad) | |||
|
|
24 | ############################################################ | |||
|
|
25 | sleep(3) | |||
|
|
26 | print("Start program") | |||
|
|
27 | t1 = time.time() | |||
|
|
28 | count=0 | |||
|
|
29 | while(True): | |||
|
|
30 | tmp_vuelta = int(360/velocidad) | |||
|
|
31 | t1=t1+tmp_vuelta*count | |||
|
|
32 | count= count+1 | |||
|
|
33 | muestras_seg = 100 | |||
|
|
34 | t2 = time.time() | |||
|
|
35 | for i in range(tmp_vuelta): | |||
|
|
36 | for j in range(muestras_seg): | |||
|
|
37 | tmp_variable = (i+j/100.0) | |||
|
|
38 | ang_azi = (tmp_variable)*float(velocidad) | |||
|
|
39 | seconds = t1+ tmp_variable | |||
|
|
40 | topic=10001 | |||
|
|
41 | print ("Azim°: ","%.4f"%ang_azi,"Time:" ,"%.5f"%seconds) | |||
|
|
42 | seconds_dec=(seconds-int(seconds))*1e6 | |||
|
|
43 | ang_azi_dec= (ang_azi-int(ang_azi))*1e3 | |||
|
|
44 | ang_elev_dec=(ang_elev-int(ang_elev))*1e3 | |||
|
|
45 | sleep(0.0088) | |||
|
|
46 | socket.send_string("%d %d %d %d %d %d %d"%(topic,ang_elev,ang_elev_dec,ang_azi,ang_azi_dec,seconds,seconds_dec)) | |||
|
|
47 | t3 = time.time() | |||
|
|
48 | print ("Total time for 1 vuelta in Seconds",t3-t2) | |||
General Comments 0
You need to be logged in to leave comments.
Login now