1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Amlogic Meson6 and Meson8 DWMAC glue layer
  4 *
  5 * Copyright (C) 2014 Beniamino Galvani <b.galvani@gmail.com>
  6 */
  7
  8#include <linux/device.h>
  9#include <linux/ethtool.h>
 10#include <linux/io.h>
 11#include <linux/ioport.h>
 12#include <linux/module.h>
 13#include <linux/platform_device.h>
 14#include <linux/stmmac.h>
 15
 16#include "stmmac_platform.h"
 17
 18#define ETHMAC_SPEED_100	BIT(1)
 19
 20struct meson_dwmac {
 21	struct device	*dev;
 22	void __iomem	*reg;
 23};
 24
 25static void meson6_dwmac_fix_mac_speed(void *priv, unsigned int speed)
 26{
 27	struct meson_dwmac *dwmac = priv;
 28	unsigned int val;
 29
 30	val = readl(dwmac->reg);
 31
 32	switch (speed) {
 33	case SPEED_10:
 34		val &= ~ETHMAC_SPEED_100;
 35		break;
 36	case SPEED_100:
 37		val |= ETHMAC_SPEED_100;
 38		break;
 39	}
 40
 41	writel(val, dwmac->reg);
 42}
 43
 44static int meson6_dwmac_probe(struct platform_device *pdev)
 45{
 46	struct plat_stmmacenet_data *plat_dat;
 47	struct stmmac_resources stmmac_res;
 48	struct meson_dwmac *dwmac;
 49	int ret;
 50
 51	ret = stmmac_get_platform_resources(pdev, &stmmac_res);
 52	if (ret)
 53		return ret;
 54
 55	plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac);
 56	if (IS_ERR(plat_dat))
 57		return PTR_ERR(plat_dat);
 58
 59	dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
 60	if (!dwmac) {
 61		ret = -ENOMEM;
 62		goto err_remove_config_dt;
 63	}
 64
 65	dwmac->reg = devm_platform_ioremap_resource(pdev, 1);
 66	if (IS_ERR(dwmac->reg)) {
 67		ret = PTR_ERR(dwmac->reg);
 68		goto err_remove_config_dt;
 69	}
 70
 71	plat_dat->bsp_priv = dwmac;
 72	plat_dat->fix_mac_speed = meson6_dwmac_fix_mac_speed;
 73
 74	ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
 75	if (ret)
 76		goto err_remove_config_dt;
 77
 78	return 0;
 79
 80err_remove_config_dt:
 81	stmmac_remove_config_dt(pdev, plat_dat);
 82
 83	return ret;
 84}
 85
 86static const struct of_device_id meson6_dwmac_match[] = {
 87	{ .compatible = "amlogic,meson6-dwmac" },
 88	{ }
 89};
 90MODULE_DEVICE_TABLE(of, meson6_dwmac_match);
 91
 92static struct platform_driver meson6_dwmac_driver = {
 93	.probe  = meson6_dwmac_probe,
 94	.remove = stmmac_pltfr_remove,
 95	.driver = {
 96		.name           = "meson6-dwmac",
 97		.pm		= &stmmac_pltfr_pm_ops,
 98		.of_match_table = meson6_dwmac_match,
 99	},
100};
101module_platform_driver(meson6_dwmac_driver);
102
103MODULE_AUTHOR("Beniamino Galvani <b.galvani@gmail.com>");
104MODULE_DESCRIPTION("Amlogic Meson6 and Meson8 DWMAC glue layer");
105MODULE_LICENSE("GPL v2");