proxy_server/protocolo.py at master · carlostaffe/proxy_server · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
import datetime

# algunas secuencias de escape
SOF = '\x7e'
ESC = '\x7d'
EOF = '\x0a'
XOR = '\x20'
#Comandos
DATA_IND ='\x03'
COMM_IND ='\x06'
STATUS_IND ='\x05'
KEEP_ALI ='\x00'
TIME_PRX ='\xaa'
#Algunas configs iniciales
#DEBUG = True
DEBUG = False
ESTADO = "waiting"
datos = ''
byte = '0'
#tabla de calibracion de motes
# http://proyectos.gridtics.frm.utn.edu.ar/projects/livres-dog/wiki/Planilla_de_direcciones
K1 = {"a" : 1.0042 , "b" : 1.0215 , "U" : 1.0184 , "V" : 1.0301,
      "G" : 1.0152 , "K" : 1.0109 , "L" : 1.0043 , "O" : 1.0160,
      "d" : 1.0084 , "f" : 1.0182 , "k" : 1.0053 , "q" : 1.0016,
      "g" : 1.0285 , "h" : 1.0051 , "i" : 1.0061 , "j" : 1.0209,
      "l" : 1.0091 , "m" : 1.0204 , "o" : 1.0178 , "p" : 1.0256,
      "r" : 1.0129 , "s" : 1.0191 , "t" : 1.0055 , "u" : 1.0245,
      "x" : 1.0098 , "H" : 1.0239 , "Y" : 1.0120 , "Z" : 1.0172}
K2 = {"a" :-0.3493 , "b" :-0.8110 , "U" : 0.0110 , "V" : 0.5783,
      "G" :-0.4679 , "K" :-0.7132 , "L" :-0.6028 , "O" :-0.1544,
      "d" :-0.8952 , "f" :-0.5356 , "k" :-0.2316 , "q" : 0.4382,
      "g" : 0.1082 , "h" :-0.6018 , "i" : 0.9133 , "j" : 0.8511,
      "l" :-0.5771 , "m" : 0.3928 , "o" :-0.3676 , "p" :-0.5513,
      "r" : 0.0670 , "s" :-0.4663 , "t" :-0.0928 , "u" :-0.3644,
      "x" : 0.2324 , "H" : 0.6421 , "Y" :-0.3274 , "Z" : 0.0523}

#http://proyectos.gridtics.frm.utn.edu.ar/projects/livres-dog/wiki/Nueva_calibraci%C3%B3n_Modelo_B2
#Temp[C]=[(2,5*CRUDO/16383-0,5)*100]*K1+K2

##################### funciones #################################
def escape (datos):
    'Busca bytes escapados en la data'
    escape = datos.find(ESC)
    while (escape  > 0 ):
        #cuando aparece 0x7D en la trama, se elimina y al caracter siguiente se le vuelve a hacer una XOR con 0x20
        datos = datos[:escape] + chr( ord(datos[escape+1]) ^ ord(XOR)) + datos[escape+2:]
        escape = datos.find(ESC,escape+1)
    return datos

def lectura_fecha(datos):
    'algoritmo de impresion de fecha'
    # reagrupo los 4 bytes
    timestamp = ord(datos[0]) * 16777216 + ord(datos[1]) * 65536 + ord(datos[2]) * 256 + ord(datos[3])
    return  (datetime.datetime.fromtimestamp(timestamp))

def calibracion(sonda,temp):
    'se calcula con la siguiente formula Temp[c] = [(2,5*CRUDO/16383-0,5)*100]*K1+K2 '
    return (((2.5 * ((ord(temp[0]) * 256) + ord (temp[1])) / 16383 - 0.5)* 100 ) * K1[sonda]) + K2[sonda]

#################################################################

def comandos (comando , datos, salida):
    'parseo de los distintos comandos'
    if comando == DATA_IND:
        if DEBUG == True:
            print "data indication"
#        print  ord(datos[1]) , ',' , # el nro de mote
        i = 0
        registro = ''
        arreglo= range(5*ord(datos[3]))
        while i < ord (datos[3]):
            registro = registro + datos[4+3*i] + ','
            temp = calibracion(datos[4+3*i], datos[5+3*i:7+3*i])
            fecha =  lectura_fecha(datos[-5:-1])
            registro = registro + fecha.strftime('%d-%m-%Y') + ','
            registro = registro + fecha.strftime('%H:%M:%S') +  ','
            registro = registro + str (temp) + '\n'
            if salida == 'g': #grafica datos de temperatura
                arreglo[0+(i*5)] = 'T' + datos[4+3*i]
                arreglo[1+(i*5)] = str(temp*1000) # expresado en Mili Celsius :-)
                arreglo[2+(i*5)] = str(temp*1000) # expresado en Mili Celsius :-)
                arreglo[3+(i*5)] = fecha
                arreglo[4+(i*5)] = 'Temperatura sonda ' + datos[4+3*i]
            i = i + 1
        if salida == 't': #datos de temperatura
            return registro[:-1]
        elif salida == 'g':
            return arreglo
        return
#           print ord(datos[-1:])	# valor de LQI

    elif comando == STATUS_IND:
        if DEBUG == True:
            print "status indicaalive"

    elif comando == KEEP_ALI:
        if DEBUG == True:
            print "keep alive"
    elif comando == TIME_PRX:
        if DEBUG == True:
            print "timestamp proxy"
    elif comando == COMM_IND:
        if DEBUG == True:
            print "command indication"
        if datos[0] == STATUS_IND :
            #print "nivel de bateria"
            registro = ''
            arreglo= range(5)
            registro = str(ord(datos[1])) + str(ord(datos[2])) + ','
            bateria = (ord(datos[3]) * 256) + ord(datos[4])  # en milivolts
            registro = registro + str(bateria) + ','
            fecha =  lectura_fecha(datos[5:])
            registro = registro + fecha.strftime('%d-%m-%Y') + ','
            registro = registro + fecha.strftime('%H:%M:%S')
            if salida == 'v': #datos de tension
                return registro
            elif salida == 'g': #grafica datos de temperatura
                arreglo[0] = 'V' + str(ord(datos[2]))
                arreglo[1] = bateria
                arreglo[2] = bateria
                arreglo[3] = fecha
                arreglo[4] = 'Tension nodo ' + str(ord(datos[2]))
                return arreglo

    return