| #!/usr/bin/env python3 |
| |
| import base64 |
| import cmd |
| import curses.ascii |
| import select |
| import socket |
| import sys |
| import time |
| |
| from elftools.elf.elffile import ELFFile |
| |
| |
| class BootromShell(cmd.Cmd): |
| intro = "Welcome to Bootrom Shell" |
| # The bootrom will display its own prompt, no need for one here. |
| prompt = "" |
| socket = None |
| poller = None |
| pty_in = None |
| pty_out = None |
| connected = False |
| use_pty = False |
| default_host_name = "Renode" |
| default_host_addr = ("localhost", 31415) |
| default_max_retry = 60 |
| |
| ############################################################################ |
| # Network stuff here |
| |
| # Try and connect to {host_addr} once per second for {max_retry} seconds |
| def connect(self, host_name, host_addr, max_retry): |
| if self.use_pty: |
| # pylint: disable=R1732 |
| self.pty_in = open("/tmp/uart", "rb", buffering=0) |
| self.pty_out = open("/tmp/uart", "wb", buffering=0) |
| self.poller = select.poll() |
| self.poller.register(self.pty_in, select.POLLIN) |
| return True |
| if self.socket is None: |
| print("Opening socket") |
| self.socket = socket.socket(socket.AF_INET, socket.SOCK_STREAM) |
| |
| print(f"Connecting to {host_name}", end="") |
| for _ in range(max_retry): |
| try: |
| self.socket.connect(host_addr) |
| self.connected = True |
| self.poller = select.poll() |
| self.poller.register(self.socket, select.POLLIN) |
| print("Connected!") |
| return True |
| except ConnectionError: |
| print(".", end="") |
| sys.stdout.flush() |
| time.sleep(1) |
| print("Connection timed out!") |
| return False |
| |
| def disconnect(self): |
| if self.pty_in is not None: |
| print("Closing pty_in") |
| self.pty_in.close() |
| if self.pty_out is not None: |
| print("Closing pty_in") |
| self.pty_out.close() |
| if self.socket is not None: |
| print("Closing socket") |
| self.socket.close() |
| self.connected = False |
| self.pty_in = None |
| self.pty_out = None |
| self.socket = None |
| self.poller = None |
| |
| def getpeername(self): |
| if self.use_pty: |
| return "/tmp/uart" |
| return self.socket.getpeername() |
| |
| def send(self, data): |
| if self.use_pty: |
| self.pty_out.write(data) |
| self.pty_out.flush() |
| else: |
| self.socket.send(data) |
| |
| def recv(self, size): |
| if self.use_pty: |
| print(self.pty_in) |
| result = self.pty_in.read(size) |
| else: |
| result = self.socket.recv(size) |
| if len(result) == 0: |
| self.disconnect() |
| return result |
| |
| def poll(self, timeout): |
| if self.connected: |
| poll_result = self.poller.poll(timeout) |
| return len(poll_result) != 0 |
| return False |
| |
| ############################################################################ |
| |
| # Dumps incoming packet to the console, returns true if it contained a sync |
| # symbol |
| def print_packet(self, echo=False): |
| saw_sync = False |
| received = self.recv(4096) |
| for c in received: |
| if c == curses.ascii.ETX: |
| saw_sync = True |
| elif echo: |
| sys.stdout.write(chr(c)) |
| sys.stdout.flush() |
| return saw_sync |
| |
| # Waits until we see a packet containing a sync symbol or the line has been |
| # idle for {timeout} |
| def wait_for_sync(self, timeout, echo=True): |
| while True: |
| if not self.connected: |
| return False |
| if self.poll(timeout): |
| if self.print_packet(echo): |
| return True |
| else: |
| return False |
| |
| # Collects bytes in a string until we see a sync symbol or we timeout |
| def wait_for_response(self, timeout): |
| result = bytearray() |
| while True: |
| if self.poll(timeout): |
| received = self.recv(1) |
| if received[0] == curses.ascii.ETX: |
| return result |
| result.append(received[0]) |
| else: |
| print("Timeout while waiting for command response") |
| return b"" |
| |
| # Waits until the line has been idle for {timeout} |
| def wait_for_idle(self, timeout, echo=True): |
| while True: |
| if self.poll(timeout): |
| self.print_packet(echo) |
| else: |
| break |
| |
| def run_command(self, line): |
| if self.connected: |
| self.send((line + "\n").encode()) |
| self.wait_for_sync(100000) |
| else: |
| print("Not connected!") |
| |
| ############################################################################ |
| |
| def load_blob_at(self, blob, address): |
| chunks = [blob[i:i + 65536] for i in range(0, len(blob), 65536)] |
| for chunk in chunks: |
| self.send(f"write {hex(address)}\n".encode()) |
| self.wait_for_response(100000) |
| self.send(base64.b64encode(chunk)) |
| self.send("\n".encode()) |
| self.wait_for_sync(100000) |
| address = address + 65536 |
| |
| def load_file_at(self, filename, address): |
| try: |
| with open(filename, "rb") as file: |
| print("file opened") |
| blob = file.read() |
| print("blob read") |
| self.load_blob_at(blob, address) |
| except OSError as e: |
| print(f"Could not load {filename}") |
| print(f"Exception {e} ") |
| |
| def load_elf(self, filename): |
| try: |
| # pylint: disable=R1732 |
| elf_file = ELFFile(open(filename, "rb")) |
| print(f"Entry point at {hex(elf_file.header.e_entry)}") |
| return elf_file |
| except OSError: |
| print(f"Could not open '{filename}' as an ELF file") |
| return None |
| |
| def upload_elf(self, elf_file): |
| if elf_file is None: |
| print("No elf file") |
| return False |
| for segment in elf_file.iter_segments(): |
| header = segment.header |
| if header.p_type == "PT_LOAD": |
| start = header.p_paddr |
| size = header.p_filesz |
| end = start + size |
| print( |
| f"Loading seg: {hex(start)}:{hex(end)} ({size} bytes)...") |
| sys.stdout.flush() |
| self.load_blob_at(segment.data(), start) |
| |
| return True |
| |
| ############################################################################ |
| # cmd.Cmd callbacks here |
| |
| def do_connect(self, _=""): |
| """Connects to the Renode server, localhost@31415 by default.""" |
| host_name = self.default_host_name |
| host_addr = self.default_host_addr |
| max_retry = self.default_max_retry |
| |
| if self.connect(host_name, host_addr, max_retry): |
| print(f"Connected to {host_name} @ {self.getpeername()}") |
| else: |
| print( |
| f"Failed to connect to {host_name} after {max_retry} seconds") |
| self.disconnect() |
| return |
| |
| # Ping the server with a newline once per second until we see a sync |
| # symbol and the line goes idle for 100 msec. |
| print("Waiting for prompt...") |
| for _ in range(180): |
| if not self.connected: |
| break |
| self.send("\n".encode()) |
| if self.wait_for_sync(1000): |
| # Sync seen, turn remote echo off and mute the ack |
| self.send("echo off\n".encode()) |
| self.wait_for_idle(1000, False) |
| return |
| |
| print("Did not see command prompt from server") |
| self.disconnect() |
| return |
| |
| def do_disconnect(self, _=""): |
| """Disconnect from the Renode server""" |
| self.disconnect() |
| |
| def do_reconnect(self, _=""): |
| """Reconnect to the Renode server""" |
| self.do_disconnect() |
| self.do_connect() |
| |
| ##---------------------------------------- |
| |
| def do_boot_elf(self, line=""): |
| """Load local ELF file to remote device and boot it""" |
| try: |
| e = self.load_elf(line) |
| if e is None: |
| print(f"Could not open '{line}' as an ELF file") |
| return False |
| |
| self.upload_elf(e) |
| self.send(f"boot {hex(e.header.e_entry)}\n".encode()) |
| self.wait_for_sync(100000) |
| except OSError: |
| print(f"Failed to boot {line}") |
| return True |
| |
| def do_load_elf(self, line=""): |
| """Load local ELF file to remote device""" |
| e = self.load_elf(line) |
| if e is None: |
| print(f"Could not open '{line}' as an ELF file") |
| return False |
| |
| self.upload_elf(e) |
| return False |
| |
| def do_load_file_at(self, line): |
| """Uploads a binary file to a fixed address""" |
| args = line.split() |
| self.load_file_at(args[0], int(args[1], 16)) |
| |
| def do_load_xflash(self, line): |
| """Uploads a binary file to external flash""" |
| self.load_file_at(line, "0x44000000") |
| |
| def do_boot_sec(self, line): |
| """Boots an app on SEC at the given entry point. |
| This will kill the active bootrom console session.""" |
| self.send(f"boot {line}\n".encode()) |
| self.wait_for_idle(100) |
| |
| def do_boot_smc(self, line): |
| """Boots an app on SMC at the given entry point. |
| If entry == 0, will stop SMC.""" |
| self.send(f"poked 0x54020000 {line}") |
| self.wait_for_idle(100) |
| |
| ##---------------------------------------- |
| |
| def do_help(self, arg=""): |
| """Displays local and remote commands""" |
| super().do_help(arg) |
| if not arg: |
| print("Remote commands") |
| print("================") |
| print() |
| self.run_command("help") |
| |
| def do_exit(self, _=""): |
| """Exits BootromShell""" |
| self.disconnect() |
| return True |
| |
| ##---------------------------------------- |
| |
| def default(self, line): |
| self.run_command(line) |
| |
| def emptyline(self): |
| pass |
| |
| ##---------------------------------------- |
| |
| # Command completeion callback (todo) |
| # pylint: disable=W0221 |
| def completenames(self, text, line, begidx, endidx): |
| result = super().completenames(text, line, begidx, endidx) |
| return result |
| |
| # Argument completion callback (todo) |
| # pylint: disable=W0221 |
| def completedefault(self, text, line, begidx, endidx): |
| result = super().completedefault(text, line, begidx, endidx) |
| return result |
| |
| |
| ################################################################################ |
| |
| if __name__ == '__main__': |
| print("<<shell starting>>") |
| shell = BootromShell() |
| shell.do_connect() |
| shell.cmdloop() |
| print("<<shell closed>>") |
