MQTT Fix assert of (pos + len) bug