Anton Babushkin
11 years ago
2 changed files with 207 additions and 133 deletions
@ -0,0 +1,207 @@
@@ -0,0 +1,207 @@
|
||||
#!/usr/bin/env python |
||||
############################################################################ |
||||
# |
||||
# Copyright (C) 2013-2014 PX4 Development Team. All rights reserved. |
||||
# |
||||
# Redistribution and use in source and binary forms, with or without |
||||
# modification, are permitted provided that the following conditions |
||||
# are met: |
||||
# |
||||
# 1. Redistributions of source code must retain the above copyright |
||||
# notice, this list of conditions and the following disclaimer. |
||||
# 2. Redistributions in binary form must reproduce the above copyright |
||||
# notice, this list of conditions and the following disclaimer in |
||||
# the documentation and/or other materials provided with the |
||||
# distribution. |
||||
# 3. Neither the name PX4 nor the names of its contributors may be |
||||
# used to endorse or promote products derived from this software |
||||
# without specific prior written permission. |
||||
# |
||||
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
||||
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
||||
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
||||
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
||||
# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
||||
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
||||
# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
||||
# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
||||
# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
||||
# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
||||
# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
||||
# POSSIBILITY OF SUCH DAMAGE. |
||||
# |
||||
############################################################################ |
||||
|
||||
"""Fetch files via nsh console |
||||
|
||||
Usage: python fetch_file.py [-l] [-f] [-d device] [-s speed] [-o out_path] path |
||||
\t-l\tList files |
||||
\t-f\tOverwrite existing files |
||||
\t-d\tSerial device |
||||
\t-s\tSerial baudrate |
||||
\t-o\tOutput path |
||||
\tpath\tPath to list/fetch, if ends with "/" then directory will be fetched recursively""" |
||||
|
||||
__author__ = "Anton Babushkin" |
||||
__version__ = "1.1" |
||||
|
||||
import serial, time, sys, os |
||||
|
||||
def _wait_for_string(ser, s, timeout): |
||||
t0 = time.time() |
||||
buf = [] |
||||
res = [] |
||||
while (True): |
||||
c = ser.read() |
||||
buf.append(c) |
||||
if len(buf) > len(s): |
||||
res.append(buf.pop(0)) |
||||
if "".join(buf) == s: |
||||
break |
||||
if timeout > 0.0 and time.time() - t0 > timeout: |
||||
raise Exception("Timeout while waiting for: " + s) |
||||
return "".join(res) |
||||
|
||||
def _exec_cmd(ser, cmd, timeout): |
||||
ser.write(cmd + "\n") |
||||
ser.flush() |
||||
_wait_for_string(ser, cmd + "\r\n", timeout) |
||||
return _wait_for_string(ser, "nsh> \x1b[K", timeout) |
||||
|
||||
def _ls_dir_raw(ser, dir, timeout): |
||||
return _exec_cmd(ser, "ls -l " + dir, timeout) |
||||
|
||||
def _ls_dir(ser, dir, timeout): |
||||
res = [] |
||||
for line in _ls_dir_raw(ser, dir, timeout).splitlines(): |
||||
if line == dir + ":": |
||||
continue |
||||
if line.startswith("nsh: ls: no such directory:"): |
||||
raise Exception("No such file: " + dir) |
||||
res.append((line[20:], int(line[11:19].strip()), line[1] == "d")) |
||||
return res |
||||
|
||||
def _get_file(ser, fn, fn_out, force, timeout): |
||||
print "Get %s:" % fn, |
||||
if not force: |
||||
# Check if file already exists with the same size |
||||
try: |
||||
os.stat(fn_out) |
||||
except: |
||||
pass |
||||
else: |
||||
print "already fetched, skip" |
||||
return |
||||
|
||||
cmd = "dumpfile " + fn |
||||
ser.write(cmd + "\n") |
||||
ser.flush() |
||||
_wait_for_string(ser, cmd + "\r\n", timeout) |
||||
res = _wait_for_string(ser, "\n", timeout) |
||||
if res.startswith("OK"): |
||||
# Got correct responce, open temp file |
||||
fn_out_part = fn_out + ".part" |
||||
fout = open(fn_out_part, "wb") |
||||
|
||||
size = int(res.split()[1]) |
||||
sys.stdout.write(" [%i bytes] " % size) |
||||
n = 0 |
||||
while (n < size): |
||||
buf = ser.read(min(size - n, 8192)) |
||||
n += len(buf) |
||||
sys.stdout.write(".") |
||||
sys.stdout.flush() |
||||
fout.write(buf) |
||||
print " done" |
||||
fout.close() |
||||
os.rename(fn_out_part, fn_out) |
||||
else: |
||||
raise Exception("Error reading file") |
||||
_wait_for_string(ser, "nsh> \x1b[K", timeout) |
||||
|
||||
def _get_files_in_dir(ser, path, path_out, force, timeout): |
||||
try: |
||||
os.mkdir(path_out) |
||||
except: |
||||
pass |
||||
for fn in _ls_dir(ser, path, timeout): |
||||
path_fn = os.path.join(path, fn[0]) |
||||
path_fn_out = os.path.join(path_out, fn[0]) |
||||
if fn[2]: |
||||
_get_files_in_dir(ser, path_fn[:-1], path_fn_out[:-1], force, timeout) |
||||
else: |
||||
_get_file(ser, path_fn, path_fn_out, force, timeout) |
||||
|
||||
def _usage(): |
||||
print """Usage: python fetch_file.py [-l] [-f] [-d device] [-s speed] [-o out_path] path |
||||
\t-l\tList files |
||||
\t-f\tOverwrite existing files |
||||
\t-d\tSerial device |
||||
\t-s\tSerial baudrate |
||||
\t-o\tOutput path |
||||
\tpath\tPath to list/fetch, if ends with "/" then directory will be fetched recursively""" |
||||
|
||||
def _main(): |
||||
dev = "/dev/tty.usbmodem1" |
||||
speed = "57600" |
||||
cmd = "get" |
||||
path = None |
||||
path_out = None |
||||
force = False |
||||
|
||||
opt = None |
||||
for arg in sys.argv[1:]: |
||||
if opt != None: |
||||
if opt == "d": |
||||
dev = arg |
||||
elif opt == "s": |
||||
speed = arg |
||||
elif opt == "o": |
||||
path_out = arg |
||||
opt = None |
||||
else: |
||||
if arg == "-l": |
||||
cmd = "ls" |
||||
elif arg == "-f": |
||||
force = True |
||||
elif arg == "-d": |
||||
opt = "d" |
||||
elif arg == "-s": |
||||
opt = "s" |
||||
elif arg == "-o": |
||||
opt = "o" |
||||
elif path == None: |
||||
path = arg |
||||
|
||||
if path == None: |
||||
_usage() |
||||
exit(0) |
||||
|
||||
# Connect to serial port |
||||
ser = serial.Serial(dev, speed, timeout=0.2) |
||||
|
||||
timeout = 1.0 |
||||
|
||||
try: |
||||
if cmd == "ls": |
||||
# List directory |
||||
print _ls_dir_raw(ser, path, timeout) |
||||
elif cmd == "get": |
||||
# Get file(s) |
||||
if path.endswith("/"): |
||||
# Get all files from directory recursively |
||||
if path_out == None: |
||||
path_out = os.path.split(path[:-1])[1] |
||||
_get_files_in_dir(ser, path[:-1], path_out, force, timeout) |
||||
else: |
||||
# Get one file |
||||
if path_out == None: |
||||
path_out = os.path.split(path)[1] |
||||
_get_file(ser, path, os.path.split(path)[1], force, timeout) |
||||
except Exception as e: |
||||
print e |
||||
|
||||
ser.close() |
||||
|
||||
if __name__ == "__main__": |
||||
_main() |
@ -1,133 +0,0 @@
@@ -1,133 +0,0 @@
|
||||
#!/usr/bin/env python |
||||
############################################################################ |
||||
# |
||||
# Copyright (C) 2012, 2013 PX4 Development Team. All rights reserved. |
||||
# |
||||
# Redistribution and use in source and binary forms, with or without |
||||
# modification, are permitted provided that the following conditions |
||||
# are met: |
||||
# |
||||
# 1. Redistributions of source code must retain the above copyright |
||||
# notice, this list of conditions and the following disclaimer. |
||||
# 2. Redistributions in binary form must reproduce the above copyright |
||||
# notice, this list of conditions and the following disclaimer in |
||||
# the documentation and/or other materials provided with the |
||||
# distribution. |
||||
# 3. Neither the name PX4 nor the names of its contributors may be |
||||
# used to endorse or promote products derived from this software |
||||
# without specific prior written permission. |
||||
# |
||||
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
||||
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
||||
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
||||
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
||||
# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
||||
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
||||
# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
||||
# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
||||
# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
||||
# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
||||
# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
||||
# POSSIBILITY OF SUCH DAMAGE. |
||||
# |
||||
############################################################################ |
||||
|
||||
# |
||||
# Log fetcher |
||||
# |
||||
# Print list of logs: |
||||
# python fetch_log.py |
||||
# |
||||
# Fetch log: |
||||
# python fetch_log.py sess001/log001.bin |
||||
# |
||||
|
||||
import serial, time, sys, os |
||||
|
||||
def wait_for_string(ser, s, timeout=1.0, debug=False): |
||||
t0 = time.time() |
||||
buf = [] |
||||
res = [] |
||||
n = 0 |
||||
while (True): |
||||
c = ser.read() |
||||
if debug: |
||||
sys.stderr.write(c) |
||||
buf.append(c) |
||||
if len(buf) > len(s): |
||||
res.append(buf.pop(0)) |
||||
n += 1 |
||||
if n % 10000 == 0: |
||||
sys.stderr.write(str(n) + "\n") |
||||
if "".join(buf) == s: |
||||
break |
||||
if timeout > 0.0 and time.time() - t0 > timeout: |
||||
raise Exception("Timeout while waiting for: " + s) |
||||
return "".join(res) |
||||
|
||||
def exec_cmd(ser, cmd, timeout): |
||||
ser.write(cmd + "\n") |
||||
ser.flush() |
||||
wait_for_string(ser, cmd + "\r\n", timeout) |
||||
return wait_for_string(ser, "nsh> \x1b[K", timeout) |
||||
|
||||
def ls_dir(ser, dir, timeout=1.0): |
||||
res = [] |
||||
for line in exec_cmd(ser, "ls -l " + dir, timeout).splitlines()[1:]: |
||||
res.append((line[20:], int(line[11:19].strip()), line[1] == "d")) |
||||
return res |
||||
|
||||
def list_logs(ser): |
||||
logs_dir = "/fs/microsd/log" |
||||
res = [] |
||||
for d in ls_dir(ser, logs_dir): |
||||
if d[2]: |
||||
sess_dir = d[0][:-1] |
||||
for f in ls_dir(ser, logs_dir + "/" + sess_dir): |
||||
log_file = f[0] |
||||
log_size = f[1] |
||||
res.append(sess_dir + "/" + log_file + "\t" + str(log_size)) |
||||
return "\n".join(res) |
||||
|
||||
def fetch_log(ser, fn, timeout): |
||||
cmd = "dumpfile " + fn |
||||
ser.write(cmd + "\n") |
||||
ser.flush() |
||||
wait_for_string(ser, cmd + "\r\n", timeout, True) |
||||
res = wait_for_string(ser, "\n", timeout, True) |
||||
data = [] |
||||
if res.startswith("OK"): |
||||
size = int(res.split()[1]) |
||||
n = 0 |
||||
print "Reading data:" |
||||
while (n < size): |
||||
buf = ser.read(min(size - n, 8192)) |
||||
data.append(buf) |
||||
n += len(buf) |
||||
sys.stdout.write(".") |
||||
sys.stdout.flush() |
||||
print |
||||
else: |
||||
raise Exception("Error reading log") |
||||
wait_for_string(ser, "nsh> \x1b[K", timeout) |
||||
return "".join(data) |
||||
|
||||
def main(): |
||||
dev = "/dev/tty.usbmodem1" |
||||
ser = serial.Serial(dev, "115200", timeout=0.2) |
||||
if len(sys.argv) < 2: |
||||
print list_logs(ser) |
||||
else: |
||||
log_file = sys.argv[1] |
||||
data = fetch_log(ser, "/fs/microsd/log/" + log_file, 1.0) |
||||
try: |
||||
os.mkdir(log_file.split("/")[0]) |
||||
except: |
||||
pass |
||||
fout = open(log_file, "wb") |
||||
fout.write(data) |
||||
fout.close() |
||||
ser.close() |
||||
|
||||
if __name__ == "__main__": |
||||
main() |
Loading…
Reference in new issue