// File: /workspace/github_c_makefile_star2_O1/orempel[P]multiboot_tool/mpmboot.c
// Function: mpm_recv
static int mpm_recv(struct mpm_privdata *mpm,
                    uint8_t command,
                    uint8_t *cause,
                    uint8_t *buffer,
                    uint16_t buffersize)
{
    int     len;
    uint8_t header[4];

    len = mpm_serial_read(mpm->fd, header, sizeof(header));
    if (len != sizeof(header))
    {
        fprintf(stderr, "short read() from device (not addressed?)\n");
        return -1;
    }

    if (header[0] != command)
    {
        fprintf(stderr, "invalid command response (0x%02x != 0x%02x)\n", header[0], command);
        return -1;
    }

    *cause = header[1];

    uint16_t length = (header[2] << 8) | header[3];
//     printf("mpm_recv() cmd=0x%02x cause=0x%02x length=0x%04x\n", command, *cause, length);

    uint16_t bufferpos = 0;
    while (length > 0)
    {

        /* free space in output buffer? */
        if ((bufferpos < buffersize) && (buffer != NULL))
        {
            uint16_t size = MIN(buffersize - bufferpos, length);

            len = mpm_serial_read(mpm->fd, buffer + bufferpos, size);
            if (len <= 0)
            {
                fprintf(stderr, "short read() from device (%d != %d)\n", len, size);
                return -1;
            }

            bufferpos += len;
            length    -= len;
        }
        else
        {
            uint8_t dummy[256];

            /* no space in output buffer, but device still sends data -> do dummy read */
            uint16_t size = MIN(sizeof(dummy), length);

            len = mpm_serial_read(mpm->fd, dummy, size);
            if (len <= 0)
            {
                fprintf(stderr, "short read() from device (%d != %d)\n", len, size);
                return -1;
            }

            length -= len;
        }
    }

    return bufferpos;
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x118, %rsp            # imm = 0x118
movl %r8d, 0x8(%rsp)
movq %rcx, %r14
movq %rdx, %r12
movl %esi, %ebp
movq %rdi, %r15
movl 0x8(%rdi), %edi
leaq 0x4(%rsp), %rsi
movl $0x4, %edx
callq 0x6ae3
cmpl $0x4, %eax
jne 0x6aa9
movzbl 0x4(%rsp), %edx
cmpb %bpl, %dl
jne 0x6ab0
movb 0x5(%rsp), %al
movb %al, (%r12)
movzwl 0x6(%rsp), %r13d
rolw $0x8, %r13w
testw %r13w, %r13w
je 0x6aa0
movzwl 0x8(%rsp), %eax
movl %eax, 0xc(%rsp)
xorl %ebx, %ebx
movzwl %r13w, %eax
testq %r14, %r14
je 0x6a4d
cmpw 0x8(%rsp), %bx
jae 0x6a4d
movzwl %bx, %esi
movl 0xc(%rsp), %ecx
subl %esi, %ecx
cmpl %eax, %ecx
cmovgel %eax, %ecx
movl 0x8(%r15), %edi
addq %r14, %rsi
movzwl %cx, %r12d
movl %r12d, %edx
callq 0x6ae3
movl %eax, %ebp
testl %eax, %eax
jle 0x6a81
addl %ebp, %ebx
jmp 0x6a72
movl $0x100, %ecx            # imm = 0x100
cmpl %ecx, %eax
cmovael %ecx, %eax
movl 0x8(%r15), %edi
movzwl %ax, %r12d
leaq 0x10(%rsp), %rsi
movl %r12d, %edx
callq 0x6ae3
movl %eax, %ebp
testl %eax, %eax
jle 0x6a81
subl %ebp, %r13d
testl %ebp, %ebp
jle 0x6acc
testw %r13w, %r13w
jne 0x6a12
jmp 0x6aa4
movq 0x6570(%rip), %rax      # 0xcff8
movq (%rax), %rdi
leaq 0x23f5(%rip), %rsi      # 0x8e87
movl %ebp, %edx
movl %r12d, %ecx
xorl %eax, %eax
callq 0x2170
jmp 0x6a75
xorl %eax, %eax
jmp 0x6ad1
movzwl %bx, %eax
jmp 0x6ad1
callq 0x2bd7
jmp 0x6acc
movzbl %bpl, %ecx
movq 0x653d(%rip), %rax      # 0xcff8
movq (%rax), %rdi
leaq 0x2395(%rip), %rsi      # 0x8e5a
xorl %eax, %eax
callq 0x2170
movl $0xffffffff, %eax       # imm = 0xFFFFFFFF
addq $0x118, %rsp            # imm = 0x118
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq