helper: hexify correctly handle signed chars

[openocd.git] / src / helper / binarybuffer.c

diff --git a/src/helper/binarybuffer.c b/src/helper/binarybuffer.c
index 74af53a95a9694ab36fba50462cd00d8cd7821fc..b3e44916aa4d44de39f39750226d2bb9c5bb4462 100644 (file)
--- a/src/helper/binarybuffer.c
+++ b/src/helper/binarybuffer.c
@@ -327,3 +327,73 @@ int str_to_buf(const char *str, unsigned str_len,
 
        return i;
 }
+
+void bit_copy_queue_init(struct bit_copy_queue *q)
+{
+       INIT_LIST_HEAD(&q->list);
+}
+
+int bit_copy_queued(struct bit_copy_queue *q, uint8_t *dst, unsigned dst_offset, const uint8_t *src,
+       unsigned src_offset, unsigned bit_count)
+{
+       struct bit_copy_queue_entry *qe = malloc(sizeof(*qe));
+       if (!qe)
+               return ERROR_FAIL;
+
+       qe->dst = dst;
+       qe->dst_offset = dst_offset;
+       qe->src = src;
+       qe->src_offset = src_offset;
+       qe->bit_count = bit_count;
+       list_add_tail(&qe->list, &q->list);
+
+       return ERROR_OK;
+}
+
+void bit_copy_execute(struct bit_copy_queue *q)
+{
+       struct bit_copy_queue_entry *qe;
+       struct bit_copy_queue_entry *tmp;
+       list_for_each_entry_safe(qe, tmp, &q->list, list) {
+               bit_copy(qe->dst, qe->dst_offset, qe->src, qe->src_offset, qe->bit_count);
+               list_del(&qe->list);
+               free(qe);
+       }
+}
+
+void bit_copy_discard(struct bit_copy_queue *q)
+{
+       struct bit_copy_queue_entry *qe;
+       struct bit_copy_queue_entry *tmp;
+       list_for_each_entry_safe(qe, tmp, &q->list, list) {
+               list_del(&qe->list);
+               free(qe);
+       }
+}
+
+int unhexify(char *bin, const char *hex, int count)
+{
+       int i, tmp;
+
+       for (i = 0; i < count; i++) {
+               if (sscanf(hex + (2 * i), "%02x", &tmp) != 1)
+                       return i;
+               bin[i] = tmp;
+       }
+
+       return i;
+}
+
+int hexify(char *hex, const char *bin, int count, int out_maxlen)
+{
+       int i, cmd_len = 0;
+
+       /* May use a length, or a null-terminated string as input. */
+       if (count == 0)
+               count = strlen(bin);
+
+       for (i = 0; i < count; i++)
+               cmd_len += snprintf(hex + cmd_len, out_maxlen - cmd_len, "%02x", bin[i] & 0xff);
+
+       return cmd_len;
+}