- uint32_t start_byte_position = (uint32_t)(bit_position/8);
- uint32_t bit_size_rest = bit_size;
-
- if((int)(bit_size-(8 + start_byte_position*8-bit_position%8))>0)
- {
- AFB_ERROR("Error: bit_position and bit_size getting out of range");
- return bit_position;
- }
-
- if(bit_size<=8 && ((bit_position+bit_size)%8==bit_size || (bit_position+bit_size)%8==0))
- {
- return (uint32_t)(start_byte_position*8 + (8-bit_size));
- }
- else
- {
- do
- {
- bit_size_rest = bit_size_rest - ((start_byte_position+1)*8-bit_position);
- start_byte_position--;
- bit_position = start_byte_position*8;
- } while (bit_size_rest>8);
- return (uint32_t)(start_byte_position*8 + (8-bit_size_rest));
- }