137 lines
3.2 KiB
C
137 lines
3.2 KiB
C
#include "opts.h"
|
|
#include "device/hw/v4l2.h"
|
|
|
|
#include <stddef.h>
|
|
#include <stdio.h>
|
|
#include <limits.h>
|
|
|
|
static int option_handler_print(option_t *option, char *data);
|
|
static int option_handler_set(option_t *option, char *data);
|
|
|
|
static void print_help(option_t *options)
|
|
{
|
|
for (int i = 0; options[i].name; i++) {
|
|
option_t *option = &options[i];
|
|
|
|
printf("%40s\t", option->name);
|
|
|
|
if (option->value_list) {
|
|
char *string = option->value_list;
|
|
char *token;
|
|
int tokens = 0;
|
|
|
|
while (token = strsep(&string, OPTION_VALUE_LIST_SEP)) {
|
|
if (tokens++ > 0)
|
|
printf("\n%40s\t", "");
|
|
printf("%s", token);
|
|
}
|
|
|
|
if (!tokens)
|
|
printf("(none)");
|
|
} else if (option->value_string) {
|
|
printf(option->format, option->value_string);
|
|
} else {
|
|
if (option->value_mapping) {
|
|
for (int j = 0; option->value_mapping[j].name; j++) {
|
|
if (option->value_mapping[j].value == *option->value) {
|
|
printf("%s - ", option->value_mapping[j].name);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
unsigned mask = UINT_MAX >> ((sizeof(*option->value) - option->size) * 8);
|
|
printf(option->format, *option->value & mask);
|
|
}
|
|
|
|
printf("\n");
|
|
}
|
|
}
|
|
|
|
static int parse_opt(option_t *options, const char *key)
|
|
{
|
|
option_t *option = NULL;
|
|
const char *value = strchr(key, '=');
|
|
|
|
for (int i = 0; options[i].name; i++) {
|
|
if (value) {
|
|
if (!strncmp(key, options[i].name, value - key)) {
|
|
option = &options[i];
|
|
value++; // ignore '='
|
|
break;
|
|
}
|
|
} else {
|
|
// require exact match
|
|
if (!strcmp(key, options[i].name)) {
|
|
option = &options[i];
|
|
value = option->default_value;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
E_LOG_DEBUG(NULL, "Parsing '%s'. Got value='%s', and option='%s'", key, value, option ? option->name : NULL);
|
|
|
|
if (!option || !value) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
int ret = 0;
|
|
if (option->value_list) {
|
|
char *ptr = option->value_list;
|
|
|
|
if (*ptr) {
|
|
strcat(ptr, OPTION_VALUE_LIST_SEP);
|
|
ptr += strlen(ptr);
|
|
}
|
|
|
|
ret = sscanf(value, option->format, ptr);
|
|
} else if (option->value_string) {
|
|
ret = sscanf(value, option->format, option->value_string);
|
|
} else if (option->value_mapping) {
|
|
for (int j = 0; option->value_mapping[j].name; j++) {
|
|
if (!strcmp(option->value_mapping[j].name, value)) {
|
|
*option->value_uint = option->value_mapping[j].value;
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
ret = sscanf(value, option->format, option->value);
|
|
} else {
|
|
ret = sscanf(value, option->format, option->value);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int parse_opts(option_t *options, int argc, char *argv[])
|
|
{
|
|
int arg;
|
|
|
|
for (arg = 1; arg < argc; arg++) {
|
|
const char *key = argv[arg];
|
|
|
|
if (key[0] == '-') {
|
|
key++;
|
|
if (key[0] == '-')
|
|
key++;
|
|
} else {
|
|
E_LOG_ERROR(NULL, "The '%s' is not option (should start with - or --).", key);
|
|
}
|
|
|
|
if (!strcmp(key, "help")) {
|
|
print_help(options);
|
|
return -1;
|
|
}
|
|
|
|
int ret = parse_opt(options, key);
|
|
if (ret <= 0) {
|
|
E_LOG_ERROR(NULL, "Parsing '%s' returned '%d'.", argv[arg], ret);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
|
|
error:
|
|
return -1;
|
|
}
|