19efc9b2bSRusaimi Amira Ruslan // SPDX-License-Identifier: GPL-2.0 29efc9b2bSRusaimi Amira Ruslan /* Intel DWMAC platform driver 39efc9b2bSRusaimi Amira Ruslan * 49efc9b2bSRusaimi Amira Ruslan * Copyright(C) 2020 Intel Corporation 59efc9b2bSRusaimi Amira Ruslan */ 69efc9b2bSRusaimi Amira Ruslan 79efc9b2bSRusaimi Amira Ruslan #include <linux/ethtool.h> 89efc9b2bSRusaimi Amira Ruslan #include <linux/module.h> 99efc9b2bSRusaimi Amira Ruslan #include <linux/of.h> 109efc9b2bSRusaimi Amira Ruslan #include <linux/of_device.h> 119efc9b2bSRusaimi Amira Ruslan #include <linux/platform_device.h> 129efc9b2bSRusaimi Amira Ruslan #include <linux/stmmac.h> 139efc9b2bSRusaimi Amira Ruslan 149efc9b2bSRusaimi Amira Ruslan #include "stmmac.h" 159efc9b2bSRusaimi Amira Ruslan #include "stmmac_platform.h" 169efc9b2bSRusaimi Amira Ruslan 179efc9b2bSRusaimi Amira Ruslan struct intel_dwmac { 189efc9b2bSRusaimi Amira Ruslan struct device *dev; 199efc9b2bSRusaimi Amira Ruslan struct clk *tx_clk; 209efc9b2bSRusaimi Amira Ruslan const struct intel_dwmac_data *data; 219efc9b2bSRusaimi Amira Ruslan }; 229efc9b2bSRusaimi Amira Ruslan 239efc9b2bSRusaimi Amira Ruslan struct intel_dwmac_data { 249efc9b2bSRusaimi Amira Ruslan void (*fix_mac_speed)(void *priv, unsigned int speed); 259efc9b2bSRusaimi Amira Ruslan unsigned long ptp_ref_clk_rate; 269efc9b2bSRusaimi Amira Ruslan unsigned long tx_clk_rate; 279efc9b2bSRusaimi Amira Ruslan bool tx_clk_en; 289efc9b2bSRusaimi Amira Ruslan }; 299efc9b2bSRusaimi Amira Ruslan 309efc9b2bSRusaimi Amira Ruslan static void kmb_eth_fix_mac_speed(void *priv, unsigned int speed) 319efc9b2bSRusaimi Amira Ruslan { 329efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac = priv; 339efc9b2bSRusaimi Amira Ruslan unsigned long rate; 349efc9b2bSRusaimi Amira Ruslan int ret; 359efc9b2bSRusaimi Amira Ruslan 369efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(dwmac->tx_clk); 379efc9b2bSRusaimi Amira Ruslan 389efc9b2bSRusaimi Amira Ruslan switch (speed) { 399efc9b2bSRusaimi Amira Ruslan case SPEED_1000: 409efc9b2bSRusaimi Amira Ruslan rate = 125000000; 419efc9b2bSRusaimi Amira Ruslan break; 429efc9b2bSRusaimi Amira Ruslan 439efc9b2bSRusaimi Amira Ruslan case SPEED_100: 449efc9b2bSRusaimi Amira Ruslan rate = 25000000; 459efc9b2bSRusaimi Amira Ruslan break; 469efc9b2bSRusaimi Amira Ruslan 479efc9b2bSRusaimi Amira Ruslan case SPEED_10: 489efc9b2bSRusaimi Amira Ruslan rate = 2500000; 499efc9b2bSRusaimi Amira Ruslan break; 509efc9b2bSRusaimi Amira Ruslan 519efc9b2bSRusaimi Amira Ruslan default: 529efc9b2bSRusaimi Amira Ruslan dev_err(dwmac->dev, "Invalid speed\n"); 539efc9b2bSRusaimi Amira Ruslan break; 549efc9b2bSRusaimi Amira Ruslan } 559efc9b2bSRusaimi Amira Ruslan 569efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(dwmac->tx_clk, rate); 579efc9b2bSRusaimi Amira Ruslan if (ret) 589efc9b2bSRusaimi Amira Ruslan dev_err(dwmac->dev, "Failed to configure tx clock rate\n"); 599efc9b2bSRusaimi Amira Ruslan } 609efc9b2bSRusaimi Amira Ruslan 619efc9b2bSRusaimi Amira Ruslan static const struct intel_dwmac_data kmb_data = { 629efc9b2bSRusaimi Amira Ruslan .fix_mac_speed = kmb_eth_fix_mac_speed, 639efc9b2bSRusaimi Amira Ruslan .ptp_ref_clk_rate = 200000000, 649efc9b2bSRusaimi Amira Ruslan .tx_clk_rate = 125000000, 659efc9b2bSRusaimi Amira Ruslan .tx_clk_en = true, 669efc9b2bSRusaimi Amira Ruslan }; 679efc9b2bSRusaimi Amira Ruslan 689efc9b2bSRusaimi Amira Ruslan static const struct of_device_id intel_eth_plat_match[] = { 699efc9b2bSRusaimi Amira Ruslan { .compatible = "intel,keembay-dwmac", .data = &kmb_data }, 709efc9b2bSRusaimi Amira Ruslan { } 719efc9b2bSRusaimi Amira Ruslan }; 729efc9b2bSRusaimi Amira Ruslan MODULE_DEVICE_TABLE(of, intel_eth_plat_match); 739efc9b2bSRusaimi Amira Ruslan 749efc9b2bSRusaimi Amira Ruslan static int intel_eth_plat_probe(struct platform_device *pdev) 759efc9b2bSRusaimi Amira Ruslan { 769efc9b2bSRusaimi Amira Ruslan struct net_device *ndev = platform_get_drvdata(pdev); 779efc9b2bSRusaimi Amira Ruslan struct stmmac_priv *priv = netdev_priv(ndev); 789efc9b2bSRusaimi Amira Ruslan struct plat_stmmacenet_data *plat_dat; 799efc9b2bSRusaimi Amira Ruslan struct stmmac_resources stmmac_res; 809efc9b2bSRusaimi Amira Ruslan const struct of_device_id *match; 819efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac; 829efc9b2bSRusaimi Amira Ruslan unsigned long rate; 839efc9b2bSRusaimi Amira Ruslan int ret; 849efc9b2bSRusaimi Amira Ruslan 859efc9b2bSRusaimi Amira Ruslan plat_dat = priv->plat; 869efc9b2bSRusaimi Amira Ruslan ret = stmmac_get_platform_resources(pdev, &stmmac_res); 879efc9b2bSRusaimi Amira Ruslan if (ret) 889efc9b2bSRusaimi Amira Ruslan return ret; 899efc9b2bSRusaimi Amira Ruslan 909efc9b2bSRusaimi Amira Ruslan plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac); 919efc9b2bSRusaimi Amira Ruslan if (IS_ERR(plat_dat)) { 929efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, "dt configuration failed\n"); 939efc9b2bSRusaimi Amira Ruslan return PTR_ERR(plat_dat); 949efc9b2bSRusaimi Amira Ruslan } 959efc9b2bSRusaimi Amira Ruslan 969efc9b2bSRusaimi Amira Ruslan dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); 979efc9b2bSRusaimi Amira Ruslan if (!dwmac) { 989efc9b2bSRusaimi Amira Ruslan ret = -ENOMEM; 999efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 1009efc9b2bSRusaimi Amira Ruslan } 1019efc9b2bSRusaimi Amira Ruslan 1029efc9b2bSRusaimi Amira Ruslan dwmac->dev = &pdev->dev; 1039efc9b2bSRusaimi Amira Ruslan dwmac->tx_clk = NULL; 1049efc9b2bSRusaimi Amira Ruslan 1059efc9b2bSRusaimi Amira Ruslan match = of_match_device(intel_eth_plat_match, &pdev->dev); 1069efc9b2bSRusaimi Amira Ruslan if (match && match->data) { 1079efc9b2bSRusaimi Amira Ruslan dwmac->data = (const struct intel_dwmac_data *)match->data; 1089efc9b2bSRusaimi Amira Ruslan 1099efc9b2bSRusaimi Amira Ruslan if (dwmac->data->fix_mac_speed) 1109efc9b2bSRusaimi Amira Ruslan plat_dat->fix_mac_speed = dwmac->data->fix_mac_speed; 1119efc9b2bSRusaimi Amira Ruslan 1129efc9b2bSRusaimi Amira Ruslan /* Enable TX clock */ 1139efc9b2bSRusaimi Amira Ruslan if (dwmac->data->tx_clk_en) { 1149efc9b2bSRusaimi Amira Ruslan dwmac->tx_clk = devm_clk_get(&pdev->dev, "tx_clk"); 1159efc9b2bSRusaimi Amira Ruslan if (IS_ERR(dwmac->tx_clk)) 1169efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 1179efc9b2bSRusaimi Amira Ruslan 1189efc9b2bSRusaimi Amira Ruslan clk_prepare_enable(dwmac->tx_clk); 1199efc9b2bSRusaimi Amira Ruslan 1209efc9b2bSRusaimi Amira Ruslan /* Check and configure TX clock rate */ 1219efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(dwmac->tx_clk); 1229efc9b2bSRusaimi Amira Ruslan if (dwmac->data->tx_clk_rate && 1239efc9b2bSRusaimi Amira Ruslan rate != dwmac->data->tx_clk_rate) { 1249efc9b2bSRusaimi Amira Ruslan rate = dwmac->data->tx_clk_rate; 1259efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(dwmac->tx_clk, rate); 1269efc9b2bSRusaimi Amira Ruslan if (ret) { 1279efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, 1289efc9b2bSRusaimi Amira Ruslan "Failed to set tx_clk\n"); 1299efc9b2bSRusaimi Amira Ruslan return ret; 1309efc9b2bSRusaimi Amira Ruslan } 1319efc9b2bSRusaimi Amira Ruslan } 1329efc9b2bSRusaimi Amira Ruslan } 1339efc9b2bSRusaimi Amira Ruslan 1349efc9b2bSRusaimi Amira Ruslan /* Check and configure PTP ref clock rate */ 1359efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(plat_dat->clk_ptp_ref); 1369efc9b2bSRusaimi Amira Ruslan if (dwmac->data->ptp_ref_clk_rate && 1379efc9b2bSRusaimi Amira Ruslan rate != dwmac->data->ptp_ref_clk_rate) { 1389efc9b2bSRusaimi Amira Ruslan rate = dwmac->data->ptp_ref_clk_rate; 1399efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(plat_dat->clk_ptp_ref, rate); 1409efc9b2bSRusaimi Amira Ruslan if (ret) { 1419efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, 1429efc9b2bSRusaimi Amira Ruslan "Failed to set clk_ptp_ref\n"); 1439efc9b2bSRusaimi Amira Ruslan return ret; 1449efc9b2bSRusaimi Amira Ruslan } 1459efc9b2bSRusaimi Amira Ruslan } 1469efc9b2bSRusaimi Amira Ruslan } 1479efc9b2bSRusaimi Amira Ruslan 1489efc9b2bSRusaimi Amira Ruslan plat_dat->bsp_priv = dwmac; 1499efc9b2bSRusaimi Amira Ruslan 1509efc9b2bSRusaimi Amira Ruslan ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); 1519efc9b2bSRusaimi Amira Ruslan if (ret) { 1529efc9b2bSRusaimi Amira Ruslan if (dwmac->tx_clk) 1539efc9b2bSRusaimi Amira Ruslan clk_disable_unprepare(dwmac->tx_clk); 1549efc9b2bSRusaimi Amira Ruslan 1559efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 1569efc9b2bSRusaimi Amira Ruslan } 1579efc9b2bSRusaimi Amira Ruslan 1589efc9b2bSRusaimi Amira Ruslan return 0; 1599efc9b2bSRusaimi Amira Ruslan 1609efc9b2bSRusaimi Amira Ruslan err_remove_config_dt: 1619efc9b2bSRusaimi Amira Ruslan stmmac_remove_config_dt(pdev, plat_dat); 1629efc9b2bSRusaimi Amira Ruslan 1639efc9b2bSRusaimi Amira Ruslan return ret; 1649efc9b2bSRusaimi Amira Ruslan } 1659efc9b2bSRusaimi Amira Ruslan 1669efc9b2bSRusaimi Amira Ruslan static int intel_eth_plat_remove(struct platform_device *pdev) 1679efc9b2bSRusaimi Amira Ruslan { 1689efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac = get_stmmac_bsp_priv(&pdev->dev); 1699efc9b2bSRusaimi Amira Ruslan int ret; 1709efc9b2bSRusaimi Amira Ruslan 1719efc9b2bSRusaimi Amira Ruslan ret = stmmac_pltfr_remove(pdev); 1729efc9b2bSRusaimi Amira Ruslan 1739efc9b2bSRusaimi Amira Ruslan if (dwmac->tx_clk) 1749efc9b2bSRusaimi Amira Ruslan clk_disable_unprepare(dwmac->tx_clk); 1759efc9b2bSRusaimi Amira Ruslan 1769efc9b2bSRusaimi Amira Ruslan return ret; 1779efc9b2bSRusaimi Amira Ruslan } 1789efc9b2bSRusaimi Amira Ruslan 1799efc9b2bSRusaimi Amira Ruslan static struct platform_driver intel_eth_plat_driver = { 1809efc9b2bSRusaimi Amira Ruslan .probe = intel_eth_plat_probe, 1819efc9b2bSRusaimi Amira Ruslan .remove = intel_eth_plat_remove, 1829efc9b2bSRusaimi Amira Ruslan .driver = { 1839efc9b2bSRusaimi Amira Ruslan .name = "intel-eth-plat", 1849efc9b2bSRusaimi Amira Ruslan .pm = &stmmac_pltfr_pm_ops, 1859efc9b2bSRusaimi Amira Ruslan .of_match_table = intel_eth_plat_match, 1869efc9b2bSRusaimi Amira Ruslan }, 1879efc9b2bSRusaimi Amira Ruslan }; 1889efc9b2bSRusaimi Amira Ruslan module_platform_driver(intel_eth_plat_driver); 1899efc9b2bSRusaimi Amira Ruslan 1909efc9b2bSRusaimi Amira Ruslan MODULE_LICENSE("GPL v2"); 1919efc9b2bSRusaimi Amira Ruslan MODULE_DESCRIPTION("Intel DWMAC platform driver"); 192