#!/usr/bin/python

import time
import serial
import signal
import sys, csv

readings=[]
f=open('data.csv','w')


serIn = serial.Serial(
	port='/dev/rfcomm0',
	baudrate=38400
)
serOut = serial.Serial(
	port='/dev/ttyUSB0',
	baudrate=9600
)

def signal_handler(signal, frame):
        total=0
        for i in readings:
                total+=i;
        print len(readings),"readings, average:",(total/len(readings))*1000,"ms"
        serOut.close()
        serIn.close()
        f.close()
        sys.exit(0)
        
signal.signal(signal.SIGINT, signal_handler)
tStart=time.time()
serIn.write('a')
while time.time()-tStart<2.0:
                if serIn.inWaiting() >0:
                        print serIn.read()

while 1:
        #print "testing.."
        finished = False
        serOut.write("0")
        tStart=time.time()
        while time.time()-tStart<1.0:
                if serIn.inWaiting() >0:
                        r=time.time()-tStart
                        readings.append(r)
                        i=serIn.read()
                        print i,r*1000,"ms"
                        f.write(str(len(readings))+","+str(r*1000)+"\n")
        #time.sleep(1000)