From 9da84ee22a02ad92ad8210454f1ce8cbba7ca1b5 Mon Sep 17 00:00:00 2001
From: Dominic DiPuma <DDiPuma@users.noreply.github.com>
Date: Fri, 28 Jul 2017 14:46:29 -0400
Subject: [PATCH 1/2] Create plotter_main.py

Obviously subject to change depending on what decisions we make next week regarding communication, but it's nearly done at this point.
---
 plotter_main.py | 64 +++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 64 insertions(+)
 create mode 100644 plotter_main.py

diff --git a/plotter_main.py b/plotter_main.py
new file mode 100644
index 0000000..99d0ea6
--- /dev/null
+++ b/plotter_main.py
@@ -0,0 +1,64 @@
+import matplotlib.pyplot as plt
+import math
+import socket
+
+# Initialize plotting coordinate lists
+xPositions = [0]
+yPositions = [0]
+xWall = []
+yWall = []
+
+def main():
+    # Initialize sockets
+    HOST = ''
+    PORT = 50000
+    receiver = socket.socket()
+    receiver.connect((HOST, PORT))
+
+    # TODO - change the socket scheme to one that is Bluetooth compatible
+
+    while True:
+        msg = receiver.recv(1024)
+
+        msgString = msg.decode('ascii')
+        if msgString == "Done":
+            receiver.close()
+            break
+        else:
+            data = msgString.split(',')
+            distance = float(data[0])
+            bearing = float(data[1])
+            sonarTime = float(data[2])
+
+            addPoint(distance, bearing, sonarTime)
+
+    # Display the output
+    plt.plot(xPositions, yPositions, 'b-', xWall, yWall, 'r-')
+    plt.show()
+    # Spruce this up with titles and labels and legends and such
+
+# Expect distance in inches, bearing in radians, and sonar time in microseconds
+def addPoint(distanceTraveled, bearing, sonarResponseTime):
+    # The most recent data point is used to project new points
+    mostRecentX = xPositions[-1]
+    mostRecentY = yPositions[-1]
+
+    # New robot position is found via trig
+    newX = mostRecentX + distanceTraveled * math.cos(bearing)
+    newY = mostRecentY + distanceTraveled * math.sin(bearing)
+
+    xPositions.append(newX)
+    yPositions.append(newY)
+
+    # Speed of sound is in inches per microsecond
+    wallDistance = (sonarResponseTime / 2) * 979 * 12 / 1000000
+    # We assume that the sonar is pointed directly to the right of the robot
+    wallAngle = bearing - math.pi / 2
+    newWallX = newX + wallDistance * math.cos(wallAngle)
+    newWallY = newY + wallDistance * math.sin(wallAngle)
+
+    xWall.append(newWallX)
+    yWall.append(newWallY)
+
+if __name__ == "__main__":
+    main()

From 3811cca052bdbe83fd8ac2c802aee4c36738e4c4 Mon Sep 17 00:00:00 2001
From: Dominic DiPuma <DDiPuma@users.noreply.github.com>
Date: Fri, 28 Jul 2017 14:52:12 -0400
Subject: [PATCH 2/2] Update plotter_main.py

---
 plotter_main.py | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/plotter_main.py b/plotter_main.py
index 99d0ea6..88909e9 100644
--- a/plotter_main.py
+++ b/plotter_main.py
@@ -34,8 +34,10 @@ def main():
 
     # Display the output
     plt.plot(xPositions, yPositions, 'b-', xWall, yWall, 'r-')
+    plt.title("DynaMITE Track and Canyon Plot")
+    plt.grid(True)
+    plt.legend(['Track Trace', 'Canyon Wall'])
     plt.show()
-    # Spruce this up with titles and labels and legends and such
 
 # Expect distance in inches, bearing in radians, and sonar time in microseconds
 def addPoint(distanceTraveled, bearing, sonarResponseTime):