drivers: mdio: add stm32 mdio support

MDIO is part of the ETH IP, but some phy chip may need a
specific phy driver to set up certain vendor registers enabling
particular features.

Add support for stm32 mdio access.

Signed-off-by: Angelo Dureghello <adureghello@baylibre.com>
This commit is contained in:
Angelo Dureghello 2024-03-22 23:23:31 +01:00 committed by Alberto Escolar
commit fe29929c91
5 changed files with 160 additions and 0 deletions

View file

@ -10,5 +10,6 @@ zephyr_library_sources_ifdef(CONFIG_MDIO_NXP_S32_GMAC mdio_nxp_s32_gmac.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_ADIN2111 mdio_adin2111.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_GPIO mdio_gpio.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_NXP_ENET mdio_nxp_enet.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_ST_STM32_HAL mdio_stm32_hal.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_INFINEON_XMC4XXX mdio_xmc4xxx.c)
zephyr_library_sources_ifdef(CONFIG_MDIO_NXP_ENET_QOS mdio_nxp_enet_qos.c)

View file

@ -31,6 +31,7 @@ source "drivers/mdio/Kconfig.nxp_s32_gmac"
source "drivers/mdio/Kconfig.adin2111"
source "drivers/mdio/Kconfig.gpio"
source "drivers/mdio/Kconfig.nxp_enet"
source "drivers/mdio/Kconfig.stm32_hal"
source "drivers/mdio/Kconfig.xmc4xxx"
source "drivers/mdio/Kconfig.nxp_enet_qos"

View file

@ -0,0 +1,11 @@
# Copyright (c) 2024 BayLibre, SAS
# Copyright (c) 2024 Analog Devices Inc.
# SPDX-License-Identifier: Apache-2.0
config MDIO_ST_STM32_HAL
bool "STM32 MDIO controller driver"
default y
depends on ETH_STM32_HAL_API_V2
depends on DT_HAS_ST_STM32_MDIO_ENABLED
help
Enable STM32 MDIO support.

View file

@ -0,0 +1,123 @@
/*
* Copyright (c) 2024 BayLibre, SAS
* Copyright (c) 2024 Analog Devices Inc.
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <stdint.h>
#include <errno.h>
#include <zephyr/device.h>
#include <zephyr/kernel.h>
#include <zephyr/drivers/pinctrl.h>
#include <zephyr/drivers/mdio.h>
#include <zephyr/net/ethernet.h>
#include <zephyr/net/mdio.h>
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(mdio_stm32_hal, CONFIG_MDIO_LOG_LEVEL);
#define DT_DRV_COMPAT st_stm32_mdio
#define ADIN1100_REG_VALUE_MASK GENMASK(15, 0)
struct mdio_stm32_data {
struct k_sem sem;
ETH_HandleTypeDef heth;
};
struct mdio_stm32_config {
const struct pinctrl_dev_config *pincfg;
};
static int mdio_stm32_read(const struct device *dev, uint8_t prtad,
uint8_t regad, uint16_t *data)
{
struct mdio_stm32_data *const dev_data = dev->data;
ETH_HandleTypeDef *heth = &dev_data->heth;
uint32_t read;
int ret;
k_sem_take(&dev_data->sem, K_FOREVER);
ret = HAL_ETH_ReadPHYRegister(heth, prtad, regad, &read);
k_sem_give(&dev_data->sem);
if (ret != HAL_OK) {
return -EIO;
}
*data = read & ADIN1100_REG_VALUE_MASK;
return ret;
}
static int mdio_stm32_write(const struct device *dev, uint8_t prtad,
uint8_t regad, uint16_t data)
{
struct mdio_stm32_data *const dev_data = dev->data;
ETH_HandleTypeDef *heth = &dev_data->heth;
int ret;
k_sem_take(&dev_data->sem, K_FOREVER);
ret = HAL_ETH_WritePHYRegister(heth, prtad, regad, data);
k_sem_give(&dev_data->sem);
if (ret != HAL_OK) {
return -EIO;
}
return ret;
}
static void mdio_stm32_bus_enable(const struct device *dev)
{
ARG_UNUSED(dev);
}
static void mdio_stm32_bus_disable(const struct device *dev)
{
ARG_UNUSED(dev);
}
static int mdio_stm32_init(const struct device *dev)
{
struct mdio_stm32_data *const dev_data = dev->data;
const struct mdio_stm32_config *const config = dev->config;
int ret;
ret = pinctrl_apply_state(config->pincfg, PINCTRL_STATE_DEFAULT);
if (ret < 0) {
return ret;
}
k_sem_init(&dev_data->sem, 1, 1);
return 0;
}
static const struct mdio_driver_api mdio_stm32_api = {
.read = mdio_stm32_read,
.write = mdio_stm32_write,
.bus_enable = mdio_stm32_bus_enable,
.bus_disable = mdio_stm32_bus_disable,
};
#define MDIO_STM32_HAL_DEVICE(inst) \
PINCTRL_DT_INST_DEFINE(inst); \
\
static struct mdio_stm32_data mdio_stm32_data_##inst = { \
.heth = {.Instance = (ETH_TypeDef *)DT_REG_ADDR(DT_INST_PARENT(inst))}, \
}; \
static struct mdio_stm32_config mdio_stm32_config_##inst = { \
.pincfg = PINCTRL_DT_INST_DEV_CONFIG_GET(inst), \
}; \
DEVICE_DT_INST_DEFINE(inst, &mdio_stm32_init, NULL, \
&mdio_stm32_data_##inst, &mdio_stm32_config_##inst, \
POST_KERNEL, CONFIG_ETH_INIT_PRIORITY, \
&mdio_stm32_api);
DT_INST_FOREACH_STATUS_OKAY(MDIO_STM32_HAL_DEVICE)

View file

@ -0,0 +1,24 @@
# Copyright (c) 2024 BayLibre, SAS
# Copyright (c) 2024 Analog Devices Inc.
# SPDX-License-Identifier: Apache-2.0
description: ST MDIO Features
compatible: "st,stm32-mdio"
include: [mdio-controller.yaml, pinctrl-device.yaml]
properties:
"#address-cells":
required: true
const: 1
"#size-cells":
required: true
const: 0
pinctrl-0:
required: true
pinctrl-names:
required: true