---

import sys
import subprocess
import os
import re
import struct

def patch_boot_data_length(bin_path, final_length):
    if not os.path.exists(bin_path):
        return
    try:
        with open(bin_path, "r+b") as f:
            f.seek(0x24)
            f.write(struct.pack("<I", final_length))
        print(f"[LMA Filter] BootROM Patch: Successfully updated Boot Data Length to {final_length} bytes ({hex(final_length)})")
    except Exception as e:
        print(f"[LMA Filter] BootROM Patch Error: Could not modify binary header. Reason: {e}")

def main():
    if len(sys.argv) < 2:
        print("[LMA Filter] Error: No real objcopy path provided.")
        sys.exit(1)

    real_objcopy = sys.argv[1]
    args = sys.argv[2:]
    elf_path = "zephyr.elf"
    
    for arg in args:
        if arg.endswith("zephyr.elf"):
            elf_path = arg
            break

    is_elf_to_elf_adjust = any("--change-section-lma" in arg for arg in args) and ("zephyr.elf" in elf_path) and not any(fmt in " ".join(args) for fmt in ["ihex", "binary"])
    if is_elf_to_elf_adjust:
        sys.exit(0)

    is_hex_or_bin_generation = any("--output-target=" in arg for arg in args) or any(fmt in " ".join(args) for fmt in ["ihex", "binary"])

    if is_hex_or_bin_generation and os.path.exists(elf_path):
        sdk_bin_dir = os.path.dirname(real_objcopy)
        readelf_bin = os.path.join(sdk_bin_dir, "arm-zephyr-eabi-readelf")
        if not os.path.exists(readelf_bin):
            for file in os.listdir(sdk_bin_dir):
                if file.endswith("readelf"):
                    readelf_bin = os.path.join(sdk_bin_dir, file)
                    break

        code_end_vma = 0x80000000
        if os.path.exists(readelf_bin):
            res = subprocess.run([readelf_bin, "-SW", elf_path], capture_output=True, text=True)
            if res.returncode == 0:
                section_regex = re.compile(r'^\s*\[\s*\d+\]\s+([\.\w\-_]+)\s+(\w+)\s+([0-9a-fA-F]{8,16})\s+([0-9a-fA-F]{6,8})\s+([0-9a-fA-F]{6,8})')
                for line in res.stdout.splitlines():
                    match = section_regex.match(line)
                    if match:
                        sec_name, sec_type, vma_str, _, size_str = match.groups()
                        vma_val = int(vma_str, 16)
                        size_val = int(size_str, 16)
                        if 0x80000000 <= vma_val < 0x80400000 and sec_type != "NOBITS":
                            end_pos = vma_val + size_val
                            if end_pos > code_end_vma:
                                code_end_vma = end_pos

        flash_data_start_lma = (code_end_vma - 0x20000000 + 15) & ~15
        print(f"[LMA Filter] Dynamic VMA/LMA Packing Initiated:")
        print(f"  -> Code region ends at Flash LMA: {hex(code_end_vma - 0x20000000)}")
        print(f"  -> Data payload will start at Flash LMA: {hex(flash_data_start_lma)}")

        dynamic_offsets = []
        final_payload_end_lma = flash_data_start_lma
        
        if os.path.exists(readelf_bin):
            res = subprocess.run([readelf_bin, "-SW", elf_path], capture_output=True, text=True)
            if res.returncode == 0:
                section_regex = re.compile(r'^\s*\[\s*\d+\]\s+([\.\w\-_]+)\s+(\w+)\s+([0-9a-fA-F]{8,16})')
                current_flash_lma = flash_data_start_lma
                
                for line in res.stdout.splitlines():
                    match = section_regex.match(line)
                    if match:
                        sec_name, sec_type, vma_str = match.groups()
                        if sec_name in [".comment", ".symtab", ".strtab", ".shstrtab"] or sec_name.startswith(".debug"):
                            continue
                        
                        vma_val = int(vma_str, 16)
                        if sec_type == "NOBITS" or vma_val < 0x80000000:
                            continue
                        
                        if vma_val >= 0x80400000:
                            new_vma = current_flash_lma + 0x20000000
                            dynamic_offsets += ["--change-section-lma", f"{sec_name}={hex(current_flash_lma)}"]
                            dynamic_offsets += ["--change-section-vma", f"{sec_name}={hex(new_vma)}"]
                            size_res = re.search(r'^\s*\[\s*\d+\]\s+' + re.escape(sec_name) + r'\s+\w+\s+[0-9a-fA-F]+\s+[0-9a-fA-F]+\s+([0-9a-fA-F]+)', res.stdout, re.M)
                            if size_res:
                                current_flash_lma += (int(size_res.group(1), 16) + 3) & ~3
                                final_payload_end_lma = current_flash_lma
                        else:
                            standard_lma = vma_val - 0x20000000
                            dynamic_offsets += ["--change-section-lma", f"{sec_name}={hex(standard_lma)}"]

        final_cmd = [real_objcopy] + dynamic_offsets + args
        subprocess.run(final_cmd, check=True)

        calculated_image_size = final_payload_end_lma - 0x60000000
        elf_dir = os.path.dirname(elf_path)
        potential_bin = os.path.join(elf_dir, "zephyr.bin")
        if os.path.exists(potential_bin):
            patch_boot_data_length(potential_bin, calculated_image_size)
        else:
            fallback_bin = os.path.join(os.getcwd(), "zephyr", "zephyr.bin")
            if os.path.exists(fallback_bin):
                patch_boot_data_length(fallback_bin, calculated_image_size)

        if os.path.exists(readelf_bin):
            res = subprocess.run([readelf_bin, "-SW", elf_path], capture_output=True, text=True)
            if res.returncode == 0:
                print(f"\n[LMA Filter] === VERIFIED DYNAMICALLY PACKED MEMORY MAP FOR FLASH ===")
                print(f"{'Section Name':<28} | {'Resulting VMA':<12} | {'Resulting LMA (Flash)':<22}")
                print("-" * 72)
                section_regex = re.compile(r'^\s*\[\s*\d+\]\s+([\.\w\-_]+)\s+(\w+)\s+([0-9a-fA-F]{8,16})')
                current_flash_lma = flash_data_start_lma
                
                for line in res.stdout.splitlines():
                    match = section_regex.match(line)
                    if not match:
                        continue
                    sec_name, sec_type, vma_str = match.groups()
                    if sec_name in [".comment", ".symtab", ".strtab", ".shstrtab"] or sec_name.startswith(".debug"):
                        continue
                    vma_val = int(vma_str, 16)
                    
                    if sec_type == "NOBITS":
                        print(f"{sec_name:<28} | 0x{vma_val:08X}   | {'--------':<22} [RAM-only / Ignored]")
                        continue
                    if vma_val < 0x80000000:
                        continue
                        
                    if vma_val >= 0x80400000:
                        new_vma = current_flash_lma + 0x20000000
                        vma_formatted = f"0x{new_vma:08X}"
                        lma_formatted = f"0x{current_flash_lma:08X}"
                        size_res = re.search(r'^\s*\[\s*\d+\]\s+' + re.escape(sec_name) + r'\s+\w+\s+[0-9a-fA-F]+\s+[0-9a-fA-F]+\s+([0-9a-fA-F]+)', res.stdout, re.M)
                        if size_res:
                            current_flash_lma += (int(size_res.group(1), 16) + 3) & ~3
                    else:
                        vma_formatted = f"0x{vma_val:08X}"
                        lma_formatted = f"0x{(vma_val - 0x20000000):08X}"
                        
                    print(f"{sec_name:<28} | {vma_formatted:<12} | {lma_formatted:<22} -> OK (Flash)")
                print("=" * 72 + "\n")
    else:
        subprocess.run([real_objcopy] + args, check=True)

if __name__ == "__main__":
    main()