2020-11-10 23:45:50 -04:00
|
|
|
#! /usr/bin/env python3
|
2019-06-15 13:03:37 -03:00
|
|
|
|
|
|
|
import serial, time
|
|
|
|
import subprocess
|
|
|
|
from subprocess import call, Popen
|
|
|
|
from argparse import ArgumentParser
|
|
|
|
import re
|
2020-11-10 23:45:50 -04:00
|
|
|
import sys
|
2019-06-15 13:03:37 -03:00
|
|
|
|
|
|
|
def do_nsh_cmd(port, baudrate, cmd):
|
|
|
|
databits = serial.EIGHTBITS
|
|
|
|
stopbits = serial.STOPBITS_ONE
|
|
|
|
parity = serial.PARITY_NONE
|
2020-11-10 23:45:50 -04:00
|
|
|
ser = serial.Serial(port, baudrate, databits, parity, stopbits, timeout=0.1)
|
2019-06-15 13:03:37 -03:00
|
|
|
|
2020-11-10 23:45:50 -04:00
|
|
|
# run command
|
2019-06-15 13:03:37 -03:00
|
|
|
timeout_start = time.time()
|
2020-11-10 23:45:50 -04:00
|
|
|
timeout = 10 # 10 seconds
|
|
|
|
|
|
|
|
success_cmd = "cmd succeeded!"
|
2019-06-15 13:03:37 -03:00
|
|
|
|
2020-09-28 17:41:28 -03:00
|
|
|
while True:
|
2020-11-10 23:45:50 -04:00
|
|
|
serial_cmd = '{0}; echo "{1}"\n'.format(cmd, success_cmd)
|
|
|
|
ser.write(serial_cmd.encode("utf-8"))
|
|
|
|
ser.flush()
|
2019-06-15 13:03:37 -03:00
|
|
|
|
2020-11-10 23:45:50 -04:00
|
|
|
serial_line = ser.readline().decode("utf-8", errors='ignore')
|
|
|
|
|
|
|
|
if cmd in serial_line:
|
2020-09-28 17:41:28 -03:00
|
|
|
break
|
2020-11-10 23:45:50 -04:00
|
|
|
else:
|
|
|
|
print(serial_line.replace('\n', ''))
|
2019-06-15 13:03:37 -03:00
|
|
|
|
|
|
|
if time.time() > timeout_start + timeout:
|
|
|
|
print("Error, timeout")
|
2020-11-10 23:45:50 -04:00
|
|
|
sys.exit(-1)
|
2019-06-15 13:03:37 -03:00
|
|
|
break
|
|
|
|
|
2020-11-10 23:45:50 -04:00
|
|
|
time.sleep(1)
|
2020-09-28 17:41:28 -03:00
|
|
|
|
|
|
|
|
2019-06-15 13:03:37 -03:00
|
|
|
timeout_start = time.time()
|
2020-11-10 23:45:50 -04:00
|
|
|
timeout = 30 # 30 seconds
|
2019-06-15 13:03:37 -03:00
|
|
|
|
2020-09-28 17:41:28 -03:00
|
|
|
while True:
|
2020-11-10 23:45:50 -04:00
|
|
|
serial_line = ser.readline().decode("utf-8", errors='ignore')
|
2019-06-15 13:03:37 -03:00
|
|
|
|
2020-11-10 23:45:50 -04:00
|
|
|
if success_cmd in serial_line:
|
2019-06-15 13:03:37 -03:00
|
|
|
break
|
2020-11-10 23:45:50 -04:00
|
|
|
else:
|
|
|
|
if len(serial_line) > 0:
|
|
|
|
print(serial_line.replace('\n', ''))
|
|
|
|
|
|
|
|
if "nsh>" in serial_line:
|
|
|
|
sys.exit(-1) # error, command didn't complete successfully
|
|
|
|
elif "NuttShell (NSH)" in serial_line:
|
|
|
|
sys.exit(-1) # error, command didn't complete successfully
|
|
|
|
|
|
|
|
if len(serial_line) <= 0:
|
|
|
|
ser.write("\n".encode("utf-8"))
|
|
|
|
ser.flush()
|
2019-06-15 13:03:37 -03:00
|
|
|
|
|
|
|
if time.time() > timeout_start + timeout:
|
|
|
|
print("Error, timeout")
|
2020-11-10 23:45:50 -04:00
|
|
|
sys.exit(-1)
|
2019-06-15 13:03:37 -03:00
|
|
|
|
|
|
|
ser.close()
|
|
|
|
|
|
|
|
def main():
|
|
|
|
parser = ArgumentParser(description=__doc__)
|
2020-11-10 23:45:50 -04:00
|
|
|
parser.add_argument('--device', "-d", nargs='?', default=None, help='', required=True)
|
2019-06-15 13:03:37 -03:00
|
|
|
parser.add_argument("--baudrate", "-b", dest="baudrate", type=int, help="Mavlink port baud rate (default=57600)", default=57600)
|
|
|
|
parser.add_argument("--cmd", "-c", dest="cmd", help="Command to run")
|
|
|
|
args = parser.parse_args()
|
|
|
|
|
|
|
|
do_nsh_cmd(args.device, args.baudrate, args.cmd)
|
|
|
|
|
|
|
|
if __name__ == "__main__":
|
|
|
|
main()
|