blob: a1c4aa20a09de193bc907c4febc5e9dc0312e956 [file] [log] [blame] [edit]
/*
* Copyright (c) 2022 Henrik Brix Andersen <henrik@brixandersen.dk>
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/device.h>
#include <zephyr/drivers/syscon.h>
#include <zephyr/drivers/pinctrl.h>
#include <zephyr/kernel.h>
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(pinctrl_xlnx_zynq, CONFIG_PINCTRL_LOG_LEVEL);
#define DT_DRV_COMPAT xlnx_pinctrl_zynq
BUILD_ASSERT(DT_NUM_INST_STATUS_OKAY(DT_DRV_COMPAT) == 1,
"Unsupported number of instances");
/* Relative SLCR register offsets for use in asserts */
#define MIO_PIN_53_OFFSET 0x00d4
#define SD0_WP_CD_SEL_OFFSET 0x0130
#define SD1_WP_CD_SEL_OFFSET 0x0134
static const struct device *const slcr = DEVICE_DT_GET(DT_INST_PHANDLE(0, syscon));
static mm_reg_t base = DT_INST_REG_ADDR(0);
K_SEM_DEFINE(pinctrl_lock, 1, 1);
int pinctrl_configure_pins(const pinctrl_soc_pin_t *pins, uint8_t pin_cnt, uintptr_t reg)
{
uint16_t addr;
uint32_t val;
uint8_t i;
int err = 0;
ARG_UNUSED(reg);
if (!device_is_ready(slcr)) {
LOG_ERR("SLCR device not ready");
return -ENODEV;
}
/* Guard the read-modify-write operations */
k_sem_take(&pinctrl_lock, K_FOREVER);
for (i = 0; i < pin_cnt; i++) {
__ASSERT_NO_MSG(pins[i].offset <= MIO_PIN_53_OFFSET ||
pins[i].offset == SD0_WP_CD_SEL_OFFSET ||
pins[i].offset == SD1_WP_CD_SEL_OFFSET);
addr = base + pins[i].offset;
err = syscon_read_reg(slcr, addr, &val);
if (err != 0) {
LOG_ERR("failed to read SLCR addr 0x%04x (err %d)", addr, err);
break;
}
LOG_DBG("0x%04x: mask 0x%08x, val 0x%08x", addr, pins[i].mask, pins[i].val);
LOG_DBG("0x%04x r: 0x%08x", addr, val);
val &= ~(pins[i].mask);
val |= pins[i].val;
LOG_DBG("0x%04x w: 0x%08x", addr, val);
err = syscon_write_reg(slcr, addr, val);
if (err != 0) {
LOG_ERR("failed to write SLCR addr 0x%04x (err %d)", addr, err);
break;
}
}
k_sem_give(&pinctrl_lock);
return err;
}