Merge remote-tracking branch 'origin/master'

Author: lwaghorn

OnLand/PDS/spacexPacket.py

@@ -0,0 +1,34 @@
+import struct
+
+def spacex_packet(pod_data):
+    team_id = 'Paradigm'
+    podState = pod_data['podState']
+    acceleration = pod_data['podAccelerationX']
+    position = pod_data['podPosition']
+    velocity = pod_data['podVelocity']
+        
+    if podState == 0:
+        status = 1
+    elif podState == 1:
+        status = 1
+    elif podState == 2:
+        status = 1
+    elif podState == 3:
+        status = 1
+    elif podState == 4:
+        status = 2
+    elif podState == 5:
+        status = 3
+    elif podState == 6:
+        status = 4
+    elif podState == 7:
+        status = 5
+    elif podState == 8:
+        status = 1
+    elif podState == 9:
+        status = 0
+    else:
+        status = 0
+        
+    return struct.pack(">BB7iI", team_id, int(status), int(acceleration), 
+                       int(position), int(velocity), 0, 0, 0, 0, 0)

OnLand/PDS/telemetry.py

@@ -2,12 +2,14 @@
 import time
 import logging as log
 import time
-from datetime import timedelta
-
+import socket
 import socketio
+
+from datetime import timedelta
 from google.protobuf import json_format
 from google.protobuf.json_format import MessageToDict
 
+from PDS.spacexPacket import spacex_packet
 from PDS.UDP.PodUdpConnection import PodUdpConnection
 from PDS.helpers.heartbeat_timer import HeartbeatTimer
 from Paradigm_pb2 import Telemetry
@@ -18,6 +20,12 @@
 broadcast_timer = HeartbeatTimer()
 log.basicConfig(stream=sys.stdout, format='%(asctime)s %(message)s', datefmt='%m/%d/%Y %I:%M:%S %p')
 
+# SpaceX Packet connection, only to be turned on during Competition run
+SEND_SPACEX_PACKET = False
+if SEND_SPACEX_PACKET:
+    server = ('127.0.0.1', 3000)
+    sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
+
 # Create socket to connect to server
 sio = socketio.Client()
 connection_status = {'name': 'telemetry', 'status': 0}
@@ -64,6 +72,9 @@ def main():
                 sio.emit('pod_telemetry', json_pod_data)
                 pod_data = MessageToDict(pod_data)
                 log.warning("Telemetry: {}".format(pod_data))
+                if SEND_SPACEX_PACKET:
+                    packet = spacex_packet(pod_data)
+                    sock.sendto(packet, server)
         else:
             connection_status['status'] = 0
             sio.emit('connection_updates', json.dumps(connection_status))