Add pinctrl driver for Realtek RTS5912. Signed-off-by: Lin Yu-Cheng <lin_yu_cheng@realtek.com>
38 lines
1.2 KiB
C
38 lines
1.2 KiB
C
/*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Copyright (c) 2024 Realtek Semiconductor Corporation, SIBG-SD7
|
|
* Author: Lin Yu-Cheng <lin_yu_cheng@realtek.com>
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT realtek_rts5912_pinctrl
|
|
|
|
#include <zephyr/drivers/pinctrl.h>
|
|
#include <zephyr/dt-bindings/pinctrl/realtek-rts5912-pinctrl.h>
|
|
|
|
#include <reg/reg_gpio.h>
|
|
|
|
#define REALTEK_RTS5912_PINMUX_GET_GPIO_PIN(n) \
|
|
(((((n) >> REALTEK_RTS5912_GPIO_LOW_POS) & REALTEK_RTS5912_GPIO_LOW_MSK)) | \
|
|
(((((n) >> REALTEK_RTS5912_GPIO_HIGH_POS) & REALTEK_RTS5912_GPIO_HIGH_MSK)) << 5))
|
|
|
|
#define PURE_PINMUX_MASK (GENMASK(31, 24) | GENMASK(17, 8) | GENMASK(2, 0))
|
|
#define REALTEK_RTS5912_GET_PURE_PINMUX(n) (n & PURE_PINMUX_MASK)
|
|
|
|
static volatile GPIO_Type *pinctrl_base =
|
|
(volatile GPIO_Type *)(DT_REG_ADDR(DT_NODELABEL(pinctrl)));
|
|
|
|
int pinctrl_configure_pins(const pinctrl_soc_pin_t *pins, uint8_t pin_cnt, uintptr_t reg)
|
|
{
|
|
ARG_UNUSED(reg);
|
|
uint32_t pin, pinmux, func;
|
|
|
|
for (uint8_t i = 0U; i < pin_cnt; i++) {
|
|
pinmux = (uint32_t)pins[i];
|
|
pin = REALTEK_RTS5912_PINMUX_GET_GPIO_PIN(pinmux);
|
|
func = REALTEK_RTS5912_GET_PURE_PINMUX(pinmux);
|
|
pinctrl_base->GCR[pin] = func;
|
|
}
|
|
|
|
return 0;
|
|
}
|