sameeas/easdecode-live.py at master · jmcmellen/sameeas · 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
import pyaudio
import wave
import sys
import math, struct, array, time, re

def analyze_wave(samples):
    delay_length = int(divmod(44100, 520.5)[0] / 2.0)
    print delay_length
    out_data = ''
    last_val = 0
    zero_counter = 0
    bit_width_ctr = 0
    bitstream = ''
    message = ''

    for i in range(0, len(samples) - delay_length, 2):
	#print samples[i + delay_length], samples[i]
	cor_val = (samples[i + delay_length] * samples[i]) / 1073676289.0
	#print cor_val

	if  cor_val > 0.03:
	    zero_counter = 0
	    out_data += struct.pack('<h', 16600)
	    if last_val == -16600:
		bit_width_ctr = 0
	    last_val = 16600

	elif cor_val < -0.03:
	    zero_counter = 0
	    out_data += struct.pack('<h', -16600)
	    if last_val == 16600:
		bit_width_ctr = 0
	    last_val = -16600

	else:
	    zero_counter += 1
	    if zero_counter > 16:
		out_data += struct.pack('<h', 0)
		bit_width_ctr = 0
	    else:
		out_data += struct.pack('h', last_val)
	if cor_val > 0.108: cor_val = 0.108
	if cor_val < -0.108: cor_val = -0.108
	out_data += struct.pack('<h', int(cor_val * 300767))
	bit_width_ctr += 1
	if bit_width_ctr == delay_length:
	    if last_val == -16600:
		bitstream += '0'
	    if last_val == 16600:
		bitstream += '1'
	if bit_width_ctr == (delay_length * 2):
	    bit_width_ctr = 0

    #print bitstream
    msg_collection = re.split(r'11010101', bitstream)
    #print thing_list
    messages = []
    for bits in msg_collection:
	if len(bits) > 7:
	    message = ''
	    for i in range(0, len(bits), 8):
		byte = bits[i:i+8]
		message += chr(int(byte[::-1], 2))
	    if message.startswith(('ZCZC', 'NNNN')):
		messages.append(message)

    print messages
    file = wave.open('correlated1.wav', 'wb')
    file.setparams( (2, 2, 44100, 44100, 'NONE', '') )
    file.writeframes(out_data)
    file.close()

def main():
    chunk = 44100 * 30
    FORMAT = pyaudio.paInt16
    CHANNELS = 2
    RATE = 44100
    WAVE_OUTPUT_FILENAME = "output.wav"

    if sys.platform == 'darwin':
	CHANNELS = 1

    p = pyaudio.PyAudio()

    stream = p.open(format = FORMAT,
                channels = CHANNELS,
                rate = RATE,
                input = True,
                frames_per_buffer = chunk)

    print "* recording"
    all = []

    while True:
	samples = array.array('h', stream.read(chunk))
	analyze_wave(samples)

    stream.stop_stream()
    stream.close()
    p.terminate()

if __name__ == "__main__":
    main()