import numpy as np
import matplotlib.pyplot as plt
import serial
import re
ser = serial.Serial("/dev/tty.usbserial",115200)
decimal = re.compile(r"-?\d+\.\d*")
cnt = 0
cnts = []
vels = []
rs = []
while True:
line = ser.readline()
print line,
velocities = re.findall(decimal,line)
if not velocities:
continue
r = float(velocities[0])
velocity = float(velocities[1])
cnts.append(cnt)
vels.append(velocity)
rs.append(r)
plt.axis([0, 200, -20, 500])
plt.plot(cnts,rs,'r')
plt.plot(cnts,vels,'b')
plt.pause(0.05)
cnt += 1
if(cnt>200):
plt.cla()
cnt = 0
cnts = []
vels = []
rs = []
ser.close()