93 static int get_clk_div_sgmii(struct ipq806x_gmac *gmac, unsigned int speed)  in get_clk_div_sgmii()  argument
95 	struct device *dev = &gmac->pdev->dev;  in get_clk_div_sgmii()
119 static int get_clk_div_rgmii(struct ipq806x_gmac *gmac, unsigned int speed)  in get_clk_div_rgmii()  argument
121 	struct device *dev = &gmac->pdev->dev;  in get_clk_div_rgmii()
145 static int ipq806x_gmac_set_speed(struct ipq806x_gmac *gmac, unsigned int speed)  in ipq806x_gmac_set_speed()  argument
150 	switch (gmac->phy_mode) {  in ipq806x_gmac_set_speed()
152 		div = get_clk_div_rgmii(gmac, speed);  in ipq806x_gmac_set_speed()
153 		clk_bits = NSS_COMMON_CLK_GATE_RGMII_RX_EN(gmac->id) |  in ipq806x_gmac_set_speed()
154 			   NSS_COMMON_CLK_GATE_RGMII_TX_EN(gmac->id);  in ipq806x_gmac_set_speed()
158 		div = get_clk_div_sgmii(gmac, speed);  in ipq806x_gmac_set_speed()
159 		clk_bits = NSS_COMMON_CLK_GATE_GMII_RX_EN(gmac->id) |  in ipq806x_gmac_set_speed()
160 			   NSS_COMMON_CLK_GATE_GMII_TX_EN(gmac->id);  in ipq806x_gmac_set_speed()
164 		dev_err(&gmac->pdev->dev, "Unsupported PHY mode: \"%s\"\n",  in ipq806x_gmac_set_speed()
165 			phy_modes(gmac->phy_mode));  in ipq806x_gmac_set_speed()
170 	regmap_read(gmac->nss_common, NSS_COMMON_CLK_GATE, &val);  in ipq806x_gmac_set_speed()
172 	regmap_write(gmac->nss_common, NSS_COMMON_CLK_GATE, val);  in ipq806x_gmac_set_speed()
175 	regmap_read(gmac->nss_common, NSS_COMMON_CLK_DIV0, &val);  in ipq806x_gmac_set_speed()
177 		 << NSS_COMMON_CLK_DIV_OFFSET(gmac->id));  in ipq806x_gmac_set_speed()
178 	val |= div << NSS_COMMON_CLK_DIV_OFFSET(gmac->id);  in ipq806x_gmac_set_speed()
179 	regmap_write(gmac->nss_common, NSS_COMMON_CLK_DIV0, val);  in ipq806x_gmac_set_speed()
182 	regmap_read(gmac->nss_common, NSS_COMMON_CLK_GATE, &val);  in ipq806x_gmac_set_speed()
184 	regmap_write(gmac->nss_common, NSS_COMMON_CLK_GATE, val);  in ipq806x_gmac_set_speed()
189 static int ipq806x_gmac_of_parse(struct ipq806x_gmac *gmac)  in ipq806x_gmac_of_parse()  argument
191 	struct device *dev = &gmac->pdev->dev;  in ipq806x_gmac_of_parse()
193 	gmac->phy_mode = of_get_phy_mode(dev->of_node);  in ipq806x_gmac_of_parse()
194 	if (gmac->phy_mode < 0) {  in ipq806x_gmac_of_parse()
199 	if (of_property_read_u32(dev->of_node, "qcom,id", &gmac->id) < 0) {  in ipq806x_gmac_of_parse()
208 	if (gmac->id > 3) {  in ipq806x_gmac_of_parse()
213 	gmac->core_clk = devm_clk_get(dev, "stmmaceth");  in ipq806x_gmac_of_parse()
214 	if (IS_ERR(gmac->core_clk)) {  in ipq806x_gmac_of_parse()
216 		return PTR_ERR(gmac->core_clk);  in ipq806x_gmac_of_parse()
218 	clk_set_rate(gmac->core_clk, 266000000);  in ipq806x_gmac_of_parse()
221 	gmac->nss_common = syscon_regmap_lookup_by_phandle(dev->of_node,  in ipq806x_gmac_of_parse()
223 	if (IS_ERR(gmac->nss_common)) {  in ipq806x_gmac_of_parse()
225 		return PTR_ERR(gmac->nss_common);  in ipq806x_gmac_of_parse()
229 	gmac->qsgmii_csr = syscon_regmap_lookup_by_phandle(dev->of_node,  in ipq806x_gmac_of_parse()
231 	if (IS_ERR(gmac->qsgmii_csr))  in ipq806x_gmac_of_parse()
234 	return PTR_ERR_OR_ZERO(gmac->qsgmii_csr);  in ipq806x_gmac_of_parse()
239 	struct ipq806x_gmac *gmac = priv;  in ipq806x_gmac_fix_mac_speed()  local
241 	ipq806x_gmac_set_speed(gmac, speed);  in ipq806x_gmac_fix_mac_speed()
249 	struct ipq806x_gmac *gmac;  in ipq806x_gmac_probe()  local
261 	gmac = devm_kzalloc(dev, sizeof(*gmac), GFP_KERNEL);  in ipq806x_gmac_probe()
262 	if (!gmac) {  in ipq806x_gmac_probe()
267 	gmac->pdev = pdev;  in ipq806x_gmac_probe()
269 	err = ipq806x_gmac_of_parse(gmac);  in ipq806x_gmac_probe()
275 	regmap_write(gmac->qsgmii_csr, QSGMII_PCS_CAL_LCKDT_CTL,  in ipq806x_gmac_probe()
283 	switch (gmac->phy_mode) {  in ipq806x_gmac_probe()
292 			phy_modes(gmac->phy_mode));  in ipq806x_gmac_probe()
296 	regmap_write(gmac->nss_common, NSS_COMMON_GMAC_CTL(gmac->id), val);  in ipq806x_gmac_probe()
299 	regmap_read(gmac->nss_common, NSS_COMMON_CLK_SRC_CTRL, &val);  in ipq806x_gmac_probe()
300 	val &= ~(1 << NSS_COMMON_CLK_SRC_CTRL_OFFSET(gmac->id));  in ipq806x_gmac_probe()
301 	switch (gmac->phy_mode) {  in ipq806x_gmac_probe()
303 		val |= NSS_COMMON_CLK_SRC_CTRL_RGMII(gmac->id) <<  in ipq806x_gmac_probe()
304 			NSS_COMMON_CLK_SRC_CTRL_OFFSET(gmac->id);  in ipq806x_gmac_probe()
307 		val |= NSS_COMMON_CLK_SRC_CTRL_SGMII(gmac->id) <<  in ipq806x_gmac_probe()
308 			NSS_COMMON_CLK_SRC_CTRL_OFFSET(gmac->id);  in ipq806x_gmac_probe()
312 			phy_modes(gmac->phy_mode));  in ipq806x_gmac_probe()
316 	regmap_write(gmac->nss_common, NSS_COMMON_CLK_SRC_CTRL, val);  in ipq806x_gmac_probe()
319 	regmap_read(gmac->nss_common, NSS_COMMON_CLK_GATE, &val);  in ipq806x_gmac_probe()
320 	val |= NSS_COMMON_CLK_GATE_PTP_EN(gmac->id);  in ipq806x_gmac_probe()
321 	regmap_write(gmac->nss_common, NSS_COMMON_CLK_GATE, val);  in ipq806x_gmac_probe()
323 	if (gmac->phy_mode == PHY_INTERFACE_MODE_SGMII) {  in ipq806x_gmac_probe()
324 		regmap_write(gmac->qsgmii_csr, QSGMII_PHY_SGMII_CTL(gmac->id),  in ipq806x_gmac_probe()
338 	plat_dat->bsp_priv = gmac;  in ipq806x_gmac_probe()