|
|
@@ -30,7 +30,11 @@
|
|
|
#define MAX_PORTS 2
|
|
|
|
|
|
/* Register offset between PHYs in PCB space */
|
|
|
-#define SATA_MDIO_REG_SPACE_SIZE 0x1000
|
|
|
+#define SATA_MDIO_REG_28NM_SPACE_SIZE 0x1000
|
|
|
+
|
|
|
+enum brcm_sata_phy_version {
|
|
|
+ BRCM_SATA_PHY_28NM,
|
|
|
+};
|
|
|
|
|
|
struct brcm_sata_port {
|
|
|
int portnum;
|
|
|
@@ -42,6 +46,7 @@ struct brcm_sata_port {
|
|
|
struct brcm_sata_phy {
|
|
|
struct device *dev;
|
|
|
void __iomem *phy_base;
|
|
|
+ enum brcm_sata_phy_version version;
|
|
|
|
|
|
struct brcm_sata_port phys[MAX_PORTS];
|
|
|
};
|
|
|
@@ -64,8 +69,12 @@ enum sata_mdio_phy_regs_28nm {
|
|
|
static inline void __iomem *brcm_sata_phy_base(struct brcm_sata_port *port)
|
|
|
{
|
|
|
struct brcm_sata_phy *priv = port->phy_priv;
|
|
|
+ u32 offset;
|
|
|
|
|
|
- return priv->phy_base + (port->portnum * SATA_MDIO_REG_SPACE_SIZE);
|
|
|
+ if (priv->version == BRCM_SATA_PHY_28NM)
|
|
|
+ offset = SATA_MDIO_REG_28NM_SPACE_SIZE;
|
|
|
+
|
|
|
+ return priv->phy_base + (port->portnum * offset);
|
|
|
}
|
|
|
|
|
|
static void brcm_sata_mdio_wr(void __iomem *addr, u32 bank, u32 ofs,
|
|
|
@@ -126,7 +135,8 @@ static const struct phy_ops phy_ops_28nm = {
|
|
|
};
|
|
|
|
|
|
static const struct of_device_id brcm_sata_phy_of_match[] = {
|
|
|
- { .compatible = "brcm,bcm7445-sata-phy" },
|
|
|
+ { .compatible = "brcm,bcm7445-sata-phy",
|
|
|
+ .data = (void *)BRCM_SATA_PHY_28NM },
|
|
|
{},
|
|
|
};
|
|
|
MODULE_DEVICE_TABLE(of, brcm_sata_phy_of_match);
|
|
|
@@ -135,6 +145,7 @@ static int brcm_sata_phy_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
struct device *dev = &pdev->dev;
|
|
|
struct device_node *dn = dev->of_node, *child;
|
|
|
+ const struct of_device_id *of_id;
|
|
|
struct brcm_sata_phy *priv;
|
|
|
struct resource *res;
|
|
|
struct phy_provider *provider;
|
|
|
@@ -154,6 +165,12 @@ static int brcm_sata_phy_probe(struct platform_device *pdev)
|
|
|
if (IS_ERR(priv->phy_base))
|
|
|
return PTR_ERR(priv->phy_base);
|
|
|
|
|
|
+ of_id = of_match_node(brcm_sata_phy_of_match, dn);
|
|
|
+ if (of_id)
|
|
|
+ priv->version = (enum brcm_sata_phy_version)of_id->data;
|
|
|
+ else
|
|
|
+ priv->version = BRCM_SATA_PHY_28NM;
|
|
|
+
|
|
|
for_each_available_child_of_node(dn, child) {
|
|
|
unsigned int id;
|
|
|
struct brcm_sata_port *port;
|