78 lines
1.9 KiB
C
78 lines
1.9 KiB
C
/*
|
|
* 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 *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;
|
|
}
|