1732fdf0eSGiuseppe CAVALLARO /* 2d15891caSSrinivas Kandagatla * dwmac-sti.c - STMicroelectronics DWMAC Specific Glue layer 3d15891caSSrinivas Kandagatla * 4d15891caSSrinivas Kandagatla * Copyright (C) 2003-2014 STMicroelectronics (R&D) Limited 5d15891caSSrinivas Kandagatla * Author: Srinivas Kandagatla <srinivas.kandagatla@st.com> 653b26b9bSGiuseppe CAVALLARO * Contributors: Giuseppe Cavallaro <peppe.cavallaro@st.com> 7d15891caSSrinivas Kandagatla * 8d15891caSSrinivas Kandagatla * This program is free software; you can redistribute it and/or modify 9d15891caSSrinivas Kandagatla * it under the terms of the GNU General Public License as published by 10d15891caSSrinivas Kandagatla * the Free Software Foundation; either version 2 of the License, or 11d15891caSSrinivas Kandagatla * (at your option) any later version. 12d15891caSSrinivas Kandagatla */ 13d15891caSSrinivas Kandagatla 14d15891caSSrinivas Kandagatla #include <linux/kernel.h> 15d15891caSSrinivas Kandagatla #include <linux/slab.h> 16d15891caSSrinivas Kandagatla #include <linux/platform_device.h> 17d15891caSSrinivas Kandagatla #include <linux/stmmac.h> 18d15891caSSrinivas Kandagatla #include <linux/phy.h> 19d15891caSSrinivas Kandagatla #include <linux/mfd/syscon.h> 202a321798SJoachim Eastwood #include <linux/module.h> 21d15891caSSrinivas Kandagatla #include <linux/regmap.h> 22d15891caSSrinivas Kandagatla #include <linux/clk.h> 23d15891caSSrinivas Kandagatla #include <linux/of.h> 24149adeddSJoachim Eastwood #include <linux/of_device.h> 25d15891caSSrinivas Kandagatla #include <linux/of_net.h> 26d15891caSSrinivas Kandagatla 27f10f9fb2SAndy Shevchenko #include "stmmac_platform.h" 28f10f9fb2SAndy Shevchenko 2953b26b9bSGiuseppe CAVALLARO #define DWMAC_125MHZ 125000000 3053b26b9bSGiuseppe CAVALLARO #define DWMAC_50MHZ 50000000 3153b26b9bSGiuseppe CAVALLARO #define DWMAC_25MHZ 25000000 3253b26b9bSGiuseppe CAVALLARO #define DWMAC_2_5MHZ 2500000 3353b26b9bSGiuseppe CAVALLARO 3453b26b9bSGiuseppe CAVALLARO #define IS_PHY_IF_MODE_RGMII(iface) (iface == PHY_INTERFACE_MODE_RGMII || \ 3553b26b9bSGiuseppe CAVALLARO iface == PHY_INTERFACE_MODE_RGMII_ID || \ 3653b26b9bSGiuseppe CAVALLARO iface == PHY_INTERFACE_MODE_RGMII_RXID || \ 3753b26b9bSGiuseppe CAVALLARO iface == PHY_INTERFACE_MODE_RGMII_TXID) 3853b26b9bSGiuseppe CAVALLARO 3953b26b9bSGiuseppe CAVALLARO #define IS_PHY_IF_MODE_GBIT(iface) (IS_PHY_IF_MODE_RGMII(iface) || \ 4053b26b9bSGiuseppe CAVALLARO iface == PHY_INTERFACE_MODE_GMII) 4153b26b9bSGiuseppe CAVALLARO 42732fdf0eSGiuseppe CAVALLARO /* STiH4xx register definitions (STiH415/STiH416/STiH407/STiH410 families) 43732fdf0eSGiuseppe CAVALLARO * 44d15891caSSrinivas Kandagatla * Below table summarizes the clock requirement and clock sources for 45d15891caSSrinivas Kandagatla * supported phy interface modes with link speeds. 46d15891caSSrinivas Kandagatla * ________________________________________________ 47d15891caSSrinivas Kandagatla *| PHY_MODE | 1000 Mbit Link | 100 Mbit Link | 48d15891caSSrinivas Kandagatla * ------------------------------------------------ 49d15891caSSrinivas Kandagatla *| MII | n/a | 25Mhz | 50d15891caSSrinivas Kandagatla *| | | txclk | 51d15891caSSrinivas Kandagatla * ------------------------------------------------ 52d15891caSSrinivas Kandagatla *| GMII | 125Mhz | 25Mhz | 53d15891caSSrinivas Kandagatla *| | clk-125/txclk | txclk | 54d15891caSSrinivas Kandagatla * ------------------------------------------------ 55d15891caSSrinivas Kandagatla *| RGMII | 125Mhz | 25Mhz | 56d15891caSSrinivas Kandagatla *| | clk-125/txclk | clkgen | 5753b26b9bSGiuseppe CAVALLARO *| | clkgen | | 58d15891caSSrinivas Kandagatla * ------------------------------------------------ 59d15891caSSrinivas Kandagatla *| RMII | n/a | 25Mhz | 60d15891caSSrinivas Kandagatla *| | |clkgen/phyclk-in | 61d15891caSSrinivas Kandagatla * ------------------------------------------------ 62d15891caSSrinivas Kandagatla * 6353b26b9bSGiuseppe CAVALLARO * Register Configuration 6453b26b9bSGiuseppe CAVALLARO *------------------------------- 6553b26b9bSGiuseppe CAVALLARO * src |BIT(8)| BIT(7)| BIT(6)| 6653b26b9bSGiuseppe CAVALLARO *------------------------------- 67d15891caSSrinivas Kandagatla * txclk | 0 | n/a | 1 | 6853b26b9bSGiuseppe CAVALLARO *------------------------------- 69d15891caSSrinivas Kandagatla * ck_125| 0 | n/a | 0 | 7053b26b9bSGiuseppe CAVALLARO *------------------------------- 71d15891caSSrinivas Kandagatla * phyclk| 1 | 0 | n/a | 7253b26b9bSGiuseppe CAVALLARO *------------------------------- 73d15891caSSrinivas Kandagatla * clkgen| 1 | 1 | n/a | 7453b26b9bSGiuseppe CAVALLARO *------------------------------- 75d15891caSSrinivas Kandagatla */ 76d15891caSSrinivas Kandagatla 7753b26b9bSGiuseppe CAVALLARO #define STIH4XX_RETIME_SRC_MASK GENMASK(8, 6) 7853b26b9bSGiuseppe CAVALLARO #define STIH4XX_ETH_SEL_TX_RETIME_CLK BIT(8) 7953b26b9bSGiuseppe CAVALLARO #define STIH4XX_ETH_SEL_INTERNAL_NOTEXT_PHYCLK BIT(7) 8053b26b9bSGiuseppe CAVALLARO #define STIH4XX_ETH_SEL_TXCLK_NOT_CLK125 BIT(6) 81d15891caSSrinivas Kandagatla 82732fdf0eSGiuseppe CAVALLARO /* STiD127 register definitions 8353b26b9bSGiuseppe CAVALLARO *----------------------- 8453b26b9bSGiuseppe CAVALLARO * src |BIT(6)| BIT(7)| 8553b26b9bSGiuseppe CAVALLARO *----------------------- 8653b26b9bSGiuseppe CAVALLARO * MII | 1 | n/a | 8753b26b9bSGiuseppe CAVALLARO *----------------------- 8853b26b9bSGiuseppe CAVALLARO * RMII | n/a | 1 | 8953b26b9bSGiuseppe CAVALLARO * clkgen| | | 9053b26b9bSGiuseppe CAVALLARO *----------------------- 9153b26b9bSGiuseppe CAVALLARO * RMII | n/a | 0 | 9253b26b9bSGiuseppe CAVALLARO * phyclk| | | 9353b26b9bSGiuseppe CAVALLARO *----------------------- 9453b26b9bSGiuseppe CAVALLARO * RGMII | 1 | n/a | 9553b26b9bSGiuseppe CAVALLARO * clkgen| | | 9653b26b9bSGiuseppe CAVALLARO *----------------------- 97d15891caSSrinivas Kandagatla */ 98d15891caSSrinivas Kandagatla 9953b26b9bSGiuseppe CAVALLARO #define STID127_RETIME_SRC_MASK GENMASK(7, 6) 10053b26b9bSGiuseppe CAVALLARO #define STID127_ETH_SEL_INTERNAL_NOTEXT_PHYCLK BIT(7) 10153b26b9bSGiuseppe CAVALLARO #define STID127_ETH_SEL_INTERNAL_NOTEXT_TXCLK BIT(6) 102d15891caSSrinivas Kandagatla 103d15891caSSrinivas Kandagatla #define ENMII_MASK GENMASK(5, 5) 104d15891caSSrinivas Kandagatla #define ENMII BIT(5) 10553b26b9bSGiuseppe CAVALLARO #define EN_MASK GENMASK(1, 1) 10653b26b9bSGiuseppe CAVALLARO #define EN BIT(1) 107d15891caSSrinivas Kandagatla 108732fdf0eSGiuseppe CAVALLARO /* 109d15891caSSrinivas Kandagatla * 3 bits [4:2] 110d15891caSSrinivas Kandagatla * 000-GMII/MII 111d15891caSSrinivas Kandagatla * 001-RGMII 112d15891caSSrinivas Kandagatla * 010-SGMII 113d15891caSSrinivas Kandagatla * 100-RMII 114d15891caSSrinivas Kandagatla */ 115d15891caSSrinivas Kandagatla #define MII_PHY_SEL_MASK GENMASK(4, 2) 116d15891caSSrinivas Kandagatla #define ETH_PHY_SEL_RMII BIT(4) 117d15891caSSrinivas Kandagatla #define ETH_PHY_SEL_SGMII BIT(3) 118d15891caSSrinivas Kandagatla #define ETH_PHY_SEL_RGMII BIT(2) 119d15891caSSrinivas Kandagatla #define ETH_PHY_SEL_GMII 0x0 120d15891caSSrinivas Kandagatla #define ETH_PHY_SEL_MII 0x0 121d15891caSSrinivas Kandagatla 122d15891caSSrinivas Kandagatla struct sti_dwmac { 12353b26b9bSGiuseppe CAVALLARO int interface; /* MII interface */ 12453b26b9bSGiuseppe CAVALLARO bool ext_phyclk; /* Clock from external PHY */ 12553b26b9bSGiuseppe CAVALLARO u32 tx_retime_src; /* TXCLK Retiming*/ 12653b26b9bSGiuseppe CAVALLARO struct clk *clk; /* PHY clock */ 1279b1a6d36SPeter Griffin u32 ctrl_reg; /* GMAC glue-logic control register */ 12853b26b9bSGiuseppe CAVALLARO int clk_sel_reg; /* GMAC ext clk selection register */ 129d15891caSSrinivas Kandagatla struct device *dev; 130d15891caSSrinivas Kandagatla struct regmap *regmap; 13106a6e829SJoachim Eastwood bool gmac_en; 13253b26b9bSGiuseppe CAVALLARO u32 speed; 13316b1adbbSJoachim Eastwood void (*fix_retime_src)(void *priv, unsigned int speed); 134d15891caSSrinivas Kandagatla }; 135d15891caSSrinivas Kandagatla 13607ca3749SJoachim Eastwood struct sti_dwmac_of_data { 13716b1adbbSJoachim Eastwood void (*fix_retime_src)(void *priv, unsigned int speed); 13807ca3749SJoachim Eastwood }; 13907ca3749SJoachim Eastwood 140d15891caSSrinivas Kandagatla static u32 phy_intf_sels[] = { 141d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_MII] = ETH_PHY_SEL_MII, 142d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_GMII] = ETH_PHY_SEL_GMII, 143d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_RGMII] = ETH_PHY_SEL_RGMII, 144d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_RGMII_ID] = ETH_PHY_SEL_RGMII, 145d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_SGMII] = ETH_PHY_SEL_SGMII, 146d15891caSSrinivas Kandagatla [PHY_INTERFACE_MODE_RMII] = ETH_PHY_SEL_RMII, 147d15891caSSrinivas Kandagatla }; 148d15891caSSrinivas Kandagatla 149d15891caSSrinivas Kandagatla enum { 150d15891caSSrinivas Kandagatla TX_RETIME_SRC_NA = 0, 151d15891caSSrinivas Kandagatla TX_RETIME_SRC_TXCLK = 1, 152d15891caSSrinivas Kandagatla TX_RETIME_SRC_CLK_125, 153d15891caSSrinivas Kandagatla TX_RETIME_SRC_PHYCLK, 154d15891caSSrinivas Kandagatla TX_RETIME_SRC_CLKGEN, 155d15891caSSrinivas Kandagatla }; 156d15891caSSrinivas Kandagatla 15753b26b9bSGiuseppe CAVALLARO static u32 stih4xx_tx_retime_val[] = { 15853b26b9bSGiuseppe CAVALLARO [TX_RETIME_SRC_TXCLK] = STIH4XX_ETH_SEL_TXCLK_NOT_CLK125, 159d15891caSSrinivas Kandagatla [TX_RETIME_SRC_CLK_125] = 0x0, 16053b26b9bSGiuseppe CAVALLARO [TX_RETIME_SRC_PHYCLK] = STIH4XX_ETH_SEL_TX_RETIME_CLK, 16153b26b9bSGiuseppe CAVALLARO [TX_RETIME_SRC_CLKGEN] = STIH4XX_ETH_SEL_TX_RETIME_CLK 16253b26b9bSGiuseppe CAVALLARO | STIH4XX_ETH_SEL_INTERNAL_NOTEXT_PHYCLK, 163d15891caSSrinivas Kandagatla }; 164d15891caSSrinivas Kandagatla 16553b26b9bSGiuseppe CAVALLARO static void stih4xx_fix_retime_src(void *priv, u32 spd) 166d15891caSSrinivas Kandagatla { 16753b26b9bSGiuseppe CAVALLARO struct sti_dwmac *dwmac = priv; 16853b26b9bSGiuseppe CAVALLARO u32 src = dwmac->tx_retime_src; 16953b26b9bSGiuseppe CAVALLARO u32 reg = dwmac->ctrl_reg; 17053b26b9bSGiuseppe CAVALLARO u32 freq = 0; 171d15891caSSrinivas Kandagatla 17253b26b9bSGiuseppe CAVALLARO if (dwmac->interface == PHY_INTERFACE_MODE_MII) { 173d15891caSSrinivas Kandagatla src = TX_RETIME_SRC_TXCLK; 174d15891caSSrinivas Kandagatla } else if (dwmac->interface == PHY_INTERFACE_MODE_RMII) { 175d15891caSSrinivas Kandagatla if (dwmac->ext_phyclk) { 176d15891caSSrinivas Kandagatla src = TX_RETIME_SRC_PHYCLK; 177d15891caSSrinivas Kandagatla } else { 178d15891caSSrinivas Kandagatla src = TX_RETIME_SRC_CLKGEN; 17953b26b9bSGiuseppe CAVALLARO freq = DWMAC_50MHZ; 180d15891caSSrinivas Kandagatla } 181d15891caSSrinivas Kandagatla } else if (IS_PHY_IF_MODE_RGMII(dwmac->interface)) { 18253b26b9bSGiuseppe CAVALLARO /* On GiGa clk source can be either ext or from clkgen */ 18353b26b9bSGiuseppe CAVALLARO if (spd == SPEED_1000) { 18453b26b9bSGiuseppe CAVALLARO freq = DWMAC_125MHZ; 18553b26b9bSGiuseppe CAVALLARO } else { 18653b26b9bSGiuseppe CAVALLARO /* Switch to clkgen for these speeds */ 187d15891caSSrinivas Kandagatla src = TX_RETIME_SRC_CLKGEN; 18853b26b9bSGiuseppe CAVALLARO if (spd == SPEED_100) 18953b26b9bSGiuseppe CAVALLARO freq = DWMAC_25MHZ; 19053b26b9bSGiuseppe CAVALLARO else if (spd == SPEED_10) 19153b26b9bSGiuseppe CAVALLARO freq = DWMAC_2_5MHZ; 19253b26b9bSGiuseppe CAVALLARO } 193d15891caSSrinivas Kandagatla } 194d15891caSSrinivas Kandagatla 195b211aa65SJoachim Eastwood if (src == TX_RETIME_SRC_CLKGEN && freq) 196d15891caSSrinivas Kandagatla clk_set_rate(dwmac->clk, freq); 197d15891caSSrinivas Kandagatla 19853b26b9bSGiuseppe CAVALLARO regmap_update_bits(dwmac->regmap, reg, STIH4XX_RETIME_SRC_MASK, 19953b26b9bSGiuseppe CAVALLARO stih4xx_tx_retime_val[src]); 200d15891caSSrinivas Kandagatla } 201d15891caSSrinivas Kandagatla 20253b26b9bSGiuseppe CAVALLARO static void stid127_fix_retime_src(void *priv, u32 spd) 20353b26b9bSGiuseppe CAVALLARO { 20453b26b9bSGiuseppe CAVALLARO struct sti_dwmac *dwmac = priv; 20553b26b9bSGiuseppe CAVALLARO u32 reg = dwmac->ctrl_reg; 20653b26b9bSGiuseppe CAVALLARO u32 freq = 0; 20753b26b9bSGiuseppe CAVALLARO u32 val = 0; 20853b26b9bSGiuseppe CAVALLARO 20953b26b9bSGiuseppe CAVALLARO if (dwmac->interface == PHY_INTERFACE_MODE_MII) { 21053b26b9bSGiuseppe CAVALLARO val = STID127_ETH_SEL_INTERNAL_NOTEXT_TXCLK; 21153b26b9bSGiuseppe CAVALLARO } else if (dwmac->interface == PHY_INTERFACE_MODE_RMII) { 21253b26b9bSGiuseppe CAVALLARO if (!dwmac->ext_phyclk) { 21353b26b9bSGiuseppe CAVALLARO val = STID127_ETH_SEL_INTERNAL_NOTEXT_PHYCLK; 21453b26b9bSGiuseppe CAVALLARO freq = DWMAC_50MHZ; 21553b26b9bSGiuseppe CAVALLARO } 21653b26b9bSGiuseppe CAVALLARO } else if (IS_PHY_IF_MODE_RGMII(dwmac->interface)) { 21753b26b9bSGiuseppe CAVALLARO val = STID127_ETH_SEL_INTERNAL_NOTEXT_TXCLK; 21853b26b9bSGiuseppe CAVALLARO if (spd == SPEED_1000) 21953b26b9bSGiuseppe CAVALLARO freq = DWMAC_125MHZ; 22053b26b9bSGiuseppe CAVALLARO else if (spd == SPEED_100) 22153b26b9bSGiuseppe CAVALLARO freq = DWMAC_25MHZ; 22253b26b9bSGiuseppe CAVALLARO else if (spd == SPEED_10) 22353b26b9bSGiuseppe CAVALLARO freq = DWMAC_2_5MHZ; 22453b26b9bSGiuseppe CAVALLARO } 22553b26b9bSGiuseppe CAVALLARO 226b211aa65SJoachim Eastwood if (freq) 22753b26b9bSGiuseppe CAVALLARO clk_set_rate(dwmac->clk, freq); 22853b26b9bSGiuseppe CAVALLARO 22953b26b9bSGiuseppe CAVALLARO regmap_update_bits(dwmac->regmap, reg, STID127_RETIME_SRC_MASK, val); 23053b26b9bSGiuseppe CAVALLARO } 23153b26b9bSGiuseppe CAVALLARO 23216b1adbbSJoachim Eastwood static int sti_dwmac_init(struct platform_device *pdev, void *priv) 23353b26b9bSGiuseppe CAVALLARO { 23416b1adbbSJoachim Eastwood struct sti_dwmac *dwmac = priv; 23553b26b9bSGiuseppe CAVALLARO struct regmap *regmap = dwmac->regmap; 23653b26b9bSGiuseppe CAVALLARO int iface = dwmac->interface; 23753b26b9bSGiuseppe CAVALLARO u32 reg = dwmac->ctrl_reg; 23853b26b9bSGiuseppe CAVALLARO u32 val; 23953b26b9bSGiuseppe CAVALLARO 24053b26b9bSGiuseppe CAVALLARO clk_prepare_enable(dwmac->clk); 24153b26b9bSGiuseppe CAVALLARO 24206a6e829SJoachim Eastwood if (dwmac->gmac_en) 24353b26b9bSGiuseppe CAVALLARO regmap_update_bits(regmap, reg, EN_MASK, EN); 24453b26b9bSGiuseppe CAVALLARO 24553b26b9bSGiuseppe CAVALLARO regmap_update_bits(regmap, reg, MII_PHY_SEL_MASK, phy_intf_sels[iface]); 24653b26b9bSGiuseppe CAVALLARO 24753b26b9bSGiuseppe CAVALLARO val = (iface == PHY_INTERFACE_MODE_REVMII) ? 0 : ENMII; 24853b26b9bSGiuseppe CAVALLARO regmap_update_bits(regmap, reg, ENMII_MASK, val); 24953b26b9bSGiuseppe CAVALLARO 25016b1adbbSJoachim Eastwood dwmac->fix_retime_src(priv, dwmac->speed); 25153b26b9bSGiuseppe CAVALLARO 25253b26b9bSGiuseppe CAVALLARO return 0; 253d15891caSSrinivas Kandagatla } 254d15891caSSrinivas Kandagatla 255d15891caSSrinivas Kandagatla static int sti_dwmac_parse_data(struct sti_dwmac *dwmac, 256d15891caSSrinivas Kandagatla struct platform_device *pdev) 257d15891caSSrinivas Kandagatla { 258d15891caSSrinivas Kandagatla struct resource *res; 259d15891caSSrinivas Kandagatla struct device *dev = &pdev->dev; 260d15891caSSrinivas Kandagatla struct device_node *np = dev->of_node; 261d15891caSSrinivas Kandagatla struct regmap *regmap; 262d15891caSSrinivas Kandagatla int err; 263d15891caSSrinivas Kandagatla 26453b26b9bSGiuseppe CAVALLARO /* clk selection from extra syscfg register */ 26553b26b9bSGiuseppe CAVALLARO dwmac->clk_sel_reg = -ENXIO; 26653b26b9bSGiuseppe CAVALLARO res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "sti-clkconf"); 26753b26b9bSGiuseppe CAVALLARO if (res) 26853b26b9bSGiuseppe CAVALLARO dwmac->clk_sel_reg = res->start; 269d15891caSSrinivas Kandagatla 270d15891caSSrinivas Kandagatla regmap = syscon_regmap_lookup_by_phandle(np, "st,syscon"); 271d15891caSSrinivas Kandagatla if (IS_ERR(regmap)) 272d15891caSSrinivas Kandagatla return PTR_ERR(regmap); 273d15891caSSrinivas Kandagatla 2749b1a6d36SPeter Griffin err = of_property_read_u32_index(np, "st,syscon", 1, &dwmac->ctrl_reg); 2759b1a6d36SPeter Griffin if (err) { 2769b1a6d36SPeter Griffin dev_err(dev, "Can't get sysconfig ctrl offset (%d)\n", err); 2779b1a6d36SPeter Griffin return err; 2789b1a6d36SPeter Griffin } 2799b1a6d36SPeter Griffin 280d15891caSSrinivas Kandagatla dwmac->dev = dev; 281d15891caSSrinivas Kandagatla dwmac->interface = of_get_phy_mode(np); 282d15891caSSrinivas Kandagatla dwmac->regmap = regmap; 28306a6e829SJoachim Eastwood dwmac->gmac_en = of_property_read_bool(np, "st,gmac_en"); 284d15891caSSrinivas Kandagatla dwmac->ext_phyclk = of_property_read_bool(np, "st,ext-phyclk"); 28553b26b9bSGiuseppe CAVALLARO dwmac->tx_retime_src = TX_RETIME_SRC_NA; 28653b26b9bSGiuseppe CAVALLARO dwmac->speed = SPEED_100; 287d15891caSSrinivas Kandagatla 288d15891caSSrinivas Kandagatla if (IS_PHY_IF_MODE_GBIT(dwmac->interface)) { 289d15891caSSrinivas Kandagatla const char *rs; 290d15891caSSrinivas Kandagatla 29122407e13SGiuseppe CAVALLARO dwmac->tx_retime_src = TX_RETIME_SRC_CLKGEN; 29222407e13SGiuseppe CAVALLARO 293d15891caSSrinivas Kandagatla err = of_property_read_string(np, "st,tx-retime-src", &rs); 29450262c85SGeert Uytterhoeven if (err < 0) { 29553b26b9bSGiuseppe CAVALLARO dev_warn(dev, "Use internal clock source\n"); 29622407e13SGiuseppe CAVALLARO } else { 29722407e13SGiuseppe CAVALLARO if (!strcasecmp(rs, "clk_125")) 29853b26b9bSGiuseppe CAVALLARO dwmac->tx_retime_src = TX_RETIME_SRC_CLK_125; 29922407e13SGiuseppe CAVALLARO else if (!strcasecmp(rs, "txclk")) 30053b26b9bSGiuseppe CAVALLARO dwmac->tx_retime_src = TX_RETIME_SRC_TXCLK; 30150262c85SGeert Uytterhoeven } 30253b26b9bSGiuseppe CAVALLARO dwmac->speed = SPEED_1000; 303d15891caSSrinivas Kandagatla } 304d15891caSSrinivas Kandagatla 305d15891caSSrinivas Kandagatla dwmac->clk = devm_clk_get(dev, "sti-ethclk"); 30653b26b9bSGiuseppe CAVALLARO if (IS_ERR(dwmac->clk)) { 30753b26b9bSGiuseppe CAVALLARO dev_warn(dev, "No phy clock provided...\n"); 308d15891caSSrinivas Kandagatla dwmac->clk = NULL; 309d15891caSSrinivas Kandagatla } 310d15891caSSrinivas Kandagatla 311d15891caSSrinivas Kandagatla return 0; 312d15891caSSrinivas Kandagatla } 313d15891caSSrinivas Kandagatla 3148387ee21SJoachim Eastwood static int sti_dwmac_probe(struct platform_device *pdev) 315d15891caSSrinivas Kandagatla { 3168387ee21SJoachim Eastwood struct plat_stmmacenet_data *plat_dat; 31707ca3749SJoachim Eastwood const struct sti_dwmac_of_data *data; 3188387ee21SJoachim Eastwood struct stmmac_resources stmmac_res; 319d15891caSSrinivas Kandagatla struct sti_dwmac *dwmac; 320d15891caSSrinivas Kandagatla int ret; 321d15891caSSrinivas Kandagatla 322149adeddSJoachim Eastwood data = of_device_get_match_data(&pdev->dev); 323149adeddSJoachim Eastwood if (!data) { 324149adeddSJoachim Eastwood dev_err(&pdev->dev, "No OF match data provided\n"); 325149adeddSJoachim Eastwood return -EINVAL; 326149adeddSJoachim Eastwood } 327149adeddSJoachim Eastwood 3288387ee21SJoachim Eastwood ret = stmmac_get_platform_resources(pdev, &stmmac_res); 3298387ee21SJoachim Eastwood if (ret) 3308387ee21SJoachim Eastwood return ret; 3318387ee21SJoachim Eastwood 3328387ee21SJoachim Eastwood plat_dat = stmmac_probe_config_dt(pdev, &stmmac_res.mac); 3338387ee21SJoachim Eastwood if (IS_ERR(plat_dat)) 3348387ee21SJoachim Eastwood return PTR_ERR(plat_dat); 3358387ee21SJoachim Eastwood 336d15891caSSrinivas Kandagatla dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); 337d15891caSSrinivas Kandagatla if (!dwmac) 3388387ee21SJoachim Eastwood return -ENOMEM; 339d15891caSSrinivas Kandagatla 340d15891caSSrinivas Kandagatla ret = sti_dwmac_parse_data(dwmac, pdev); 341d15891caSSrinivas Kandagatla if (ret) { 342d15891caSSrinivas Kandagatla dev_err(&pdev->dev, "Unable to parse OF data\n"); 3438387ee21SJoachim Eastwood return ret; 344d15891caSSrinivas Kandagatla } 345d15891caSSrinivas Kandagatla 34616b1adbbSJoachim Eastwood dwmac->fix_retime_src = data->fix_retime_src; 3478387ee21SJoachim Eastwood 34816b1adbbSJoachim Eastwood plat_dat->bsp_priv = dwmac; 34916b1adbbSJoachim Eastwood plat_dat->fix_mac_speed = data->fix_retime_src; 35016b1adbbSJoachim Eastwood 35116b1adbbSJoachim Eastwood ret = sti_dwmac_init(pdev, plat_dat->bsp_priv); 3528387ee21SJoachim Eastwood if (ret) 3538387ee21SJoachim Eastwood return ret; 3548387ee21SJoachim Eastwood 3558387ee21SJoachim Eastwood return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); 356d15891caSSrinivas Kandagatla } 357d15891caSSrinivas Kandagatla 3582517cfd4SJoachim Eastwood static int sti_dwmac_remove(struct platform_device *pdev) 3592517cfd4SJoachim Eastwood { 3602517cfd4SJoachim Eastwood struct sti_dwmac *dwmac = get_stmmac_bsp_priv(&pdev->dev); 3612517cfd4SJoachim Eastwood int ret = stmmac_dvr_remove(&pdev->dev); 3622517cfd4SJoachim Eastwood 3632517cfd4SJoachim Eastwood clk_disable_unprepare(dwmac->clk); 3642517cfd4SJoachim Eastwood 3652517cfd4SJoachim Eastwood return ret; 3662517cfd4SJoachim Eastwood } 3672517cfd4SJoachim Eastwood 3682517cfd4SJoachim Eastwood #ifdef CONFIG_PM_SLEEP 3692517cfd4SJoachim Eastwood static int sti_dwmac_suspend(struct device *dev) 3702517cfd4SJoachim Eastwood { 3712517cfd4SJoachim Eastwood struct sti_dwmac *dwmac = get_stmmac_bsp_priv(dev); 3722517cfd4SJoachim Eastwood int ret = stmmac_suspend(dev); 3732517cfd4SJoachim Eastwood 3742517cfd4SJoachim Eastwood clk_disable_unprepare(dwmac->clk); 3752517cfd4SJoachim Eastwood 3762517cfd4SJoachim Eastwood return ret; 3772517cfd4SJoachim Eastwood } 3782517cfd4SJoachim Eastwood 3792517cfd4SJoachim Eastwood static int sti_dwmac_resume(struct device *dev) 3802517cfd4SJoachim Eastwood { 3812517cfd4SJoachim Eastwood struct sti_dwmac *dwmac = get_stmmac_bsp_priv(dev); 3822517cfd4SJoachim Eastwood struct platform_device *pdev = to_platform_device(dev); 3832517cfd4SJoachim Eastwood 3842517cfd4SJoachim Eastwood sti_dwmac_init(pdev, dwmac); 3852517cfd4SJoachim Eastwood 3862517cfd4SJoachim Eastwood return stmmac_resume(dev); 3872517cfd4SJoachim Eastwood } 3882517cfd4SJoachim Eastwood #endif /* CONFIG_PM_SLEEP */ 3892517cfd4SJoachim Eastwood 3902517cfd4SJoachim Eastwood static SIMPLE_DEV_PM_OPS(sti_dwmac_pm_ops, sti_dwmac_suspend, 3912517cfd4SJoachim Eastwood sti_dwmac_resume); 3922517cfd4SJoachim Eastwood 39307ca3749SJoachim Eastwood static const struct sti_dwmac_of_data stih4xx_dwmac_data = { 39416b1adbbSJoachim Eastwood .fix_retime_src = stih4xx_fix_retime_src, 39553b26b9bSGiuseppe CAVALLARO }; 39653b26b9bSGiuseppe CAVALLARO 39707ca3749SJoachim Eastwood static const struct sti_dwmac_of_data stid127_dwmac_data = { 39816b1adbbSJoachim Eastwood .fix_retime_src = stid127_fix_retime_src, 399d15891caSSrinivas Kandagatla }; 4002a321798SJoachim Eastwood 4012a321798SJoachim Eastwood static const struct of_device_id sti_dwmac_match[] = { 4022a321798SJoachim Eastwood { .compatible = "st,stih415-dwmac", .data = &stih4xx_dwmac_data}, 4032a321798SJoachim Eastwood { .compatible = "st,stih416-dwmac", .data = &stih4xx_dwmac_data}, 4042a321798SJoachim Eastwood { .compatible = "st,stid127-dwmac", .data = &stid127_dwmac_data}, 4052a321798SJoachim Eastwood { .compatible = "st,stih407-dwmac", .data = &stih4xx_dwmac_data}, 4062a321798SJoachim Eastwood { } 4072a321798SJoachim Eastwood }; 4082a321798SJoachim Eastwood MODULE_DEVICE_TABLE(of, sti_dwmac_match); 4092a321798SJoachim Eastwood 4102a321798SJoachim Eastwood static struct platform_driver sti_dwmac_driver = { 4118387ee21SJoachim Eastwood .probe = sti_dwmac_probe, 4122517cfd4SJoachim Eastwood .remove = sti_dwmac_remove, 4132a321798SJoachim Eastwood .driver = { 4142a321798SJoachim Eastwood .name = "sti-dwmac", 4152517cfd4SJoachim Eastwood .pm = &sti_dwmac_pm_ops, 4162a321798SJoachim Eastwood .of_match_table = sti_dwmac_match, 4172a321798SJoachim Eastwood }, 4182a321798SJoachim Eastwood }; 4192a321798SJoachim Eastwood module_platform_driver(sti_dwmac_driver); 4202a321798SJoachim Eastwood 4212a321798SJoachim Eastwood MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@st.com>"); 4222a321798SJoachim Eastwood MODULE_DESCRIPTION("STMicroelectronics DWMAC Specific Glue layer"); 4232a321798SJoachim Eastwood MODULE_LICENSE("GPL"); 424