| 75 | /* Message encode/decode functions (must access whole aligned words for MMIO) */ |
| 76 | |
| 77 | void gdb_message_encode_bytes(struct gdb_message *message, const void *data, |
| 78 | int length) |
| 79 | { |
| 80 | die_if(message->used + length * 2 > message->size, OUTPUT_OVERRUN_MSG); |
| 81 | const mmio_word_t *aligned = |
| 82 | (mmio_word_t *)ALIGN_DOWN((uintptr_t)data, sizeof(*aligned)); |
| 83 | mmio_word_t word = be32toh(readl(aligned++)); |
| 84 | while (length--) { |
| 85 | u8 byte = (word >> ((((void *)aligned - data) - 1) * 8)); |
| 86 | message->buf[message->used++] = to_hex(byte >> 4); |
| 87 | message->buf[message->used++] = to_hex(byte & 0xf); |
| 88 | if (length && ++data == (void *)aligned) |
| 89 | word = be32toh(readl(aligned++)); |
| 90 | } |
| 91 | } |
| 92 | |
| 93 | void gdb_message_decode_bytes(const struct gdb_message *message, int offset, |
| 94 | void *data, int length) |
no test coverage detected