#!/usr/bin/env python3 import os import sys import multiprocessing import platform import shutil import subprocess import tarfile import tempfile import requests import argparse from common.basedir import BASEDIR from selfdrive.test.process_replay.compare_logs import save_log from tools.lib.api import CommaApi from tools.lib.auth_config import get_token from tools.lib.robust_logreader import RobustLogReader from tools.lib.route import Route from urllib.parse import urlparse, parse_qs juggle_dir = os.path.dirname(os.path.realpath(__file__)) DEMO_ROUTE = "4cf7a6ad03080c90|2021-09-29--13-46-36" RELEASES_URL="https://github.com/commaai/PlotJuggler/releases/download/latest" INSTALL_DIR = os.path.join(juggle_dir, "bin") def install(): m = f"{platform.system()}-{platform.machine()}" supported = ("Linux-x86_64", "Darwin-arm64", "Darwin-x86_64") if m not in supported: raise Exception(f"Unsupported platform: '{m}'. Supported platforms: {supported}") if os.path.exists(INSTALL_DIR): shutil.rmtree(INSTALL_DIR) os.mkdir(INSTALL_DIR) url = os.path.join(RELEASES_URL, m + ".tar.gz") with requests.get(url, stream=True) as r, tempfile.NamedTemporaryFile() as tmp: r.raise_for_status() with open(tmp.name, 'wb') as tmpf: for chunk in r.iter_content(chunk_size=1024*1024): tmpf.write(chunk) with tarfile.open(tmp.name) as tar: tar.extractall(path=INSTALL_DIR) def load_segment(segment_name): if segment_name is None: return [] try: return list(RobustLogReader(segment_name)) except ValueError as e: print(f"Error parsing {segment_name}: {e}") return [] def start_juggler(fn=None, dbc=None, layout=None): env = os.environ.copy() env["BASEDIR"] = BASEDIR env["PATH"] = f"{INSTALL_DIR}:{os.getenv('PATH', '')}" if dbc: env["DBC_NAME"] = dbc extra_args = "" if fn is not None: extra_args += f"-d {fn}" if layout is not None: extra_args += f"-l {layout}" subprocess.call(f'plotjuggler --plugin_folders {INSTALL_DIR} {extra_args}', shell=True, env=env, cwd=juggle_dir) def juggle_route(route_name, segment_number, segment_count, qlog, can, layout): # TODO: abstract out the cabana stuff if 'cabana' in route_name: query = parse_qs(urlparse(route_name).query) api = CommaApi(get_token()) logs = api.get(f'v1/route/{query["route"][0]}/log_urls?sig={query["sig"][0]}&exp={query["exp"][0]}') elif route_name.startswith("http://") or route_name.startswith("https://") or os.path.isfile(route_name): logs = [route_name] else: r = Route(route_name) logs = r.qlog_paths() if qlog else r.log_paths() if segment_number is not None: logs = logs[segment_number:segment_number+segment_count] if None in logs: ans = input(f"{logs.count(None)}/{len(logs)} of the rlogs in this segment are missing, would you like to fall back to the qlogs? (y/n) ") if ans == 'y': logs = r.qlog_paths() if segment_number is not None: logs = logs[segment_number:segment_number+segment_count] else: print(f"Please try a different {'segment' if segment_number is not None else 'route'}") return all_data = [] with multiprocessing.Pool(24) as pool: for d in pool.map(load_segment, logs): all_data += d if not can: all_data = [d for d in all_data if d.which() not in ['can', 'sendcan']] # Infer DBC name from logs dbc = None for cp in [m for m in all_data if m.which() == 'carParams']: try: DBC = __import__(f"selfdrive.car.{cp.carParams.carName}.values", fromlist=['DBC']).DBC dbc = DBC[cp.carParams.carFingerprint]['pt'] except Exception: pass break with tempfile.NamedTemporaryFile(suffix='.rlog', dir=juggle_dir) as tmp: save_log(tmp.name, all_data, compress=False) del all_data start_juggler(tmp.name, dbc, layout) if __name__ == "__main__": parser = argparse.ArgumentParser(description="A helper to run PlotJuggler on openpilot routes", formatter_class=argparse.ArgumentDefaultsHelpFormatter) parser.add_argument("--demo", action="store_true", help="Use the demo route instead of providing one") parser.add_argument("--qlog", action="store_true", help="Use qlogs") parser.add_argument("--can", action="store_true", help="Parse CAN data") parser.add_argument("--stream", action="store_true", help="Start PlotJuggler in streaming mode") parser.add_argument("--layout", nargs='?', help="Run PlotJuggler with a pre-defined layout") parser.add_argument("--install", action="store_true", help="Install or update PlotJuggler + plugins") parser.add_argument("route_name", nargs='?', help="The route name to plot (cabana share URL accepted)") parser.add_argument("segment_number", type=int, nargs='?', help="The index of the segment to plot") parser.add_argument("segment_count", type=int, nargs='?', help="The number of segments to plot", default=1) if len(sys.argv) == 1: parser.print_help() sys.exit() args = parser.parse_args() if args.install: install() sys.exit() if args.stream: start_juggler(layout=args.layout) else: route = DEMO_ROUTE if args.demo else args.route_name.strip() juggle_route(route, args.segment_number, args.segment_count, args.qlog, args.can, args.layout)