diff --git a/src/include/gpio.h b/src/include/gpio.h index e54b156ce7..7b64ebfe80 100644 --- a/src/include/gpio.h +++ b/src/include/gpio.h @@ -34,6 +34,15 @@ void gpio_input_pullup(gpio_t gpio); void gpio_input(gpio_t gpio); void gpio_output(gpio_t gpio, int value); +/* + * Read the value presented by the set of GPIOs, when each pin is interpreted + * as a base-2 digit (LOW = 0, HIGH = 1). + * + * gpio[]: pin positions to read. gpio[0] is less significant than gpio[1]. + * num_gpio: number of pins to read. + */ +int gpio_base2_value(gpio_t gpio[], int num_gpio); + /* * Read the value presented by the set of GPIOs, when each pin is interpreted * as a base-3 digit (LOW = 0, HIGH = 1, Z/floating = 2). diff --git a/src/lib/gpio.c b/src/lib/gpio.c index 3a646e0d1d..0875538bae 100644 --- a/src/lib/gpio.c +++ b/src/lib/gpio.c @@ -22,6 +22,18 @@ #include #include +int gpio_base2_value(gpio_t gpio[], int num_gpio) +{ + int i, result = 0; + + for (i = 0; i < num_gpio; i++) { + gpio_input(gpio[i]); + result |= gpio_get(gpio[i]) << i; + } + + return result; +} + int gpio_base3_value(gpio_t gpio[], int num_gpio) { /*