|
@@ -17,13 +17,14 @@
|
|
|
*/
|
|
|
|
|
|
#include "qdf_mem.h"
|
|
|
+#include "qdf_module.h"
|
|
|
#include "qdf_status.h"
|
|
|
#include "qdf_trace.h"
|
|
|
#include "qdf_types.h"
|
|
|
|
|
|
static QDF_STATUS qdf_consume_char(const char **str, char c)
|
|
|
{
|
|
|
- if (*str[0] != c)
|
|
|
+ if ((*str)[0] != c)
|
|
|
return QDF_STATUS_E_FAILURE;
|
|
|
|
|
|
(*str)++;
|
|
@@ -33,12 +34,12 @@ static QDF_STATUS qdf_consume_char(const char **str, char c)
|
|
|
|
|
|
static QDF_STATUS qdf_consume_whitespace(const char **str, char *c)
|
|
|
{
|
|
|
- switch (*str[0]) {
|
|
|
+ switch ((*str)[0]) {
|
|
|
case ' ':
|
|
|
case '\t':
|
|
|
case '\n':
|
|
|
case '\r':
|
|
|
- *c = *str[0];
|
|
|
+ *c = (*str)[0];
|
|
|
(*str)++;
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
default:
|
|
@@ -58,7 +59,7 @@ static void qdf_skip_whitespace(const char **str)
|
|
|
|
|
|
static QDF_STATUS qdf_consume_dec(const char **str, uint8_t *out_digit)
|
|
|
{
|
|
|
- uint8_t c = *str[0];
|
|
|
+ uint8_t c = (*str)[0];
|
|
|
|
|
|
if (c >= '0' && c <= '9')
|
|
|
*out_digit = c - '0';
|
|
@@ -70,6 +71,24 @@ static QDF_STATUS qdf_consume_dec(const char **str, uint8_t *out_digit)
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
}
|
|
|
|
|
|
+static QDF_STATUS qdf_consume_hex(const char **str, uint8_t *out_nibble)
|
|
|
+{
|
|
|
+ uint8_t c = (*str)[0];
|
|
|
+
|
|
|
+ if (c >= '0' && c <= '9')
|
|
|
+ *out_nibble = c - '0';
|
|
|
+ else if (c >= 'a' && c <= 'f')
|
|
|
+ *out_nibble = c - 'a' + 10;
|
|
|
+ else if (c >= 'A' && c <= 'F')
|
|
|
+ *out_nibble = c - 'A' + 10;
|
|
|
+ else
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+
|
|
|
+ (*str)++;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
static QDF_STATUS qdf_consume_octet_dec(const char **str, uint8_t *out_octet)
|
|
|
{
|
|
|
uint8_t len = 0;
|
|
@@ -101,24 +120,6 @@ static QDF_STATUS qdf_consume_octet_dec(const char **str, uint8_t *out_octet)
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
}
|
|
|
|
|
|
-static QDF_STATUS qdf_consume_hex(const char **str, uint8_t *out_nibble)
|
|
|
-{
|
|
|
- uint8_t c = *str[0];
|
|
|
-
|
|
|
- if (c >= '0' && c <= '9')
|
|
|
- *out_nibble = c - '0';
|
|
|
- else if (c >= 'a' && c <= 'f')
|
|
|
- *out_nibble = c - 'a' + 10;
|
|
|
- else if (c >= 'A' && c <= 'F')
|
|
|
- *out_nibble = c - 'A' + 10;
|
|
|
- else
|
|
|
- return QDF_STATUS_E_FAILURE;
|
|
|
-
|
|
|
- (*str)++;
|
|
|
-
|
|
|
- return QDF_STATUS_SUCCESS;
|
|
|
-}
|
|
|
-
|
|
|
static QDF_STATUS qdf_consume_hex_pair(const char **str, uint8_t *out_byte)
|
|
|
{
|
|
|
QDF_STATUS status;
|
|
@@ -167,6 +168,210 @@ static QDF_STATUS qdf_consume_hextet(const char **str, uint16_t *out_hextet)
|
|
|
return QDF_STATUS_SUCCESS;
|
|
|
}
|
|
|
|
|
|
+static QDF_STATUS qdf_consume_radix(const char **str, uint8_t *out_radix)
|
|
|
+{
|
|
|
+ if ((*str)[0] == '0') {
|
|
|
+ switch ((*str)[1]) {
|
|
|
+ case 'b':
|
|
|
+ *out_radix = 2;
|
|
|
+ *str += 2;
|
|
|
+ break;
|
|
|
+ case 'o':
|
|
|
+ *out_radix = 8;
|
|
|
+ *str += 2;
|
|
|
+ break;
|
|
|
+ case 'x':
|
|
|
+ *out_radix = 16;
|
|
|
+ *str += 2;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ *out_radix = 10;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (*str[0] >= '0' && *str[0] <= '9') {
|
|
|
+ *out_radix = 10;
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+ }
|
|
|
+
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+}
|
|
|
+
|
|
|
+static QDF_STATUS
|
|
|
+qdf_int_parse(const char *int_str, uint64_t *out_int, bool *out_negate)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ bool negate = false;
|
|
|
+ uint8_t radix;
|
|
|
+ uint8_t digit;
|
|
|
+ uint64_t value = 0;
|
|
|
+ uint64_t next_value;
|
|
|
+
|
|
|
+ QDF_BUG(int_str);
|
|
|
+ if (!int_str)
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+
|
|
|
+ QDF_BUG(out_int);
|
|
|
+ if (!out_int)
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+
|
|
|
+ qdf_skip_whitespace(&int_str);
|
|
|
+
|
|
|
+ status = qdf_consume_char(&int_str, '-');
|
|
|
+ if (QDF_IS_STATUS_SUCCESS(status))
|
|
|
+ negate = true;
|
|
|
+ else
|
|
|
+ qdf_consume_char(&int_str, '+');
|
|
|
+
|
|
|
+ status = qdf_consume_radix(&int_str, &radix);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status))
|
|
|
+ return status;
|
|
|
+
|
|
|
+ while (QDF_IS_STATUS_SUCCESS(qdf_consume_hex(&int_str, &digit))) {
|
|
|
+ if (digit >= radix)
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+
|
|
|
+ next_value = value * radix + digit;
|
|
|
+ if (next_value < value)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+
|
|
|
+ value = next_value;
|
|
|
+ }
|
|
|
+
|
|
|
+ qdf_skip_whitespace(&int_str);
|
|
|
+ if (int_str[0] != '\0')
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+
|
|
|
+ *out_negate = negate;
|
|
|
+ *out_int = value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+
|
|
|
+QDF_STATUS qdf_int32_parse(const char *int_str, int32_t *out_int)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ int64_t value;
|
|
|
+
|
|
|
+ status = qdf_int64_parse(int_str, &value);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status))
|
|
|
+ return status;
|
|
|
+
|
|
|
+ if ((int32_t)value != value)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+
|
|
|
+ *out_int = value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+qdf_export_symbol(qdf_int32_parse);
|
|
|
+
|
|
|
+QDF_STATUS qdf_uint32_parse(const char *int_str, uint32_t *out_int)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ uint64_t value;
|
|
|
+
|
|
|
+ status = qdf_uint64_parse(int_str, &value);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status))
|
|
|
+ return status;
|
|
|
+
|
|
|
+ if ((uint32_t)value != value)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+
|
|
|
+ *out_int = value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+qdf_export_symbol(qdf_uint32_parse);
|
|
|
+
|
|
|
+QDF_STATUS qdf_int64_parse(const char *int_str, int64_t *out_int)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ bool negate;
|
|
|
+ uint64_t value;
|
|
|
+ int64_t signed_value;
|
|
|
+
|
|
|
+ status = qdf_int_parse(int_str, &value, &negate);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status))
|
|
|
+ return status;
|
|
|
+
|
|
|
+ if (negate) {
|
|
|
+ signed_value = -value;
|
|
|
+ if (signed_value > 0)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+ } else {
|
|
|
+ signed_value = value;
|
|
|
+ if (signed_value < 0)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+ }
|
|
|
+
|
|
|
+ *out_int = signed_value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+qdf_export_symbol(qdf_int64_parse);
|
|
|
+
|
|
|
+QDF_STATUS qdf_uint64_parse(const char *int_str, uint64_t *out_int)
|
|
|
+{
|
|
|
+ QDF_STATUS status;
|
|
|
+ bool negate;
|
|
|
+ uint64_t value;
|
|
|
+
|
|
|
+ status = qdf_int_parse(int_str, &value, &negate);
|
|
|
+ if (QDF_IS_STATUS_ERROR(status))
|
|
|
+ return status;
|
|
|
+
|
|
|
+ if (negate)
|
|
|
+ return QDF_STATUS_E_RANGE;
|
|
|
+
|
|
|
+ *out_int = value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+qdf_export_symbol(qdf_uint64_parse);
|
|
|
+
|
|
|
+QDF_STATUS qdf_bool_parse(const char *bool_str, bool *out_bool)
|
|
|
+{
|
|
|
+ bool value;
|
|
|
+
|
|
|
+ QDF_BUG(bool_str);
|
|
|
+ if (!bool_str)
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+
|
|
|
+ QDF_BUG(out_bool);
|
|
|
+ if (!out_bool)
|
|
|
+ return QDF_STATUS_E_INVAL;
|
|
|
+
|
|
|
+ qdf_skip_whitespace(&bool_str);
|
|
|
+
|
|
|
+ switch (bool_str[0]) {
|
|
|
+ case '1':
|
|
|
+ case 'y':
|
|
|
+ case 'Y':
|
|
|
+ value = true;
|
|
|
+ break;
|
|
|
+ case '0':
|
|
|
+ case 'n':
|
|
|
+ case 'N':
|
|
|
+ value = false;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ qdf_skip_whitespace(&bool_str);
|
|
|
+ if (bool_str[0] != '\0')
|
|
|
+ return QDF_STATUS_E_FAILURE;
|
|
|
+
|
|
|
+ *out_bool = value;
|
|
|
+
|
|
|
+ return QDF_STATUS_SUCCESS;
|
|
|
+}
|
|
|
+qdf_export_symbol(qdf_bool_parse);
|
|
|
+
|
|
|
QDF_STATUS qdf_mac_parse(const char *mac_str, struct qdf_mac_addr *out_addr)
|
|
|
{
|
|
|
QDF_STATUS status;
|