Working demo for plotting a live graph of data recieved over a serial connection!

Christopher Stone
1 parent caf04a11
Showing 3 changed files with 59 additions and 10 deletions Show diff stats
telemetry/code/monitor/pyglet_test.py -> telemetry/code/monitor/graph_plotter.py
telemetry/code/robot/analogread_demo/analogread_demo.ino
telemetry/code/robot/fading_led_demo/fading_led_demo.ino
+#!/usr/bin/env python
+
 import pyglet
 import math
 import random
 import time
+import serial
+
+datafeed = serial.Serial(
+ port='/dev/ttyUSB0',
+ baudrate = 9600,
+ parity=serial.PARITY_NONE,
+ stopbits=serial.STOPBITS_ONE,
+ bytesize=serial.EIGHTBITS,
+ timeout=1
+)
  
 window = pyglet.window.Window()
 window.set_caption("Test graph")
@@ -36,9 +48,15 @@ def plotline(xdata, ydata):
     pyglet.gl.glColor4f(1, 0, 0, 1.0)
     points = []
     for n in range(max(len(xdata), len(ydata))):
-        xpos = ((xdata[n]-min(xdata))*window.width)/(max(xdata)-min(xdata))
+        try:
+            xpos = ((xdata[n]-min(xdata))*window.width)/(max(xdata)-min(xdata))
+        except:
+            xpos = 0
         xpos = int(xpos)
-        ypos = ((ydata[n]-min(ydata))*window.height)/(max(ydata)-min(ydata))
+        try:
+            ypos = ((ydata[n]-min(ydata))*window.height)/(max(ydata)-min(ydata))
+        except:
+            ypos = 0
         ypos = int(ypos)
         points.append([xpos, ypos])
     for n in range(len(points)-1):            
@@ -52,14 +70,23 @@ ydata = [0]
 @window.event
 def on_draw():
     window.clear()
-    ydata.append(random.uniform(0, 10))
-    if len(ydata) > 100:
-        del ydata[0]
-    xdata.append(round(time.time() - starttime, 3))
-    if len(xdata) > 100:
-        del xdata[0]
+    #ydata.append(random.uniform(0, 10))
+    value = datafeed.readline()
+    try:
+        value = float(value)
+        ydata.append(value)
+        print("Value: " + str(ydata[-1]))
+
+        if len(ydata) > 250:
+            del ydata[0]
+        xdata.append(round(time.time() - starttime, 3))
+        if len(xdata) > 250:
+            del xdata[0]
+    except:
+        pass
     drawgrid(10, 12, [min(xdata), max(xdata)], [min(ydata), max(ydata)])
     plotline(xdata, ydata)
  
+
  
 pyglet.app.run()
 \ No newline at end of file
@@ -0,0 +1,20 @@
+/*
+ * Read analogue data, send it on
+ * 
+ * A starting point for a robot monitoring system
+ * By the UoN Robot Wars project, 2018
+ * This code is under the GPL
+ */
+
+#include <math.h>
+ 
+void setup() {
+  Serial.begin(9600);
+  Serial.println("Hello, World");
+  pinMode(13, OUTPUT);
+}
+
+void loop() {
+  float avalue = analogRead(A0);
+  Serial.println(avalue);
+}
@@ -16,12 +16,14 @@ void setup() {
  
 void loop() {
   // PWM an LED, fading sinusoidally
-  double major_frequency = 0.3;
-  double minor_frequency = 100;
+  double major_frequency = 0.5;
+  double minor_frequency = 50;
   double duty = 0.5+(0.5*sin(2*PI*major_frequency*millis()/1000));
   Serial.println(duty);
   digitalWrite(13, HIGH);
   delay(1000 * duty/minor_frequency);
   digitalWrite(13, LOW);
   delay(1000 * (1-duty)/minor_frequency);
+  float avalue = analogRead(A0);
+  //Serial.println(avalue);
 }