You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
100 lines
2.4 KiB
100 lines
2.4 KiB
/* |
|
* Copyright (c) 2023-2024 Analog Devices, Inc. |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#include <zephyr/dt-bindings/pinctrl/max32-pinctrl.h> |
|
#include <zephyr/drivers/pinctrl.h> |
|
|
|
#include <gpio.h> |
|
|
|
#define ADI_MAX32_GET_PORT_ADDR_OR_NONE(nodelabel) \ |
|
IF_ENABLED(DT_NODE_EXISTS(DT_NODELABEL(nodelabel)), \ |
|
(DT_REG_ADDR(DT_NODELABEL(nodelabel)),)) |
|
|
|
/** GPIO port addresses */ |
|
static const uint32_t gpios[] = { |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio0) |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio1) |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio2) |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio3) |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio4) |
|
ADI_MAX32_GET_PORT_ADDR_OR_NONE(gpio5) |
|
}; |
|
|
|
static int pinctrl_configure_pin(pinctrl_soc_pin_t soc_pin) |
|
{ |
|
uint32_t port; |
|
uint32_t pin; |
|
uint32_t afx; |
|
int pincfg; |
|
mxc_gpio_cfg_t gpio_cfg; |
|
|
|
port = MAX32_PINMUX_PORT(soc_pin.pinmux); |
|
pin = MAX32_PINMUX_PIN(soc_pin.pinmux); |
|
afx = MAX32_PINMUX_MODE(soc_pin.pinmux); |
|
pincfg = soc_pin.pincfg; |
|
|
|
if (gpios[port] == 0) { |
|
return -EINVAL; |
|
} |
|
|
|
gpio_cfg.port = (mxc_gpio_regs_t *)gpios[port]; |
|
gpio_cfg.mask = BIT(pin); |
|
|
|
if (pincfg & BIT(MAX32_BIAS_PULL_UP_SHIFT)) { |
|
gpio_cfg.pad = MXC_GPIO_PAD_PULL_UP; |
|
} else if (pincfg & BIT(MAX32_BIAS_PULL_DOWN_SHIFT)) { |
|
gpio_cfg.pad = MXC_GPIO_PAD_PULL_DOWN; |
|
} else { |
|
gpio_cfg.pad = MXC_GPIO_PAD_NONE; |
|
} |
|
|
|
if (pincfg & BIT(MAX32_INPUT_ENABLE_SHIFT)) { |
|
gpio_cfg.func = MXC_GPIO_FUNC_IN; |
|
} else if (pincfg & BIT(MAX32_OUTPUT_ENABLE_SHIFT)) { |
|
gpio_cfg.func = MXC_GPIO_FUNC_OUT; |
|
} else { |
|
/* Add +1 to index match */ |
|
gpio_cfg.func = (mxc_gpio_func_t)(afx + 1); |
|
} |
|
|
|
if (pincfg & BIT(MAX32_POWER_SOURCE_SHIFT)) { |
|
gpio_cfg.vssel = MXC_GPIO_VSSEL_VDDIOH; |
|
} else { |
|
gpio_cfg.vssel = MXC_GPIO_VSSEL_VDDIO; |
|
} |
|
|
|
gpio_cfg.drvstr = (pincfg >> MAX32_DRV_STRENGTH_SHIFT) & MAX32_DRV_STRENGTH_MASK; |
|
|
|
if (MXC_GPIO_Config(&gpio_cfg) != 0) { |
|
return -ENOTSUP; |
|
} |
|
|
|
if (pincfg & BIT(MAX32_OUTPUT_ENABLE_SHIFT)) { |
|
if (pincfg & BIT(MAX32_OUTPUT_HIGH_SHIFT)) { |
|
MXC_GPIO_OutSet(gpio_cfg.port, BIT(pin)); |
|
} else { |
|
MXC_GPIO_OutClr(gpio_cfg.port, BIT(pin)); |
|
} |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
int pinctrl_configure_pins(const pinctrl_soc_pin_t *pins, uint8_t pin_cnt, uintptr_t reg) |
|
{ |
|
ARG_UNUSED(reg); |
|
|
|
int ret; |
|
|
|
for (uint8_t i = 0U; i < pin_cnt; i++) { |
|
ret = pinctrl_configure_pin(*pins++); |
|
if (ret) { |
|
return ret; |
|
} |
|
} |
|
|
|
return 0; |
|
}
|
|
|