-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathheatmap.py
More file actions
71 lines (61 loc) · 2.03 KB
/
Copy pathheatmap.py
File metadata and controls
71 lines (61 loc) · 2.03 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
import serial
import time
import numpy as np
import matplotlib.pyplot as plt
from matplotlib.colors import Normalize
from matplotlib.animation import FuncAnimation
import threading
#config
BAUDRATE = 115200
PORT = '/dev/cu.usbmodem1201' # depends on system\'COM3' for Windows
GRID_ROWS = 4
GRID_COLS = 4
VMIN = 1
VMAX_DEFAULT = 50
ZERO_COLOR = 0
INTERVAL = 500
def setup_serial_connection():
ser = serial.Serial(PORT, BAUDRATE, timeout=1)
time.sleep(2) #delay
return ser
#normalization by chatgpt
def zero_fixed_normalize(value, vmin=VMIN, vmax=VMAX_DEFAULT):
norm = Normalize(vmin, vmax)
normalized_values = norm(value)
normalized_values[value == 0] = ZERO_COLOR
return normalized_values
#read data to grid
def read_serial_data(grid, ser):
while True:
if ser.in_waiting > 0:
line = ser.readline().decode('utf-8').rstrip()
print(line)
try:
values = list(map(int, line.split(',')))
if len(values) == GRID_COLS + 1:
row = values[0]
grid[row] = values[1:GRID_COLS+1][::-1] #reverse for correct visualization
except ValueError:
print(f"Invalid data received: {line}")
#update heatmap
def update_heatmap(i, grid, heatmap):
vmax_value = np.max(grid[np.nonzero(grid)]) if np.any(grid) else VMAX_DEFAULT
heatmap.set_norm(Normalize(vmin=VMIN, vmax=vmax_value))
heatmap.set_array(grid)
return [heatmap]
#display
def main():
grid = np.zeros((GRID_ROWS, GRID_COLS))
ser = setup_serial_connection()
fig, ax = plt.subplots()
heatmap = ax.imshow(grid, cmap='afmhot', norm=Normalize(vmin=VMIN, vmax=VMAX_DEFAULT))
plt.colorbar(heatmap)
serial_thread = threading.Thread(target=read_serial_data, args=(grid, ser), daemon=True)
serial_thread.start()
#animation for squares
ani = FuncAnimation(fig, update_heatmap, fargs=(grid, heatmap), interval=INTERVAL)
plt.show()
ser.close()
#run visualization
if __name__ == "__main__":
main()