Function encode

lib_acl_cpp/samples/mqtt/mqtt_length/main.cpp:24–46

}

static int encode(unsigned n, unsigned char *buf) {
	int len = 0;
	if (n < 128) {
		buf[len++] = n & 0x7f;
	} else if (n < 16384) {
		buf[len++] = ((unsigned char) n & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 7) & 0x7f);
	} else if (n < 2097152) {
		buf[len++] = ((unsigned char) n & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 7 ) & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 14) & 0x7f);
	} else if (n < 268435456) {
		buf[len++] = ((unsigned char) n & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 7 ) & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 14) & 0x7f) | 0x80;
		buf[len++] = ((unsigned char) (n >> 21) & 0x7f);
	} else {
		printf("invalid dlen_=%u\n", n);
		return -1;
	}

	return len;
}

int main(void) {
	unsigned char buf[4];