Как извлечь конкретные биты из смещения

Question

Я пытаюсь создать ассемблер на языке c, в котором я беру входные данные из файла, содержащего команду, в этом случае branchifequal я затем беру его код операции, который равен 10, поэтому byte[0] = 0xA0, а затемя получаю регистр для следующих 4 битов, а затем регистр для следующих 4 бит, но тогда как мне обработать смещение? при условии, что команда branchifequal r1 r2 8, тогда ручная сборка должна быть A1 20 00 08. Это сделано, я знаю, проверяя верхние 4 бита смещения адреса, которые равны 0, а затем нижние 16 битов, которые 0000 0000 0000 1000 я считаю. который должен конвертировать в 00 08 в шестнадцатеричном виде. Как я могу получить это, проверяя последние 4 бита во втором байте и 2 бита в 3-м байте, а затем последние 2 бита в 4-м байте - просто простое шестнадцатеричное значение, которое сделано в моем коде ниже. У меня такая же проблема и для моей команды jump.

PR1.C

    #include <stdio.h>
    #include <string.h>
    #include <stdlib.h>

    char *ltrim(char *s) {
        while (*s == ' ' || *s == '\t') s++;
        return s;
    }

    char getRegister(char *text) {
        if (*text == 'r' || *text=='R') text++;
        return atoi(text);
    }

    char getHex(char *text){
        int number = (int)strtol(text, NULL, 16);
        char reservednum[5];
        if(number <= 0xFFFF){
            sprintf(&reservednum[0], "%04x", number);
        }
        return atoi(reservednum);
    }

    int assembleLine(char *text, unsigned char* bytes) {
        text = ltrim(text);
        char *keyWord = strtok(text," ");
        if (strcmp("add",keyWord) == 0) {
            bytes[0] = 0x10;
            bytes[0] |= getRegister(strtok(NULL," "));
            bytes[1] = getRegister(strtok(NULL," ")) << 4 | getRegister(strtok(NULL," "));
            return 2;
        }
        else if(strcmp("subtract", keyWord) == 0){
            bytes[0] = 0x50;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4 | getRegister(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("and", keyWord) == 0){
            bytes[0] = 0x20;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4 | getRegister(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("divide", keyWord) == 0){
            bytes[0] = 0x30;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4 | getRegister(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("multiply", keyWord) == 0){
            bytes[0] = 0x40;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4 | getRegister(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("or", keyWord) == 0){
            bytes[0] = 0x60;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4 | getRegister(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("halt", keyWord) == 0){
            bytes[0] = 0x00;
            bytes[1] = 0x00;
            return 2;
        }
        else if(strcmp("return", keyWord) == 0){
            bytes[0] = 0x70;
            bytes[1] = 0x00;
            return 2;
        }
        else if(strcmp("addimmediate", keyWord) == 0){
            bytes[0] = 0x90;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getHex(strtok(NULL, " "));
            return 2;
        }
        else if(strcmp("interrupt", keyWord) == 0){
            bytes[0] = 0x80;
            bytes[0] |= getHex(strtok(NULL, " "));
            bytes[1] = 0x00;
            return 2;
        }
        else if(strcmp("push", keyWord) == 0){
            bytes[0] = 0x70;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = 0x40;
            return 2;
        }
        else if(strcmp("pop", keyWord) == 0){
            bytes[0] = 0x70;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = 0x80;
            return 2;
        }
        else if(strcmp("jump", keyWord) == 0){
            bytes[0] = 0xC0;
            bytes[1] = 0x00;
            bytes[2] = 0x00;
            bytes[3] = getHex(strtok(NULL, " "));
            return 4;
        }
        else if(strcmp("branchifequal", keyWord) == 0){
            bytes[0] = 0xA0;
            bytes[0] |= getRegister(strtok(NULL, " "));
            bytes[1] = getRegister(strtok(NULL, " ")) << 4;
            bytes[2] = 0x00;
            bytes[3] = getHex(strtok(NULL, " "));
            return 4;
        }
    }

    int main(int argc, char **argv) {
        FILE *src = fopen(argv[1],"r");
        FILE *dst = fopen(argv[2],"w");
        while (!feof(src)) {
            unsigned char bytes[4];
            char line[1000];
            if (NULL != fgets(line, 1000, src)) {
                printf ("read: %s\n",line);
                int byteCount = assembleLine(line,bytes);
                fwrite(bytes,byteCount,1,dst);
            }
        }
        fclose(src);
        fclose(dst);
        return 0;
    }