Faster now: stm32 100bytes message, now encode 124us and decode 112us

Author: hit9

lib/c/bitproto.c

@@ -227,7 +227,13 @@ void BpCopyBufferBits(int n, unsigned char *dst, unsigned char *src, int di,
             if (n >= 32) {
                 ((uint32_t *)dst)[0] = ((uint32_t *)(src))[0] >> si;
                 if (si) dst[3] |= ((src[4] << d) & ~(0xff << d << si));
+
                 c = 32;
+
+                dst += 4;
+                src += 4;
+                n -= c;
+                continue;
             } else if (b >= 32) {
                 // Copy as an uint32 integer.
                 // This way, performance faster x2 than bits copy approach.
@@ -238,6 +244,11 @@ void BpCopyBufferBits(int n, unsigned char *dst, unsigned char *src, int di,
                 if (si) dst[1] |= ((src[2] << d) & ~(0xff << d << si));
 
                 c = 16;
+
+                dst += 2;
+                src += 2;
+                n -= c;
+                continue;
             } else if (b >= 16) {
                 // Copy as an uint16 integer.
                 ((uint16_t *)dst)[0] = ((uint16_t *)(src))[0] >> si;
@@ -246,7 +257,13 @@ void BpCopyBufferBits(int n, unsigned char *dst, unsigned char *src, int di,
                 // Copy as an unsigned char.
                 dst[0] = (src[0] >> si) & 0xff;
                 if (si) dst[0] |= ((src[1] << d) & ~(0xff << d << si));
+
                 c = 8;
+
+                dst += 1;
+                src += 1;
+                n -= c;
+                continue;
             } else if (b >= 8) {
                 // Copy as an unsigned char.
                 dst[0] = (src[0] >> si) & 0xff;