Пример #1
0
                    motors.stop()
                    reels.stop()
                elif cmd_data == 'p':
                    sdata = sensors.poll(frequency=1,
                                         length=1,
                                         stream=stream_telemetry)
                    print(sdata)
                elif cmd_data == 't':
                    stream_telemetry = not stream_telemetry
                    if stream_telemetry:
                        print('Telemetry broadcast: ON')
                    else:
                        print('Telemetry broadcast: OFF')
    except (OSError, serial.SerialException):
        print('Serial connection error. Trying to reconnect...')
        connection.reconnect()
    except Exception as err:
        print("An error has ocurred")
        print(err)

    sys.stdout.flush()  # for service to print logs

terminate()

vst.keeprunning = False
vst.interrupt()
sur.keeprunning = False

# When everything done, release the capture
sock.close()