Считывание определенных битов из одного регистра и запись в определенные биты другого

---

Я ищу, чтобы реализовать прототип для read_and_write, но не могу получить его правильно. Любая помощь будет оценена по достоинству. Я могу извлекать биты.

В приведенном ниже коде для write_val1 мое намерение состоит в том, чтобы записать только первые 9 бит final_val в read_data. Остальные 7 бит read_data должны оставаться нетронутыми. Ожидаемый результат для write_val1 = 0x0080

Аналогично для write_val2, мое намерение состоит в том, чтобы записать только следующие 8 бит из final_val в read_data. Остальные 8 бит read_data должны оставаться нетронутыми. Ожидаемый результат для write_val2 = 0x2700

Аналогично для write_val3 мое намерение состоит в том, чтобы записать только следующие 3 бита(010) из final_val в позицию[11:13] read_data, оставив остальную часть read_data нетронутой.

Ожидаемый вывод = 0x5448 ; например: выберите 010 извлеченный бит из write_val3; 0x3048 = 0111 0000 0100 1000; 0x5048 = 0101 0000 0100 1000

#include <stdio.h>
#include <stdint.h>

 // Extracts n bits from a given position in LSB. 
int bitExtracted(uint16_t read_data, uint8_t n_bits, uint8_t pos) 
{ 
    return (((1 << n_bits) - 1) & (read_data >> (pos - 1))); 
} 

void read_and_write(uint32_t* final_val, uint16_t* write_val, uint8_t start_pos, uint8_t end_pos)
{
    uint32_t temp = *final_val;
    *write_val = (uint16_t) ((temp >> start_pos) & ((1 << end_pos) - 1)); // store the desired number of bits in write_val
    *final_val = (temp >> end_pos); //shift final_val by end_pos since those bits are already written
    printf("\n temp %x, write_val %x, final_val %x ", temp, *write_val, *final_val);
    
}

void main() 
{
    uint16_t read_data = 0x0; //assume some read value
    uint16_t ext_val1 = bitExtracted(read_data, 9, 1);  //Read BITS [8:0] from read_data
    uint8_t ext_val2 = bitExtracted(read_data, 8, 1);   //Read BITS [7:0] from read_data
    uint8_t ext_val3 = bitExtracted(read_data, 3, 5);   //Read BITS [7:4] from read_data
    uint32_t final_val = 0x0; //Stores 20 extracted bits from val1, val2 and val3 into final_val (LSB to MSB in order)
    uint16_t write_val1, write_val2, write_val3;
    uint8_t start_pos = 0, end_pos =8;
    ext_val1 = 0x80, ext_val2 = 0x0, ext_val3 = 0x2;
    final_val = (ext_val1 | (ext_val2 << 9) | (ext_val3 << 17));
    printf ("\n final_val %x", final_val);
    
    //Read first 9 bits of final_val and write only into [8:0] position of existing read_data
    read_and_write(&final_val, &write_val1, 0, 9); 
    read_data = 0x80;
    write_val1 = write_val1 | read_data;
    
    //Read next 8 bits of final_val and write only into [7:0] position of existing read_data
    start_pos = 0;
    end_pos = 7;
    read_data = 0x27b7;
    read_and_write(&final_val, &write_val2, start_pos, end_pos);
    write_val2 = write_val2 | read_data;

    //Read next 3 bits of final_val and write only into[13:11] position of existing read_data
    start_pos = 11;
    end_pos = 13;
    read_data = 0x3048;
    read_and_write(&final_val, &write_val3, start_pos, end_pos);
    write_val3 = write_val3 | read_data;
    printf ("\n val1 0x%x val2 0x%x val3 0x%x final_val 0x%x", write_val1, write_val2, ext_val3, final_val);
}

Что я уже пробовал:

Я могу извлекать биты и объединять их в один final_val. Я не могу изменить регистры в этих конкретных start_pos и end_pos.

---