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 14b4c5f83aSRusaimi Amira Ruslan #include "dwmac4.h" 159efc9b2bSRusaimi Amira Ruslan #include "stmmac.h" 169efc9b2bSRusaimi Amira Ruslan #include "stmmac_platform.h" 179efc9b2bSRusaimi Amira Ruslan 189efc9b2bSRusaimi Amira Ruslan struct intel_dwmac { 199efc9b2bSRusaimi Amira Ruslan struct device *dev; 209efc9b2bSRusaimi Amira Ruslan struct clk *tx_clk; 219efc9b2bSRusaimi Amira Ruslan const struct intel_dwmac_data *data; 229efc9b2bSRusaimi Amira Ruslan }; 239efc9b2bSRusaimi Amira Ruslan 249efc9b2bSRusaimi Amira Ruslan struct intel_dwmac_data { 259efc9b2bSRusaimi Amira Ruslan void (*fix_mac_speed)(void *priv, unsigned int speed); 269efc9b2bSRusaimi Amira Ruslan unsigned long ptp_ref_clk_rate; 279efc9b2bSRusaimi Amira Ruslan unsigned long tx_clk_rate; 289efc9b2bSRusaimi Amira Ruslan bool tx_clk_en; 299efc9b2bSRusaimi Amira Ruslan }; 309efc9b2bSRusaimi Amira Ruslan 319efc9b2bSRusaimi Amira Ruslan static void kmb_eth_fix_mac_speed(void *priv, unsigned int speed) 329efc9b2bSRusaimi Amira Ruslan { 339efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac = priv; 349efc9b2bSRusaimi Amira Ruslan unsigned long rate; 359efc9b2bSRusaimi Amira Ruslan int ret; 369efc9b2bSRusaimi Amira Ruslan 379efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(dwmac->tx_clk); 389efc9b2bSRusaimi Amira Ruslan 399efc9b2bSRusaimi Amira Ruslan switch (speed) { 409efc9b2bSRusaimi Amira Ruslan case SPEED_1000: 419efc9b2bSRusaimi Amira Ruslan rate = 125000000; 429efc9b2bSRusaimi Amira Ruslan break; 439efc9b2bSRusaimi Amira Ruslan 449efc9b2bSRusaimi Amira Ruslan case SPEED_100: 459efc9b2bSRusaimi Amira Ruslan rate = 25000000; 469efc9b2bSRusaimi Amira Ruslan break; 479efc9b2bSRusaimi Amira Ruslan 489efc9b2bSRusaimi Amira Ruslan case SPEED_10: 499efc9b2bSRusaimi Amira Ruslan rate = 2500000; 509efc9b2bSRusaimi Amira Ruslan break; 519efc9b2bSRusaimi Amira Ruslan 529efc9b2bSRusaimi Amira Ruslan default: 539efc9b2bSRusaimi Amira Ruslan dev_err(dwmac->dev, "Invalid speed\n"); 549efc9b2bSRusaimi Amira Ruslan break; 559efc9b2bSRusaimi Amira Ruslan } 569efc9b2bSRusaimi Amira Ruslan 579efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(dwmac->tx_clk, rate); 589efc9b2bSRusaimi Amira Ruslan if (ret) 599efc9b2bSRusaimi Amira Ruslan dev_err(dwmac->dev, "Failed to configure tx clock rate\n"); 609efc9b2bSRusaimi Amira Ruslan } 619efc9b2bSRusaimi Amira Ruslan 629efc9b2bSRusaimi Amira Ruslan static const struct intel_dwmac_data kmb_data = { 639efc9b2bSRusaimi Amira Ruslan .fix_mac_speed = kmb_eth_fix_mac_speed, 649efc9b2bSRusaimi Amira Ruslan .ptp_ref_clk_rate = 200000000, 659efc9b2bSRusaimi Amira Ruslan .tx_clk_rate = 125000000, 669efc9b2bSRusaimi Amira Ruslan .tx_clk_en = true, 679efc9b2bSRusaimi Amira Ruslan }; 689efc9b2bSRusaimi Amira Ruslan 699efc9b2bSRusaimi Amira Ruslan static const struct of_device_id intel_eth_plat_match[] = { 709efc9b2bSRusaimi Amira Ruslan { .compatible = "intel,keembay-dwmac", .data = &kmb_data }, 719efc9b2bSRusaimi Amira Ruslan { } 729efc9b2bSRusaimi Amira Ruslan }; 739efc9b2bSRusaimi Amira Ruslan MODULE_DEVICE_TABLE(of, intel_eth_plat_match); 749efc9b2bSRusaimi Amira Ruslan 759efc9b2bSRusaimi Amira Ruslan static int intel_eth_plat_probe(struct platform_device *pdev) 769efc9b2bSRusaimi Amira Ruslan { 779efc9b2bSRusaimi Amira Ruslan struct net_device *ndev = platform_get_drvdata(pdev); 789efc9b2bSRusaimi Amira Ruslan struct stmmac_priv *priv = netdev_priv(ndev); 799efc9b2bSRusaimi Amira Ruslan struct plat_stmmacenet_data *plat_dat; 809efc9b2bSRusaimi Amira Ruslan struct stmmac_resources stmmac_res; 819efc9b2bSRusaimi Amira Ruslan const struct of_device_id *match; 829efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac; 839efc9b2bSRusaimi Amira Ruslan unsigned long rate; 849efc9b2bSRusaimi Amira Ruslan int ret; 859efc9b2bSRusaimi Amira Ruslan 869efc9b2bSRusaimi Amira Ruslan plat_dat = priv->plat; 879efc9b2bSRusaimi Amira Ruslan ret = stmmac_get_platform_resources(pdev, &stmmac_res); 889efc9b2bSRusaimi Amira Ruslan if (ret) 899efc9b2bSRusaimi Amira Ruslan return ret; 909efc9b2bSRusaimi Amira Ruslan 919efc9b2bSRusaimi Amira Ruslan plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac); 929efc9b2bSRusaimi Amira Ruslan if (IS_ERR(plat_dat)) { 939efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, "dt configuration failed\n"); 949efc9b2bSRusaimi Amira Ruslan return PTR_ERR(plat_dat); 959efc9b2bSRusaimi Amira Ruslan } 969efc9b2bSRusaimi Amira Ruslan 979efc9b2bSRusaimi Amira Ruslan dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); 989efc9b2bSRusaimi Amira Ruslan if (!dwmac) { 999efc9b2bSRusaimi Amira Ruslan ret = -ENOMEM; 1009efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 1019efc9b2bSRusaimi Amira Ruslan } 1029efc9b2bSRusaimi Amira Ruslan 1039efc9b2bSRusaimi Amira Ruslan dwmac->dev = &pdev->dev; 1049efc9b2bSRusaimi Amira Ruslan dwmac->tx_clk = NULL; 1059efc9b2bSRusaimi Amira Ruslan 1069efc9b2bSRusaimi Amira Ruslan match = of_match_device(intel_eth_plat_match, &pdev->dev); 1079efc9b2bSRusaimi Amira Ruslan if (match && match->data) { 1089efc9b2bSRusaimi Amira Ruslan dwmac->data = (const struct intel_dwmac_data *)match->data; 1099efc9b2bSRusaimi Amira Ruslan 1109efc9b2bSRusaimi Amira Ruslan if (dwmac->data->fix_mac_speed) 1119efc9b2bSRusaimi Amira Ruslan plat_dat->fix_mac_speed = dwmac->data->fix_mac_speed; 1129efc9b2bSRusaimi Amira Ruslan 1139efc9b2bSRusaimi Amira Ruslan /* Enable TX clock */ 1149efc9b2bSRusaimi Amira Ruslan if (dwmac->data->tx_clk_en) { 1159efc9b2bSRusaimi Amira Ruslan dwmac->tx_clk = devm_clk_get(&pdev->dev, "tx_clk"); 116661710bfSZhang Changzhong if (IS_ERR(dwmac->tx_clk)) { 117661710bfSZhang Changzhong ret = PTR_ERR(dwmac->tx_clk); 1189efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 119661710bfSZhang Changzhong } 1209efc9b2bSRusaimi Amira Ruslan 1219efc9b2bSRusaimi Amira Ruslan clk_prepare_enable(dwmac->tx_clk); 1229efc9b2bSRusaimi Amira Ruslan 1239efc9b2bSRusaimi Amira Ruslan /* Check and configure TX clock rate */ 1249efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(dwmac->tx_clk); 1259efc9b2bSRusaimi Amira Ruslan if (dwmac->data->tx_clk_rate && 1269efc9b2bSRusaimi Amira Ruslan rate != dwmac->data->tx_clk_rate) { 1279efc9b2bSRusaimi Amira Ruslan rate = dwmac->data->tx_clk_rate; 1289efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(dwmac->tx_clk, rate); 1299efc9b2bSRusaimi Amira Ruslan if (ret) { 1309efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, 1319efc9b2bSRusaimi Amira Ruslan "Failed to set tx_clk\n"); 132*3765d86fSPan Bian goto err_remove_config_dt; 1339efc9b2bSRusaimi Amira Ruslan } 1349efc9b2bSRusaimi Amira Ruslan } 1359efc9b2bSRusaimi Amira Ruslan } 1369efc9b2bSRusaimi Amira Ruslan 1379efc9b2bSRusaimi Amira Ruslan /* Check and configure PTP ref clock rate */ 1389efc9b2bSRusaimi Amira Ruslan rate = clk_get_rate(plat_dat->clk_ptp_ref); 1399efc9b2bSRusaimi Amira Ruslan if (dwmac->data->ptp_ref_clk_rate && 1409efc9b2bSRusaimi Amira Ruslan rate != dwmac->data->ptp_ref_clk_rate) { 1419efc9b2bSRusaimi Amira Ruslan rate = dwmac->data->ptp_ref_clk_rate; 1429efc9b2bSRusaimi Amira Ruslan ret = clk_set_rate(plat_dat->clk_ptp_ref, rate); 1439efc9b2bSRusaimi Amira Ruslan if (ret) { 1449efc9b2bSRusaimi Amira Ruslan dev_err(&pdev->dev, 1459efc9b2bSRusaimi Amira Ruslan "Failed to set clk_ptp_ref\n"); 146*3765d86fSPan Bian goto err_remove_config_dt; 1479efc9b2bSRusaimi Amira Ruslan } 1489efc9b2bSRusaimi Amira Ruslan } 1499efc9b2bSRusaimi Amira Ruslan } 1509efc9b2bSRusaimi Amira Ruslan 1519efc9b2bSRusaimi Amira Ruslan plat_dat->bsp_priv = dwmac; 152b4c5f83aSRusaimi Amira Ruslan plat_dat->eee_usecs_rate = plat_dat->clk_ptp_rate; 153b4c5f83aSRusaimi Amira Ruslan 154b4c5f83aSRusaimi Amira Ruslan if (plat_dat->eee_usecs_rate > 0) { 155b4c5f83aSRusaimi Amira Ruslan u32 tx_lpi_usec; 156b4c5f83aSRusaimi Amira Ruslan 157b4c5f83aSRusaimi Amira Ruslan tx_lpi_usec = (plat_dat->eee_usecs_rate / 1000000) - 1; 158b4c5f83aSRusaimi Amira Ruslan writel(tx_lpi_usec, stmmac_res.addr + GMAC_1US_TIC_COUNTER); 159b4c5f83aSRusaimi Amira Ruslan } 1609efc9b2bSRusaimi Amira Ruslan 1619efc9b2bSRusaimi Amira Ruslan ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); 1629efc9b2bSRusaimi Amira Ruslan if (ret) { 1639efc9b2bSRusaimi Amira Ruslan clk_disable_unprepare(dwmac->tx_clk); 1649efc9b2bSRusaimi Amira Ruslan goto err_remove_config_dt; 1659efc9b2bSRusaimi Amira Ruslan } 1669efc9b2bSRusaimi Amira Ruslan 1679efc9b2bSRusaimi Amira Ruslan return 0; 1689efc9b2bSRusaimi Amira Ruslan 1699efc9b2bSRusaimi Amira Ruslan err_remove_config_dt: 1709efc9b2bSRusaimi Amira Ruslan stmmac_remove_config_dt(pdev, plat_dat); 1719efc9b2bSRusaimi Amira Ruslan 1729efc9b2bSRusaimi Amira Ruslan return ret; 1739efc9b2bSRusaimi Amira Ruslan } 1749efc9b2bSRusaimi Amira Ruslan 1759efc9b2bSRusaimi Amira Ruslan static int intel_eth_plat_remove(struct platform_device *pdev) 1769efc9b2bSRusaimi Amira Ruslan { 1779efc9b2bSRusaimi Amira Ruslan struct intel_dwmac *dwmac = get_stmmac_bsp_priv(&pdev->dev); 1789efc9b2bSRusaimi Amira Ruslan int ret; 1799efc9b2bSRusaimi Amira Ruslan 1809efc9b2bSRusaimi Amira Ruslan ret = stmmac_pltfr_remove(pdev); 1819efc9b2bSRusaimi Amira Ruslan clk_disable_unprepare(dwmac->tx_clk); 1829efc9b2bSRusaimi Amira Ruslan 1839efc9b2bSRusaimi Amira Ruslan return ret; 1849efc9b2bSRusaimi Amira Ruslan } 1859efc9b2bSRusaimi Amira Ruslan 1869efc9b2bSRusaimi Amira Ruslan static struct platform_driver intel_eth_plat_driver = { 1879efc9b2bSRusaimi Amira Ruslan .probe = intel_eth_plat_probe, 1889efc9b2bSRusaimi Amira Ruslan .remove = intel_eth_plat_remove, 1899efc9b2bSRusaimi Amira Ruslan .driver = { 1909efc9b2bSRusaimi Amira Ruslan .name = "intel-eth-plat", 1919efc9b2bSRusaimi Amira Ruslan .pm = &stmmac_pltfr_pm_ops, 1929efc9b2bSRusaimi Amira Ruslan .of_match_table = intel_eth_plat_match, 1939efc9b2bSRusaimi Amira Ruslan }, 1949efc9b2bSRusaimi Amira Ruslan }; 1959efc9b2bSRusaimi Amira Ruslan module_platform_driver(intel_eth_plat_driver); 1969efc9b2bSRusaimi Amira Ruslan 1979efc9b2bSRusaimi Amira Ruslan MODULE_LICENSE("GPL v2"); 1989efc9b2bSRusaimi Amira Ruslan MODULE_DESCRIPTION("Intel DWMAC platform driver"); 199