serjial.py

import math
import serial
import struct
from datetime import datetime
import time


def main():
    with open("logfile", "a+") as log:
        with open("beshrukt.uk2", "wb+") as smolOut:
            try:
                ser = serial.Serial("/dev/ttyUSB1", 19200)
            except:
                ser = serial.Serial("/dev/ttyUSB0", 19200)

            print(ser.name)

            print("\033[2J")
            accelMin = 10
            accelMax = 0

            correct_len = 170

            while 1:
                count_plus = 0

                time.sleep(0.1)
                print("\033[2H")

                while 1:
                    byte = ser.read(1)
                    # print(byte)
                    if byte == b"+":
                        count_plus += 1
                    else:
                        count_plus = 0
                    if count_plus == 3:
                        print("[PACKET]", end="")
                        break

                input_data = ser.read(correct_len)
                # input_data = ser.read(177)
                # input_data = open("example.dat", "rb").read()

                if (input_data[169] != 45) or (input_data[168] != 45):
                    print("[FAIL]", input_data[169], input_data[168], len(input_data))
                    continue

                # if ((end := input_data.find(b'--')) - (start := input_data.find(b'+++')) + 2 != correct_len):
                #     print(len(input_data))
                #     print(input_data)
                #     continue

                input_data = input_data[:-2]
                print("", flush=True)

                rezultat = list(struct.unpack("=9f1l", input_data[:-128]))
                rezultat[3] -= 0.22
                accelSqrt = math.sqrt(rezultat[3]*rezultat[3] + rezultat[4]*rezultat[4] + rezultat[5]*rezultat[5])


                print("\x1b[5;10f", end="")

                print("TEMPERATURE:")
                print("\x1b[6;12fT: %3.3f *C  " % (rezultat[0]), end="")

                print("\x1b[8;10f", end="")

                print("HUMIDITY:")
                print("\x1b[9;12fH: %3.3f %%  " % (rezultat[1]), end="")

                print("\x1b[11;10f", end="")

                print("PRESSURE:")
                print("\x1b[12;12fP: %4.3f hPa  " % (rezultat[2]), end="")

                print("\x1b[14;10f", end="")

                print("ACCELERATION: %3.3f G" % (accelSqrt))
                print("\x1b[15;12fX: %3.3f G  " % (rezultat[3]), end="")
                print("\x1b[16;12fY: %3.3f G  " % (rezultat[4]), end="")
                print("\x1b[17;12fZ: %3.3f G  " % (rezultat[5]), end="")

                print("\x1b[19;10f", end="")

                print("GYROSCOPE:")
                print("\x1b[20;12fX: %3.3f  " % (rezultat[6]), end="")
                print("\x1b[21;12fY: %3.3f  " % (rezultat[7]), end="")
                print("\x1b[22;12fZ: %3.3f  " % (rezultat[8]), end="")

                log.write(repr((rezultat, datetime.now(), input_data[-132:])) + "\n")
                smolOut.write(input_data[-132:])
                smolOut.flush()

        ser.close()


if __name__ == "__main__":
    main()