coreboot-kgpe-d16/src/lib/gpio.c

182 lines
4.8 KiB
C

/* SPDX-License-Identifier: GPL-2.0-only */
#include <base3.h>
#include <console/console.h>
#include <delay.h>
#include <gpio.h>
static void _check_num(const char *name, int num)
{
if ((num > 31) || (num < 1)) {
printk(BIOS_EMERG, "%s: %d ", name, num);
die("is an invalid number of GPIOs");
}
}
static uint32_t _gpio_base2_value(const gpio_t gpio[], int num_gpio)
{
uint32_t result = 0;
int i;
/* Wait until signals become stable */
udelay(10);
for (i = 0; i < num_gpio; i++)
result |= gpio_get(gpio[i]) << i;
return result;
}
uint32_t gpio_base2_value(const gpio_t gpio[], int num_gpio)
{
int i;
_check_num(__func__, num_gpio);
for (i = 0; i < num_gpio; i++)
gpio_input(gpio[i]);
return _gpio_base2_value(gpio, num_gpio);
}
uint32_t gpio_pulldown_base2_value(const gpio_t gpio[], int num_gpio)
{
int i;
_check_num(__func__, num_gpio);
for (i = 0; i < num_gpio; i++)
gpio_input_pulldown(gpio[i]);
return _gpio_base2_value(gpio, num_gpio);
}
uint32_t gpio_pullup_base2_value(const gpio_t gpio[], int num_gpio)
{
int i;
_check_num(__func__, num_gpio);
for (i = 0; i < num_gpio; i++)
gpio_input_pullup(gpio[i]);
return _gpio_base2_value(gpio, num_gpio);
}
uint32_t _gpio_base3_value(const gpio_t gpio[], int num_gpio, int binary_first)
{
/*
* GPIOs which are tied to stronger external pull up or pull down
* will stay there regardless of the internal pull up or pull
* down setting.
*
* GPIOs which are floating will go to whatever level they're
* internally pulled to.
*/
static const char tristate_char[] = {[0] = '0', [1] = '1', [Z] = 'Z'};
uint32_t result = 0;
int has_z = 0;
int binary_below = 0;
int index;
int temp;
char value[32];
_check_num(__func__, num_gpio);
/* Enable internal pull up */
for (index = 0; index < num_gpio; ++index)
gpio_input_pullup(gpio[index]);
/* Wait until signals become stable */
udelay(10);
/* Get gpio values at internal pull up */
for (index = 0; index < num_gpio; ++index)
value[index] = gpio_get(gpio[index]);
/* Enable internal pull down */
for (index = 0; index < num_gpio; ++index)
gpio_input_pulldown(gpio[index]);
/* Wait until signals become stable */
udelay(10);
/*
* Get gpio values at internal pull down.
* Compare with gpio pull up value and then
* determine a gpio final value/state:
* 0: pull down
* 1: pull up
* 2: floating
*/
printk(BIOS_DEBUG, "Reading tristate GPIOs: ");
for (index = num_gpio - 1; index >= 0; --index) {
temp = gpio_get(gpio[index]);
temp |= ((value[index] ^ temp) << 1);
printk(BIOS_DEBUG, "%c ", tristate_char[temp]);
result = (result * 3) + temp;
/* Disable pull to avoid wasting power. For HiZ we leave the
pull-down enabled, since letting them float freely back and
forth may waste power in the SoC's GPIO input logic. */
if (temp != Z)
gpio_input(gpio[index]);
/*
* For binary_first we keep track of the normal ternary result
* and whether we found any pin that was a Z. We also determine
* the amount of numbers that can be represented with only
* binary digits (no Z) whose value in the normal ternary system
* is lower than the one we are parsing. Counting from the left,
* we add 2^i for any '1' digit to account for the binary
* numbers whose values would be below it if all following
* digits we parsed would be '0'. As soon as we find a '2' digit
* we can total the remaining binary numbers below as 2^(i+1)
* because we know that all binary representations counting only
* this and following digits must have values below our number
* (since 1xxx is always smaller than 2xxx).
*
* Example: 1 0 2 1 (counting from the left / most significant)
* '1' at 3^3: Add 2^3 = 8 to account for binaries 0000-0111
* '0' at 3^2: Ignore (not all binaries 1000-1100 are below us)
* '2' at 3^1: Add 2^(1+1) = 4 to account for binaries 1000-1011
* Stop adding for lower digits (3^0), all already accounted
* now. We know that there can be no binary numbers 1020-102X.
*/
if (binary_first && !has_z) {
switch (temp) {
case 0: /* Ignore '0' digits. */
break;
case 1: /* Account for binaries 0 to 2^index - 1. */
binary_below += 1 << index;
break;
case 2: /* Account for binaries 0 to 2^(index+1) - 1. */
binary_below += 1 << (index + 1);
has_z = 1;
}
}
}
if (binary_first) {
if (has_z)
result = result + (1 << num_gpio) - binary_below;
else /* binary_below is normal binary system value if !has_z. */
result = binary_below;
}
printk(BIOS_DEBUG, "= %d (%s base3 number system)\n", result,
binary_first ? "binary_first" : "standard");
return result;
}
/* Default handler for ACPI path is to return NULL */
__weak const char *gpio_acpi_path(gpio_t gpio)
{
return NULL;
}
/* Default handler returns 0 because type of gpio_t is unknown */
__weak uint16_t gpio_acpi_pin(gpio_t gpio)
{
return 0;
}