1 // SPDX-License-Identifier: GPL-2.0-only 2 // Copyright (C) 2016 Broadcom 3 4 #include <linux/device.h> 5 #include <linux/module.h> 6 #include <linux/of_mdio.h> 7 #include <linux/mdio.h> 8 #include <linux/phy.h> 9 #include <linux/phy/phy.h> 10 11 #define BLK_ADDR_REG_OFFSET 0x1f 12 #define PLL_AFE1_100MHZ_BLK 0x2100 13 #define PLL_CLK_AMP_OFFSET 0x03 14 #define PLL_CLK_AMP_2P05V 0x2b18 15 16 static int ns2_pci_phy_init(struct phy *p) 17 { 18 struct mdio_device *mdiodev = phy_get_drvdata(p); 19 int rc; 20 21 /* select the AFE 100MHz block page */ 22 rc = mdiodev_write(mdiodev, BLK_ADDR_REG_OFFSET, PLL_AFE1_100MHZ_BLK); 23 if (rc) 24 goto err; 25 26 /* set the 100 MHz reference clock amplitude to 2.05 v */ 27 rc = mdiodev_write(mdiodev, PLL_CLK_AMP_OFFSET, PLL_CLK_AMP_2P05V); 28 if (rc) 29 goto err; 30 31 return 0; 32 33 err: 34 dev_err(&mdiodev->dev, "Error %d writing to phy\n", rc); 35 return rc; 36 } 37 38 static const struct phy_ops ns2_pci_phy_ops = { 39 .init = ns2_pci_phy_init, 40 .owner = THIS_MODULE, 41 }; 42 43 static int ns2_pci_phy_probe(struct mdio_device *mdiodev) 44 { 45 struct device *dev = &mdiodev->dev; 46 struct phy_provider *provider; 47 struct phy *phy; 48 49 phy = devm_phy_create(dev, dev->of_node, &ns2_pci_phy_ops); 50 if (IS_ERR(phy)) { 51 dev_err(dev, "failed to create Phy\n"); 52 return PTR_ERR(phy); 53 } 54 55 phy_set_drvdata(phy, mdiodev); 56 57 provider = devm_of_phy_provider_register(&phy->dev, 58 of_phy_simple_xlate); 59 if (IS_ERR(provider)) { 60 dev_err(dev, "failed to register Phy provider\n"); 61 return PTR_ERR(provider); 62 } 63 64 return 0; 65 } 66 67 static const struct of_device_id ns2_pci_phy_of_match[] = { 68 { .compatible = "brcm,ns2-pcie-phy", }, 69 { /* sentinel */ }, 70 }; 71 MODULE_DEVICE_TABLE(of, ns2_pci_phy_of_match); 72 73 static struct mdio_driver ns2_pci_phy_driver = { 74 .mdiodrv = { 75 .driver = { 76 .name = "phy-bcm-ns2-pci", 77 .of_match_table = ns2_pci_phy_of_match, 78 }, 79 }, 80 .probe = ns2_pci_phy_probe, 81 }; 82 mdio_module_driver(ns2_pci_phy_driver); 83 84 MODULE_AUTHOR("Broadcom"); 85 MODULE_DESCRIPTION("Broadcom Northstar2 PCI Phy driver"); 86 MODULE_LICENSE("GPL v2"); 87 MODULE_ALIAS("platform:phy-bcm-ns2-pci"); 88