56 lines
1.5 KiB
C
56 lines
1.5 KiB
C
|
/*
|
||
|
|
* Copyright 2025 Arm Limited and/or its affiliates <open-source-office@arm.com>
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "zephyr/device.h"
|
||
|
|
#include "zephyr/drivers/gpio.h"
|
||
|
|
#include <zephyr/drivers/pinctrl.h>
|
||
|
|
#include <zephyr/devicetree/gpio.h>
|
||
|
|
#include <zephyr/drivers/gpio/gpio_cmsdk_ahb.h>
|
||
|
|
|
||
|
|
/**
|
||
|
|
* The ARM MPS2 Board has 4 GPIO controllers. These controllers
|
||
|
|
* are responsible for pin muxing, input/output, pull-up, etc.
|
||
|
|
*
|
||
|
|
* All GPIO controller pins are exposed via the following sequence of pin
|
||
|
|
* numbers:
|
||
|
|
* Pins 0 - 15 are for GPIO0
|
||
|
|
* Pins 16 - 31 are for GPIO1
|
||
|
|
* Pins 32 - 47 are for GPIO2
|
||
|
|
* Pins 48 - 51 are for GPIO3
|
||
|
|
*
|
||
|
|
* For the GPIO controllers configuration ARM MPS2 Board follows the
|
||
|
|
* Arduino compliant pin out.
|
||
|
|
*/
|
||
|
|
|
||
|
|
static const struct device *const gpio_ports[] = {
|
||
|
|
DEVICE_DT_GET_OR_NULL(DT_NODELABEL(gpio0)),
|
||
|
|
DEVICE_DT_GET_OR_NULL(DT_NODELABEL(gpio1)),
|
||
|
|
DEVICE_DT_GET_OR_NULL(DT_NODELABEL(gpio2)),
|
||
|
|
DEVICE_DT_GET_OR_NULL(DT_NODELABEL(gpio3)),
|
||
|
|
};
|
||
|
|
|
||
|
|
static int pinctrl_configure_pin(const pinctrl_soc_pin_t *pin)
|
||
|
|
{
|
||
|
|
uint32_t flags = pin->input_enable ? GPIO_INPUT : GPIO_OUTPUT;
|
||
|
|
|
||
|
|
/* Each gpio has 16 pins, so divide by 16 to get specific gpio*/
|
||
|
|
const struct device *gpio_dev = gpio_ports[pin->pin_num >> 4];
|
||
|
|
|
||
|
|
return cmsdk_ahb_gpio_config(gpio_dev, pin->pin_num % 16, flags);
|
||
|
|
}
|
||
|
|
|
||
|
|
int pinctrl_configure_pins(const pinctrl_soc_pin_t *pins, uint8_t pin_cnt, uintptr_t reg)
|
||
|
|
{
|
||
|
|
ARG_UNUSED(reg);
|
||
|
|
for (uint8_t i = 0U; i < pin_cnt; i++) {
|
||
|
|
if (pinctrl_configure_pin(pins++) == -ENOTSUP) {
|
||
|
|
return -ENOTSUP;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|