1 files changed, 53 insertions, 0 deletions
diff --git a/pyBTlatency/pyBTlatency.py b/pyBTlatency/pyBTlatency.py
new file mode 100755
index 0000000..c80a77b
--- /dev/null
+++ b/pyBTlatency/pyBTlatency.py
@@ -0,0 +1,53 @@
+#!/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)
+                
+
+                
+\ No newline at end of file