95 lines
1.8 KiB
C
95 lines
1.8 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2018 Intel Corporation
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <kernel.h>
|
||
|
|
#include <pinmux.h>
|
||
|
|
#include <iomux.h>
|
||
|
|
|
||
|
|
static volatile u32_t *iomux_ctrl_regs = (volatile u32_t *)DT_PINMUX_BASE_ADDR;
|
||
|
|
|
||
|
|
static int pinmux_set(struct device *dev, u32_t pin, u32_t func)
|
||
|
|
{
|
||
|
|
u32_t lsb, msb;
|
||
|
|
u32_t index;
|
||
|
|
u32_t value;
|
||
|
|
u32_t mask;
|
||
|
|
|
||
|
|
/* retrieve control register index */
|
||
|
|
index = IOMUX_INDEX(pin);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* retrieve the least and most significant bit positions for
|
||
|
|
* the pin group
|
||
|
|
*/
|
||
|
|
lsb = IOMUX_LSB(pin);
|
||
|
|
msb = IOMUX_MSB(pin);
|
||
|
|
|
||
|
|
if ((index >= DT_PINMUX_CTRL_REG_COUNT) || (msb > 31) || (lsb > msb)) {
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
mask = BIT_MASK(msb - lsb + 1) << lsb;
|
||
|
|
value = (func << lsb) & mask;
|
||
|
|
|
||
|
|
iomux_ctrl_regs[index] = (iomux_ctrl_regs[index] & ~mask) | value;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int pinmux_get(struct device *dev, u32_t pin, u32_t *func)
|
||
|
|
{
|
||
|
|
u32_t lsb, msb;
|
||
|
|
u32_t index;
|
||
|
|
u32_t mask;
|
||
|
|
|
||
|
|
/* retrieve control register index */
|
||
|
|
index = IOMUX_INDEX(pin);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* retrieve the least and most significant bit positions for
|
||
|
|
* the pin group
|
||
|
|
*/
|
||
|
|
lsb = IOMUX_LSB(pin);
|
||
|
|
msb = IOMUX_MSB(pin);
|
||
|
|
|
||
|
|
if ((index >= DT_PINMUX_CTRL_REG_COUNT) || (msb > 31) || (lsb > msb) ||
|
||
|
|
(func == NULL)) {
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
mask = BIT_MASK(msb - lsb + 1);
|
||
|
|
|
||
|
|
*func = (iomux_ctrl_regs[index] >> lsb) & mask;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int pinmux_pullup(struct device *dev, u32_t pin, u8_t func)
|
||
|
|
{
|
||
|
|
return -ENOSYS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int pinmux_input(struct device *dev, u32_t pin, u8_t func)
|
||
|
|
{
|
||
|
|
return -ENOSYS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct pinmux_driver_api apis = {
|
||
|
|
.set = pinmux_set,
|
||
|
|
.get = pinmux_get,
|
||
|
|
.pullup = pinmux_pullup,
|
||
|
|
.input = pinmux_input
|
||
|
|
};
|
||
|
|
|
||
|
|
static int pinmux_init(struct device *device)
|
||
|
|
{
|
||
|
|
ARG_UNUSED(device);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
DEVICE_AND_API_INIT(pinmux, CONFIG_PINMUX_NAME, &pinmux_init, NULL, NULL,
|
||
|
|
PRE_KERNEL_1, CONFIG_PINMUX_INIT_PRIORITY, &apis);
|