3h˱diD79)ۏ%<Æ8^L:>|YF[kTcW}w_b.F3t]K}ݏfz4g`vWٗ;I7אp5 i(%IKg=goEvKEWHmyѶ`= thݫMtJU&H'wQt!/w,S-3dYIl6B5Ns A34~GbBHjQfLd@L iFSO }1ZE1 JtF]1_Ls@ ;- ;aąTֽzޕEJB)pb* : Ȫ+״t|/c~XeTR Dp@ urN96@)ݛcG˞`վ0$q]u߱:ZIt0Zwŷbo/U fi'dxEe6?XW~4'ńL|+m>'~R@YiY:K[5W3Mn??8c7t1H$!09ݥt?c^A>t3sJ5/ %{ibI~"֙PDwK }X:9Rᤪj\*Zǿ*ҙtR}|eƷcXQfS8-75|t[wQoOn k!¼@J޽[g1vE ÎbZA_RE -ZŽd=GךIj7ٲƲ@^1zxHuT|ARΖđ-.Ug2.'k- 3?h>6Ma *:͡fz)b%ph<>lJn-,AMFSU,);O  5yUl̢*?↵RwT繐TGI(9h{t~I[@$KO,;*K a }{2ͳ`u~>HpY>hJF˧{}VC*XƲ1!|+|[sZ2hB]`p<=ig0%_k*VkOO7–g`;Pt8}u7*ٹiBSHbY:J tc?H5OJ tc?H5Or+XF V_FI4(|!辮X8De ÆͪI$YJm2{7cBW+*(f2 IS Mem9 #}ӻ[ ~xe+:*`a<[ ~T^zzHJu:ɆGUEK#MumWv =; >vEf##X39jᗈ35E@'嵻G13=|>:0R_̒}p=D LMl5,^,be\uK%<x'vYF[Fhb>7umd]\OeC.VsXn}R-1||߂e>8o+oeV- 2`HIlqW9G} T5ɬIRe`y.Vx?aWH 7簑9Lo c^o7v:LCTbtZx_ĦȮ¿bۨ9q`'Ab- 1:ud:;jkZǔ<uYNșa~/ֱoI8,PH"1H&:k: E1[sjdaMTWy dObz N*8ܖg@zL3̷ jH!=`pSv׹.XK+OgNt'/0P"GQt$eOťT֗Q r|&Id"Yh\TW*Df-=EB:dCiʨ6Lj.X$ykm*N uQܡF-qxj\+Ԓoe+{*xPgCH~ ˊEf̣mf؝R"1_4%!5,51X`'YjxJ]ՋBnP"YQ#n{„7YS-oq\dTC4w (2-ozUbКM'[I(t~ a5'%VɧnQ;L|맚]8Y ܕ TxK~ hXuM~,9d뱪!!j&%p>Bs8 Hr :@HQSs.tT$`^IF.Z}±e2We%2Vވ{cs.$j3Jܗ!J tc?H5OV Ԭ2 _˃2>~Jz|Ab3 Zd ghP6uHZF)W/1It"Ƽ!XC 7&[vYLo, MBc5L]\ezQ"/Wਛv@@.q+bjӗi._ ͵Ff۴u*J0+n,5J%ym ;UItV*Â"=]XOGrkّ9AGxnPh-z[ IH|c7Rm?5:Fkz {resp_type}, {resp_length} | {resp_meta}') if resp_length > 0: resp = b'' while len(resp) < resp_length: chunk = sock.recv(resp_length - len(resp)) if not chunk: raise ConnectionError("Connection closed") resp += chunk # print(f' {len(resp)} ') return (resp_time, resp_length, resp) except (socket.error, BrokenPipeError): print('!!! socket error') def fetch_data(): global val_cnt global measure_data_lock global vals global vals_raw global vals_times global tilts global ffts global freqs global fft_ffts global fft_ffts_freqs qc = 0 socket_perform_request(b'clear_data') while True: (resp_time, resp_length, acc_gyr_raw) = socket_perform_request(b'query_data') # print(f'{len(acc_gyr_raw)}') tilt = {} tilt_xs = [] tilt_ys = [] measure_data_lock.acquire() for i in range(0, len(acc_gyr_raw), MPU6050_FIFO_BYTES_PER_PACKAGE): v = list(struct.unpack(">hhhhhh", bytearray(acc_gyr_raw[i : i + MPU6050_FIFO_BYTES_PER_PACKAGE]))) vals_acc = (np.array(v[:3]) / MPU6050_ACC_SCALING).tolist() vals_gyr = (np.array(v[3:]) / MPU6050_GYRO_SCALING).tolist() tilt_x = np.rad2deg(np.arctan2(v[2], v[1]) + np.pi / 2) - TILT_X_AVG tilt_y = np.rad2deg(np.arctan2(v[2], v[0]) + np.pi / 2) - TILT_Y_AVG # print(f'{tilt_x:.2f}, {tilt_y:.2f}') tilt_xs.append(tilt_x) tilt_ys.append(tilt_y) v.append(tilt_x) v.append(tilt_y) vals_raw.append(v) # vals_all = vals_acc + vals_gyr vals_all = vals_acc + vals_gyr + [tilt_x] + [tilt_y] vals.append(vals_all) # vals.append((np.array(v) / MPU6050_ACC_SCALING).tolist()) # print(vals[-1:]) # print(type(vals[-1:])) vals_times.append(resp_time) measure_data_lock.release() # print(len(vals)) # if qc > 100: # tilt_x_avg = np.average(np.array(tilt_xs)) # tilt_y_avg = np.average(np.array(tilt_ys)) # print(f'{tilt_x_avg:.2f}, {tilt_y_avg:.2f}') tilt['x'] = np.average(np.array(tilt_xs)) tilt['y'] = np.average(np.array(tilt_ys)) tilts.append(tilt) # if vals.length > FFT_VAL_CNT: # if qc > FFT_VAL_CNT: if len(vals) > FFT_VAL_CNT: t0 = time.perf_counter() ffts_loc = [] freqs_loc = [] fft_ffts_loc = [] fft_ffts_freqs_loc = [] fft_vals = vals[-FFT_VAL_CNT:] for i in range(MPU6050_FIFO_VALUES_PER_PACKAGE + 2): fft_vals_single = [r[i] for r in fft_vals] # fft_vals = vals[-FFT_VAL_CNT][:, i] #fft = np.abs(np.fft.fft(fft_vals_single)[:FFT_VAL_CNT // 2]).tolist()[1:100] #freq = np.fft.fftfreq(FFT_VAL_CNT, 1 / MEAS_SAMPLE_RATE)[:FFT_VAL_CNT // 2].tolist()[1:100] fft = np.abs(np.fft.fft(fft_vals_single)[:FFT_VAL_CNT // 2]).tolist()[1:500] freq = np.fft.fftfreq(FFT_VAL_CNT, 1 / MEAS_SAMPLE_RATE)[:FFT_VAL_CNT // 2].tolist()[1:500] ffts_loc.append(fft) freqs_loc.append(freq) fft_fft = np.abs(np.fft.fft(fft)[:len(fft) // 2]).tolist()[1:] fft_fft_freq = np.fft.fftfreq(len(fft), 1)[:len(fft) // 2].tolist()[1:] fft_ffts_loc.append(fft_fft) fft_ffts_freqs_loc.append(fft_fft_freq) # positive_fft = np.abs(fft_result[:len(fft_result)//2]) # positive_freqs = frequencies[:len(frequencies)//2] ffts.append(ffts_loc) freqs.append(freqs_loc) fft_ffts.append(fft_ffts_loc) fft_ffts_freqs.append(fft_ffts_freqs_loc) t1 = time.perf_counter() d = t1 - t0 # print(d) qc += 1 if len(vals) > 10000: del vals[:9000] time.sleep(FETCH_DATA_INTERVAL) ## --- main ---------------------------------------------------------------- val_cnt = 0 # --- python deque (> RingBuffer) --- # vals = RingBuffer() # vals_raw = RingBuffer() # vals_times = RingBuffer() # tilts = RingBuffer() # ffts = RingBuffer() # freqs = RingBuffer() # fft_ffts= RingBuffer() # fft_ffts_freqs = RingBuffer() # --- python list --- vals = [] vals_raw = [] vals_times = [] tilts = [] ffts = [] freqs = [] fft_ffts= [] fft_ffts_freqs = [] measure_state = threading.Event() measure_data_lock = threading.Lock() data_fetcher_thread = threading.Thread(target=fetch_data) data_fetcher_thread.start() asyncio.run(run_server())