-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathServer.py
More file actions
183 lines (141 loc) · 6.46 KB
/
Copy pathServer.py
File metadata and controls
183 lines (141 loc) · 6.46 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
import socket
import select
from mpl_toolkits import mplot3d
import numpy as np
import matplotlib.pyplot as plt
from mpl_toolkits.mplot3d import Axes3D
from matplotlib import animation as animation
HEADER_LENGTH = 10
IP = "0.0.0.0"
PORT = 1234
x_arr, y_arr, z_arr = [], [], []
x_gry, y_gry, z_gry = [], [], []
# Create a socket
server_socket = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
# Sets REUSEADDR (as a socket option) to 1 on socket
server_socket.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
server_socket.bind((IP, PORT))
# This makes server listen to new connections
server_socket.listen()
# List of sockets for select.select()
sockets_list = [server_socket]
# List of connected clients - socket as a key, user header and name as data
clients = {}
print(f'Listening for connections on {IP}:{PORT}...')
# Handles message receiving
def receive_message(client_socket):
try:
# Receive our "header" containing message length, it's size is defined and constant
message_header = client_socket.recv(HEADER_LENGTH)
# If we received no data, client gracefully closed a connection, for example using socket.close() or socket.shutdown(socket.SHUT_RDWR)
if not len(message_header):
return False
# Convert header to int value
message_length = int(message_header.decode('utf-8').strip())
# Return an object of message header and message data
return {'header': message_header, 'data': client_socket.recv(message_length)}
except:
return False
fig = plt.figure()
while True:
read_sockets, _, exception_sockets = select.select(sockets_list, [], sockets_list)
# Iterate over notified sockets
for notified_socket in read_sockets:
# If notified socket is a server socket - new connection, accept it
if notified_socket == server_socket:
# Accept new connection
client_socket, client_address = server_socket.accept()
# Client should send his name right away, receive it
user = receive_message(client_socket)
# If False - client disconnected before he sent his name
if user is False:
continue
# Add accepted socket to select.select() list
sockets_list.append(client_socket)
# Also save username and username header
clients[client_socket] = user
print('Accepted new connection from {}:{}, username: {}'.format(*client_address, user['data'].decode('utf-8')))
# Else existing socket is sending a message
else:
# Receive message
message = receive_message(notified_socket)
# If False, client disconnected, cleanup
if message is False:
print('Closed connection from: {}'.format(clients[notified_socket]['data'].decode('utf-8')))
plt.close('all')
# Remove from list for socket.socket()
sockets_list.remove(notified_socket)
# Remove from our list of users
del clients[notified_socket]
continue
# Get user by notified socket, so we will know who sent the message
user = clients[notified_socket]
print(f'Received message from {user["data"].decode("utf-8")}: {message["data"].decode("utf-8")}')
x=message["data"].decode("utf-8")
split=x.split(",")
time_between_samples = 0.333
try:
x, y, z= float(split[0]), float(split[1]), float(split[2])
except:
continue
if len(x_arr) > 20:
x_arr.pop(0)
x_arr.append(x)
if len(y_arr) > 20:
y_arr.pop(0)
y_arr.append(y)
if len(z_arr) > 20:
z_arr.pop(0)
z_arr.append(z)
'''
if len(x_gry) > 20:
x_gry.pop(0)
x_gry.append(x_g)
if len(y_gry) > 20:
y_gry.pop(0)
y_gry.append(y_g)
if len(z_gry) > 20:
z_gry.pop(0)
z_gry.append(z_g)'''
v_lx = [sum(x_arr[:i]) * time_between_samples for i in range(len(x_arr))]
#d_lx = [sum(v_lx[:j]) * time_between_samples for j in range(len(v_lx))]
v_ly = [sum(y_arr[:i]) * time_between_samples for i in range(len(y_arr))]
#d_ly = [sum(v_ly[:j]) * time_between_samples for j in range(len(v_ly))]
v_lz = [sum(z_arr[:i]) * time_between_samples for i in range(len(z_arr))]
#d_lz = [sum(v_lz[:j]) * time_between_samples for j in range(len(v_lz))]
i = list(range(len(x_arr)))
ax = plt.axes(projection='3d')
ax.set_xlim3d(-10,10)
ax.set_ylim3d(-10,10)
ax.set_zlim3d(-10,10)
ax.plot(v_lx,v_ly, v_lz, '-g')
plt.pause(0.0001)
'''
plt.clf()
plt.subplot(4, 1, 1)
plt.plot(i, d_lx, '-g')
plt.title('X,Y,Z Acceleration Subplots')
plt.ylabel('X velocity')
plt.subplot(4, 1, 2)
plt.plot(i, y_arr, '-k')
plt.xlabel('time (s)')
plt.ylabel('Y acceleration')
plt.subplot(4, 1, 3)
plt.plot(i, z_arr, '-b')
plt.xlabel('time (s)')
plt.ylabel('Z acceleration')
plt.pause(.2)
'''
# Iterate over connected clients and broadcast message
for client_socket in clients:
# But don't sent it to sender
if client_socket != notified_socket:
# Send user and message (both with their headers)
# We are reusing here message header sent by sender, and saved username header send by user when he connected
client_socket.send(user['header'] + user['data'] + message['header'] + message['data'])
# It's not really necessary to have this, but will handle some socket exceptions just in case
for notified_socket in exception_sockets:
# Remove from list for socket.socket()
sockets_list.remove(notified_socket)
# Remove from our list of users
del clients[notified_socket]