linux-kernel.vger.kernel.org archive mirror
 help / color / mirror / Atom feed
* [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
@ 2014-04-22 15:49 Hubert Chaumette
  2014-04-22 16:10 ` Florian Fainelli
  2014-04-22 16:21 ` Alexandre Belloni
  0 siblings, 2 replies; 9+ messages in thread
From: Hubert Chaumette @ 2014-04-22 15:49 UTC (permalink / raw)
  To: f.fainelli; +Cc: linux-kernel, linux-arm-kernel, netdev

Adds support for ksz9031 PAD skew configuration over devicetree.

Changes since v1:
- Removed ksz9021 and ksz9031 fixup deletions from arch/arm/mach-imx/mach-imx6q.c

Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
---
 drivers/net/phy/micrel.c | 185 ++++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 184 insertions(+), 1 deletion(-)

diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
index 5a8993b..df56b26 100644
--- a/drivers/net/phy/micrel.c
+++ b/drivers/net/phy/micrel.c
@@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
 	return 0;
 }
 
+#define MII_KSZ9031RN_MMD_CTRL_REG	0x0d
+#define MII_KSZ9031RN_MMD_REGDATA_REG	0x0e
+#define OP_DATA				1
+#define KSZ9031_PS_TO_REG		60
+
+/* Extended registers */
+#define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
+#define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
+#define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
+#define MII_KSZ9031RN_CLK_PAD_SKEW	8
+
+static int ksz9031_extended_write(struct phy_device *phydev,
+				  u8 mode, u32 dev_addr, u32 regnum, u16 val)
+{
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
+	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
+	return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
+}
+
+static int ksz9031_extended_read(struct phy_device *phydev,
+				 u8 mode, u32 dev_addr, u32 regnum)
+{
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
+	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
+	return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
+}
+
+/* Two 5-bit fields register */
+static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
+					struct device_node *of_node,
+					char *field1, char *field2)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 2)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
+				MII_KSZ9031RN_CLK_PAD_SKEW);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xffe0) |
+			 ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
+
+	if (val2 != -2)
+		newval = (newval & 0xfc1f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2,
+			MII_KSZ9031RN_CLK_PAD_SKEW, newval);
+}
+
+/* Four 4-bit fields register */
+static int ksz9031_load_data_skew_values(struct phy_device *phydev,
+					 struct device_node *of_node, u16 reg,
+					 char *field1, char *field2,
+					 char *field3, char *field4)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int val3 = -3;
+	int val4 = -4;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field3, &val3))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field4, &val4))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 4)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xfff0) |
+			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
+
+	if (val2 != -2)
+		newval = (newval & 0xff0f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
+
+	if (val3 != -3)
+		newval = (newval & 0xf0ff) |
+			 (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
+
+	if (val4 != -4)
+		newval = (newval & 0x0fff) |
+			 (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
+}
+
+/* Two 4-bit fields register */
+static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
+					 struct device_node *of_node,
+					 char *field1, char *field2)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 2)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
+				MII_KSZ9031RN_CONTROL_PAD_SKEW);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xfff0) |
+			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
+
+	if (val2 != -2)
+		newval = (newval & 0xff0f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2,
+			MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
+}
+
+static int ksz9031_config_init(struct phy_device *phydev)
+{
+	struct device *dev = &phydev->dev;
+	struct device_node *of_node = dev->of_node;
+
+	if (!of_node && dev->parent->of_node)
+		of_node = dev->parent->of_node;
+
+	if (of_node) {
+		ksz9031_load_clk_skew_values(phydev, of_node,
+				"rxc-skew-ps", "txc-skew-ps");
+
+		ksz9031_load_data_skew_values(phydev, of_node,
+				MII_KSZ9031RN_RX_DATA_PAD_SKEW,
+				"rxd0-skew-ps", "rxd1-skew-ps",
+				"rxd2-skew-ps", "rxd3-skew-ps");
+
+		ksz9031_load_data_skew_values(phydev, of_node,
+				MII_KSZ9031RN_TX_DATA_PAD_SKEW,
+				"txd0-skew-ps", "txd1-skew-ps",
+				"txd2-skew-ps", "txd3-skew-ps");
+
+		ksz9031_load_ctrl_skew_values(phydev, of_node,
+				"txen-skew-ps", "rxdv-skew-ps");
+	}
+	return 0;
+}
+
 #define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
 #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	(1 << 6)
 #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	(1 << 4)
@@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
 	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause
 				| SUPPORTED_Asym_Pause),
 	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
-	.config_init	= kszphy_config_init,
+	.config_init	= ksz9031_config_init,
 	.config_aneg	= genphy_config_aneg,
 	.read_status	= genphy_read_status,
 	.ack_interrupt	= kszphy_ack_interrupt,
-- 
1.9.2


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-22 15:49 [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031 Hubert Chaumette
@ 2014-04-22 16:10 ` Florian Fainelli
  2014-04-23  7:35   ` Hubert Chaumette
  2014-04-22 16:21 ` Alexandre Belloni
  1 sibling, 1 reply; 9+ messages in thread
From: Florian Fainelli @ 2014-04-22 16:10 UTC (permalink / raw)
  To: Hubert Chaumette; +Cc: linux-kernel, linux-arm-kernel, netdev

2014-04-22 8:49 GMT-07:00 Hubert Chaumette <hchaumette@adeneo-embedded.com>:
> Adds support for ksz9031 PAD skew configuration over devicetree.
>
> Changes since v1:
> - Removed ksz9021 and ksz9031 fixup deletions from arch/arm/mach-imx/mach-imx6q.c

You should probably update the existing binding document in
Documentation/devicetree/bindings/net/micrel-ksz9021.txt to cover the
KSZ9031 PHY too.

>
> Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
> ---
>  drivers/net/phy/micrel.c | 185 ++++++++++++++++++++++++++++++++++++++++++++++-
>  1 file changed, 184 insertions(+), 1 deletion(-)
>
> diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
> index 5a8993b..df56b26 100644
> --- a/drivers/net/phy/micrel.c
> +++ b/drivers/net/phy/micrel.c
> @@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
>         return 0;
>  }
>
> +#define MII_KSZ9031RN_MMD_CTRL_REG     0x0d
> +#define MII_KSZ9031RN_MMD_REGDATA_REG  0x0e
> +#define OP_DATA                                1
> +#define KSZ9031_PS_TO_REG              60
> +
> +/* Extended registers */
> +#define MII_KSZ9031RN_CONTROL_PAD_SKEW 4
> +#define MII_KSZ9031RN_RX_DATA_PAD_SKEW 5
> +#define MII_KSZ9031RN_TX_DATA_PAD_SKEW 6
> +#define MII_KSZ9031RN_CLK_PAD_SKEW     8
> +
> +static int ksz9031_extended_write(struct phy_device *phydev,
> +                                 u8 mode, u32 dev_addr, u32 regnum, u16 val)
> +{
> +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +       return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
> +}
> +
> +static int ksz9031_extended_read(struct phy_device *phydev,
> +                                u8 mode, u32 dev_addr, u32 regnum)
> +{
> +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +       return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
> +}
> +
> +/* Two 5-bit fields register */
> +static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
> +                                       struct device_node *of_node,
> +                                       char *field1, char *field2)
> +{
> +       int val1 = -1;
> +       int val2 = -2;
> +       int newval;
> +       int matches = 0;
> +
> +       if (!of_property_read_u32(of_node, field1, &val1))
> +               matches++;
> +
> +       if (!of_property_read_u32(of_node, field2, &val2))
> +               matches++;
> +
> +       if (!matches)
> +               return 0;
> +
> +       if (matches < 2)
> +               newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +                               MII_KSZ9031RN_CLK_PAD_SKEW);
> +       else
> +               newval = 0;
> +
> +       if (val1 != -1)
> +               newval = (newval & 0xffe0) |
> +                        ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
> +
> +       if (val2 != -2)
> +               newval = (newval & 0xfc1f) |
> +                        (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
> +
> +       return ksz9031_extended_write(phydev, OP_DATA, 2,
> +                       MII_KSZ9031RN_CLK_PAD_SKEW, newval);
> +}
> +
> +/* Four 4-bit fields register */
> +static int ksz9031_load_data_skew_values(struct phy_device *phydev,
> +                                        struct device_node *of_node, u16 reg,
> +                                        char *field1, char *field2,
> +                                        char *field3, char *field4)
> +{
> +       int val1 = -1;
> +       int val2 = -2;
> +       int val3 = -3;
> +       int val4 = -4;
> +       int newval;
> +       int matches = 0;
> +
> +       if (!of_property_read_u32(of_node, field1, &val1))
> +               matches++;
> +
> +       if (!of_property_read_u32(of_node, field2, &val2))
> +               matches++;
> +
> +       if (!of_property_read_u32(of_node, field3, &val3))
> +               matches++;
> +
> +       if (!of_property_read_u32(of_node, field4, &val4))
> +               matches++;
> +
> +       if (!matches)
> +               return 0;
> +
> +       if (matches < 4)
> +               newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
> +       else
> +               newval = 0;
> +
> +       if (val1 != -1)
> +               newval = (newval & 0xfff0) |
> +                        (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +       if (val2 != -2)
> +               newval = (newval & 0xff0f) |
> +                        (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +       if (val3 != -3)
> +               newval = (newval & 0xf0ff) |
> +                        (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
> +
> +       if (val4 != -4)
> +               newval = (newval & 0x0fff) |
> +                        (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);

How about something like this:

for (i = 0; i < 4; i++) {
            if (val[i] != -i) {
                    mask = 0xffff;
                    mask <<= (0 << (i * 4));
                    newval = (newval & mask) |
                           (((val[i] / KSZ9031_PS_TO_REG) & 0xf) << (i *4);
            }
}

Such that you could factor ksz9031_load_ctrl_skew_values() and
ksz9031_load_data_skew_values() to specify the number of matches they
should have?

> +
> +       return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
> +}
> +
> +/* Two 4-bit fields register */
> +static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
> +                                        struct device_node *of_node,
> +                                        char *field1, char *field2)
> +{
> +       int val1 = -1;
> +       int val2 = -2;
> +       int newval;
> +       int matches = 0;
> +
> +       if (!of_property_read_u32(of_node, field1, &val1))
> +               matches++;
> +
> +       if (!of_property_read_u32(of_node, field2, &val2))
> +               matches++;
> +
> +       if (!matches)
> +               return 0;
> +
> +       if (matches < 2)
> +               newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +                               MII_KSZ9031RN_CONTROL_PAD_SKEW);
> +       else
> +               newval = 0;
> +
> +       if (val1 != -1)
> +               newval = (newval & 0xfff0) |
> +                        (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +       if (val2 != -2)
> +               newval = (newval & 0xff0f) |
> +                        (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +       return ksz9031_extended_write(phydev, OP_DATA, 2,
> +                       MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
> +}
> +
> +static int ksz9031_config_init(struct phy_device *phydev)
> +{
> +       struct device *dev = &phydev->dev;
> +       struct device_node *of_node = dev->of_node;
> +
> +       if (!of_node && dev->parent->of_node)
> +               of_node = dev->parent->of_node;
> +
> +       if (of_node) {
> +               ksz9031_load_clk_skew_values(phydev, of_node,
> +                               "rxc-skew-ps", "txc-skew-ps");
> +
> +               ksz9031_load_data_skew_values(phydev, of_node,
> +                               MII_KSZ9031RN_RX_DATA_PAD_SKEW,
> +                               "rxd0-skew-ps", "rxd1-skew-ps",
> +                               "rxd2-skew-ps", "rxd3-skew-ps");
> +
> +               ksz9031_load_data_skew_values(phydev, of_node,
> +                               MII_KSZ9031RN_TX_DATA_PAD_SKEW,
> +                               "txd0-skew-ps", "txd1-skew-ps",
> +                               "txd2-skew-ps", "txd3-skew-ps");
> +
> +               ksz9031_load_ctrl_skew_values(phydev, of_node,
> +                               "txen-skew-ps", "rxdv-skew-ps");
> +       }
> +       return 0;
> +}
> +
>  #define KSZ8873MLL_GLOBAL_CONTROL_4    0x06
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX     (1 << 6)
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED      (1 << 4)
> @@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
>         .features       = (PHY_GBIT_FEATURES | SUPPORTED_Pause
>                                 | SUPPORTED_Asym_Pause),
>         .flags          = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
> -       .config_init    = kszphy_config_init,
> +       .config_init    = ksz9031_config_init,
>         .config_aneg    = genphy_config_aneg,
>         .read_status    = genphy_read_status,
>         .ack_interrupt  = kszphy_ack_interrupt,
> --
> 1.9.2
>



-- 
Florian

^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-22 15:49 [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031 Hubert Chaumette
  2014-04-22 16:10 ` Florian Fainelli
@ 2014-04-22 16:21 ` Alexandre Belloni
  2014-04-23  7:01   ` Hubert Chaumette
  1 sibling, 1 reply; 9+ messages in thread
From: Alexandre Belloni @ 2014-04-22 16:21 UTC (permalink / raw)
  To: Hubert Chaumette; +Cc: f.fainelli, netdev, linux-kernel, linux-arm-kernel

Hi,

As this is version two of your patch, you should probably use [PATCHv2].
Also, this doesn't have anything to do with i.mx6 anymore. I think youe
subject line should look like:
[PATCHv2] net: phy: micrel: Add DT configuration support for ksz9031

On 22/04/2014 at 17:49:08 +0200, Hubert Chaumette wrote :
> Adds support for ksz9031 PAD skew configuration over devicetree.
> 
> Changes since v1:
> - Removed ksz9021 and ksz9031 fixup deletions from arch/arm/mach-imx/mach-imx6q.c
> 
> Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
> ---
>  drivers/net/phy/micrel.c | 185 ++++++++++++++++++++++++++++++++++++++++++++++-
>  1 file changed, 184 insertions(+), 1 deletion(-)
> 
> diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
> index 5a8993b..df56b26 100644
> --- a/drivers/net/phy/micrel.c
> +++ b/drivers/net/phy/micrel.c
> @@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
>  	return 0;
>  }
>  
> +#define MII_KSZ9031RN_MMD_CTRL_REG	0x0d
> +#define MII_KSZ9031RN_MMD_REGDATA_REG	0x0e
> +#define OP_DATA				1
> +#define KSZ9031_PS_TO_REG		60
> +
> +/* Extended registers */
> +#define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
> +#define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
> +#define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
> +#define MII_KSZ9031RN_CLK_PAD_SKEW	8
> +
> +static int ksz9031_extended_write(struct phy_device *phydev,
> +				  u8 mode, u32 dev_addr, u32 regnum, u16 val)
> +{
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +	return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
> +}
> +
> +static int ksz9031_extended_read(struct phy_device *phydev,
> +				 u8 mode, u32 dev_addr, u32 regnum)
> +{
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +	return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
> +}
> +
> +/* Two 5-bit fields register */
> +static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
> +					struct device_node *of_node,
> +					char *field1, char *field2)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 2)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +				MII_KSZ9031RN_CLK_PAD_SKEW);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xffe0) |
> +			 ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xfc1f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2,
> +			MII_KSZ9031RN_CLK_PAD_SKEW, newval);
> +}
> +
> +/* Four 4-bit fields register */
> +static int ksz9031_load_data_skew_values(struct phy_device *phydev,
> +					 struct device_node *of_node, u16 reg,
> +					 char *field1, char *field2,
> +					 char *field3, char *field4)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int val3 = -3;
> +	int val4 = -4;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field3, &val3))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field4, &val4))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 4)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xfff0) |
> +			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xff0f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +	if (val3 != -3)
> +		newval = (newval & 0xf0ff) |
> +			 (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
> +
> +	if (val4 != -4)
> +		newval = (newval & 0x0fff) |
> +			 (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
> +}
> +
> +/* Two 4-bit fields register */
> +static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
> +					 struct device_node *of_node,
> +					 char *field1, char *field2)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 2)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +				MII_KSZ9031RN_CONTROL_PAD_SKEW);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xfff0) |
> +			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xff0f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2,
> +			MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
> +}
> +
> +static int ksz9031_config_init(struct phy_device *phydev)
> +{
> +	struct device *dev = &phydev->dev;
> +	struct device_node *of_node = dev->of_node;
> +
> +	if (!of_node && dev->parent->of_node)
> +		of_node = dev->parent->of_node;
> +
> +	if (of_node) {
> +		ksz9031_load_clk_skew_values(phydev, of_node,
> +				"rxc-skew-ps", "txc-skew-ps");
> +
> +		ksz9031_load_data_skew_values(phydev, of_node,
> +				MII_KSZ9031RN_RX_DATA_PAD_SKEW,
> +				"rxd0-skew-ps", "rxd1-skew-ps",
> +				"rxd2-skew-ps", "rxd3-skew-ps");
> +
> +		ksz9031_load_data_skew_values(phydev, of_node,
> +				MII_KSZ9031RN_TX_DATA_PAD_SKEW,
> +				"txd0-skew-ps", "txd1-skew-ps",
> +				"txd2-skew-ps", "txd3-skew-ps");
> +
> +		ksz9031_load_ctrl_skew_values(phydev, of_node,
> +				"txen-skew-ps", "rxdv-skew-ps");
> +	}
> +	return 0;
> +}
> +
>  #define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	(1 << 6)
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	(1 << 4)
> @@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
>  	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause
>  				| SUPPORTED_Asym_Pause),
>  	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
> -	.config_init	= kszphy_config_init,
> +	.config_init	= ksz9031_config_init,
>  	.config_aneg	= genphy_config_aneg,
>  	.read_status	= genphy_read_status,
>  	.ack_interrupt	= kszphy_ack_interrupt,
> -- 
> 1.9.2
> 
> 
> _______________________________________________
> linux-arm-kernel mailing list
> linux-arm-kernel@lists.infradead.org
> http://lists.infradead.org/mailman/listinfo/linux-arm-kernel

-- 
Alexandre Belloni, Free Electrons
Embedded Linux, Kernel and Android engineering
http://free-electrons.com

^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-22 16:21 ` Alexandre Belloni
@ 2014-04-23  7:01   ` Hubert Chaumette
  0 siblings, 0 replies; 9+ messages in thread
From: Hubert Chaumette @ 2014-04-23  7:01 UTC (permalink / raw)
  To: Alexandre Belloni; +Cc: f.fainelli, netdev, linux-kernel, linux-arm-kernel

Hi Alexandre,

Le mardi 22 avril 2014 à 18:21 +0200, Alexandre Belloni a écrit :
As this is version two of your patch, you should probably use [PATCHv2].
> 
Indeed, it seems --subject-prefix is *not* a /send-email/ option...

Also, this doesn't have anything to do with i.mx6 anymore. I think youe
> subject line should look like:
> [PATCHv2] net: phy: micrel: Add DT configuration support for ksz9031
 
I didn't change it to avoid breaking the patch's history. I'll do it for
next iterations. Thanks for your input.

Hubert


^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-22 16:10 ` Florian Fainelli
@ 2014-04-23  7:35   ` Hubert Chaumette
  2014-04-23 16:38     ` Florian Fainelli
  0 siblings, 1 reply; 9+ messages in thread
From: Hubert Chaumette @ 2014-04-23  7:35 UTC (permalink / raw)
  To: Florian Fainelli; +Cc: linux-kernel, linux-arm-kernel, netdev

Le mardi 22 avril 2014 à 09:10 -0700, Florian Fainelli a écrit :
> 2014-04-22 8:49 GMT-07:00 Hubert Chaumette <hchaumette@adeneo-embedded.com>:
> > Adds support for ksz9031 PAD skew configuration over devicetree.
> >
> > Changes since v1:
> > - Removed ksz9021 and ksz9031 fixup deletions from arch/arm/mach-imx/mach-imx6q.c
> 
> You should probably update the existing binding document in
> Documentation/devicetree/bindings/net/micrel-ksz9021.txt to cover the
> KSZ9031 PHY too.

Should it be renamed in the process (micrel-ksz90x1.txt) ?

> >
> > Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
> > ---
> >  drivers/net/phy/micrel.c | 185 ++++++++++++++++++++++++++++++++++++++++++++++-
> >  1 file changed, 184 insertions(+), 1 deletion(-)
> >
> > diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
> > index 5a8993b..df56b26 100644
> > --- a/drivers/net/phy/micrel.c
> > +++ b/drivers/net/phy/micrel.c
> > @@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
> >         return 0;
> >  }
> >
> > +#define MII_KSZ9031RN_MMD_CTRL_REG     0x0d
> > +#define MII_KSZ9031RN_MMD_REGDATA_REG  0x0e
> > +#define OP_DATA                                1
> > +#define KSZ9031_PS_TO_REG              60
> > +
> > +/* Extended registers */
> > +#define MII_KSZ9031RN_CONTROL_PAD_SKEW 4
> > +#define MII_KSZ9031RN_RX_DATA_PAD_SKEW 5
> > +#define MII_KSZ9031RN_TX_DATA_PAD_SKEW 6
> > +#define MII_KSZ9031RN_CLK_PAD_SKEW     8
> > +
> > +static int ksz9031_extended_write(struct phy_device *phydev,
> > +                                 u8 mode, u32 dev_addr, u32 regnum, u16 val)
> > +{
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> > +       return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
> > +}
> > +
> > +static int ksz9031_extended_read(struct phy_device *phydev,
> > +                                u8 mode, u32 dev_addr, u32 regnum)
> > +{
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> > +       return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
> > +}
> > +
> > +/* Two 5-bit fields register */
> > +static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
> > +                                       struct device_node *of_node,
> > +                                       char *field1, char *field2)
> > +{
> > +       int val1 = -1;
> > +       int val2 = -2;
> > +       int newval;
> > +       int matches = 0;
> > +
> > +       if (!of_property_read_u32(of_node, field1, &val1))
> > +               matches++;
> > +
> > +       if (!of_property_read_u32(of_node, field2, &val2))
> > +               matches++;
> > +
> > +       if (!matches)
> > +               return 0;
> > +
> > +       if (matches < 2)
> > +               newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> > +                               MII_KSZ9031RN_CLK_PAD_SKEW);
> > +       else
> > +               newval = 0;
> > +
> > +       if (val1 != -1)
> > +               newval = (newval & 0xffe0) |
> > +                        ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
> > +
> > +       if (val2 != -2)
> > +               newval = (newval & 0xfc1f) |
> > +                        (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
> > +
> > +       return ksz9031_extended_write(phydev, OP_DATA, 2,
> > +                       MII_KSZ9031RN_CLK_PAD_SKEW, newval);
> > +}
> > +
> > +/* Four 4-bit fields register */
> > +static int ksz9031_load_data_skew_values(struct phy_device *phydev,
> > +                                        struct device_node *of_node, u16 reg,
> > +                                        char *field1, char *field2,
> > +                                        char *field3, char *field4)
> > +{
> > +       int val1 = -1;
> > +       int val2 = -2;
> > +       int val3 = -3;
> > +       int val4 = -4;
> > +       int newval;
> > +       int matches = 0;
> > +
> > +       if (!of_property_read_u32(of_node, field1, &val1))
> > +               matches++;
> > +
> > +       if (!of_property_read_u32(of_node, field2, &val2))
> > +               matches++;
> > +
> > +       if (!of_property_read_u32(of_node, field3, &val3))
> > +               matches++;
> > +
> > +       if (!of_property_read_u32(of_node, field4, &val4))
> > +               matches++;
> > +
> > +       if (!matches)
> > +               return 0;
> > +
> > +       if (matches < 4)
> > +               newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
> > +       else
> > +               newval = 0;
> > +
> > +       if (val1 != -1)
> > +               newval = (newval & 0xfff0) |
> > +                        (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> > +
> > +       if (val2 != -2)
> > +               newval = (newval & 0xff0f) |
> > +                        (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> > +
> > +       if (val3 != -3)
> > +               newval = (newval & 0xf0ff) |
> > +                        (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
> > +
> > +       if (val4 != -4)
> > +               newval = (newval & 0x0fff) |
> > +                        (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
> 
> How about something like this:
> 
> for (i = 0; i < 4; i++) {
>             if (val[i] != -i) {
>                     mask = 0xffff;
>                     mask <<= (0 << (i * 4));
>                     newval = (newval & mask) |
>                            (((val[i] / KSZ9031_PS_TO_REG) & 0xf) << (i *4);
>             }
> }
> 
> Such that you could factor ksz9031_load_ctrl_skew_values() and
> ksz9031_load_data_skew_values() to specify the number of matches they
> should have?

I'm on it.

We could go further along this path and add a field length parameter to
also factor ksz9031_load_clk_skew_values()?
A similar loop could be used in ksz9021_load_values_from_of().

> > +
> > +       return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
> > +}
> > +
> > +/* Two 4-bit fields register */
> > +static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
> > +                                        struct device_node *of_node,
> > +                                        char *field1, char *field2)
> > +{
> > +       int val1 = -1;
> > +       int val2 = -2;
> > +       int newval;
> > +       int matches = 0;
> > +
> > +       if (!of_property_read_u32(of_node, field1, &val1))
> > +               matches++;
> > +
> > +       if (!of_property_read_u32(of_node, field2, &val2))
> > +               matches++;
> > +
> > +       if (!matches)
> > +               return 0;
> > +
> > +       if (matches < 2)
> > +               newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> > +                               MII_KSZ9031RN_CONTROL_PAD_SKEW);
> > +       else
> > +               newval = 0;
> > +
> > +       if (val1 != -1)
> > +               newval = (newval & 0xfff0) |
> > +                        (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> > +
> > +       if (val2 != -2)
> > +               newval = (newval & 0xff0f) |
> > +                        (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> > +
> > +       return ksz9031_extended_write(phydev, OP_DATA, 2,
> > +                       MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
> > +}
> > +
> > +static int ksz9031_config_init(struct phy_device *phydev)
> > +{
> > +       struct device *dev = &phydev->dev;
> > +       struct device_node *of_node = dev->of_node;
> > +
> > +       if (!of_node && dev->parent->of_node)
> > +               of_node = dev->parent->of_node;
> > +
> > +       if (of_node) {
> > +               ksz9031_load_clk_skew_values(phydev, of_node,
> > +                               "rxc-skew-ps", "txc-skew-ps");
> > +
> > +               ksz9031_load_data_skew_values(phydev, of_node,
> > +                               MII_KSZ9031RN_RX_DATA_PAD_SKEW,
> > +                               "rxd0-skew-ps", "rxd1-skew-ps",
> > +                               "rxd2-skew-ps", "rxd3-skew-ps");
> > +
> > +               ksz9031_load_data_skew_values(phydev, of_node,
> > +                               MII_KSZ9031RN_TX_DATA_PAD_SKEW,
> > +                               "txd0-skew-ps", "txd1-skew-ps",
> > +                               "txd2-skew-ps", "txd3-skew-ps");
> > +
> > +               ksz9031_load_ctrl_skew_values(phydev, of_node,
> > +                               "txen-skew-ps", "rxdv-skew-ps");
> > +       }
> > +       return 0;
> > +}
> > +
> >  #define KSZ8873MLL_GLOBAL_CONTROL_4    0x06
> >  #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX     (1 << 6)
> >  #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED      (1 << 4)
> > @@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
> >         .features       = (PHY_GBIT_FEATURES | SUPPORTED_Pause
> >                                 | SUPPORTED_Asym_Pause),
> >         .flags          = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
> > -       .config_init    = kszphy_config_init,
> > +       .config_init    = ksz9031_config_init,
> >         .config_aneg    = genphy_config_aneg,
> >         .read_status    = genphy_read_status,
> >         .ack_interrupt  = kszphy_ack_interrupt,
> > --
> > 1.9.2
> >




^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-23  7:35   ` Hubert Chaumette
@ 2014-04-23 16:38     ` Florian Fainelli
  0 siblings, 0 replies; 9+ messages in thread
From: Florian Fainelli @ 2014-04-23 16:38 UTC (permalink / raw)
  To: Hubert Chaumette; +Cc: linux-kernel, linux-arm-kernel, netdev

2014-04-23 0:35 GMT-07:00 Hubert Chaumette <hchaumette@adeneo-embedded.com>:
> Le mardi 22 avril 2014 à 09:10 -0700, Florian Fainelli a écrit :
>> 2014-04-22 8:49 GMT-07:00 Hubert Chaumette <hchaumette@adeneo-embedded.com>:
>> > Adds support for ksz9031 PAD skew configuration over devicetree.
>> >
>> > Changes since v1:
>> > - Removed ksz9021 and ksz9031 fixup deletions from arch/arm/mach-imx/mach-imx6q.c
>>
>> You should probably update the existing binding document in
>> Documentation/devicetree/bindings/net/micrel-ksz9021.txt to cover the
>> KSZ9031 PHY too.
>
> Should it be renamed in the process (micrel-ksz90x1.txt) ?

That's a good question, I suppose that you could proceed to a rename
after checking that this document is not referenced directly somewhere
else in Documentation/devicetree/bindings/

>
>> >
>> > Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
>> > ---
>> >  drivers/net/phy/micrel.c | 185 ++++++++++++++++++++++++++++++++++++++++++++++-
>> >  1 file changed, 184 insertions(+), 1 deletion(-)
>> >
>> > diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
>> > index 5a8993b..df56b26 100644
>> > --- a/drivers/net/phy/micrel.c
>> > +++ b/drivers/net/phy/micrel.c
>> > @@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
>> >         return 0;
>> >  }
>> >
>> > +#define MII_KSZ9031RN_MMD_CTRL_REG     0x0d
>> > +#define MII_KSZ9031RN_MMD_REGDATA_REG  0x0e
>> > +#define OP_DATA                                1
>> > +#define KSZ9031_PS_TO_REG              60
>> > +
>> > +/* Extended registers */
>> > +#define MII_KSZ9031RN_CONTROL_PAD_SKEW 4
>> > +#define MII_KSZ9031RN_RX_DATA_PAD_SKEW 5
>> > +#define MII_KSZ9031RN_TX_DATA_PAD_SKEW 6
>> > +#define MII_KSZ9031RN_CLK_PAD_SKEW     8
>> > +
>> > +static int ksz9031_extended_write(struct phy_device *phydev,
>> > +                                 u8 mode, u32 dev_addr, u32 regnum, u16 val)
>> > +{
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
>> > +       return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
>> > +}
>> > +
>> > +static int ksz9031_extended_read(struct phy_device *phydev,
>> > +                                u8 mode, u32 dev_addr, u32 regnum)
>> > +{
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
>> > +       phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
>> > +       return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
>> > +}
>> > +
>> > +/* Two 5-bit fields register */
>> > +static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
>> > +                                       struct device_node *of_node,
>> > +                                       char *field1, char *field2)
>> > +{
>> > +       int val1 = -1;
>> > +       int val2 = -2;
>> > +       int newval;
>> > +       int matches = 0;
>> > +
>> > +       if (!of_property_read_u32(of_node, field1, &val1))
>> > +               matches++;
>> > +
>> > +       if (!of_property_read_u32(of_node, field2, &val2))
>> > +               matches++;
>> > +
>> > +       if (!matches)
>> > +               return 0;
>> > +
>> > +       if (matches < 2)
>> > +               newval = ksz9031_extended_read(phydev, OP_DATA, 2,
>> > +                               MII_KSZ9031RN_CLK_PAD_SKEW);
>> > +       else
>> > +               newval = 0;
>> > +
>> > +       if (val1 != -1)
>> > +               newval = (newval & 0xffe0) |
>> > +                        ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
>> > +
>> > +       if (val2 != -2)
>> > +               newval = (newval & 0xfc1f) |
>> > +                        (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
>> > +
>> > +       return ksz9031_extended_write(phydev, OP_DATA, 2,
>> > +                       MII_KSZ9031RN_CLK_PAD_SKEW, newval);
>> > +}
>> > +
>> > +/* Four 4-bit fields register */
>> > +static int ksz9031_load_data_skew_values(struct phy_device *phydev,
>> > +                                        struct device_node *of_node, u16 reg,
>> > +                                        char *field1, char *field2,
>> > +                                        char *field3, char *field4)
>> > +{
>> > +       int val1 = -1;
>> > +       int val2 = -2;
>> > +       int val3 = -3;
>> > +       int val4 = -4;
>> > +       int newval;
>> > +       int matches = 0;
>> > +
>> > +       if (!of_property_read_u32(of_node, field1, &val1))
>> > +               matches++;
>> > +
>> > +       if (!of_property_read_u32(of_node, field2, &val2))
>> > +               matches++;
>> > +
>> > +       if (!of_property_read_u32(of_node, field3, &val3))
>> > +               matches++;
>> > +
>> > +       if (!of_property_read_u32(of_node, field4, &val4))
>> > +               matches++;
>> > +
>> > +       if (!matches)
>> > +               return 0;
>> > +
>> > +       if (matches < 4)
>> > +               newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
>> > +       else
>> > +               newval = 0;
>> > +
>> > +       if (val1 != -1)
>> > +               newval = (newval & 0xfff0) |
>> > +                        (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
>> > +
>> > +       if (val2 != -2)
>> > +               newval = (newval & 0xff0f) |
>> > +                        (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
>> > +
>> > +       if (val3 != -3)
>> > +               newval = (newval & 0xf0ff) |
>> > +                        (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
>> > +
>> > +       if (val4 != -4)
>> > +               newval = (newval & 0x0fff) |
>> > +                        (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
>>
>> How about something like this:
>>
>> for (i = 0; i < 4; i++) {
>>             if (val[i] != -i) {
>>                     mask = 0xffff;
>>                     mask <<= (0 << (i * 4));
>>                     newval = (newval & mask) |
>>                            (((val[i] / KSZ9031_PS_TO_REG) & 0xf) << (i *4);
>>             }
>> }
>>
>> Such that you could factor ksz9031_load_ctrl_skew_values() and
>> ksz9031_load_data_skew_values() to specify the number of matches they
>> should have?
>
> I'm on it.
>
> We could go further along this path and add a field length parameter to
> also factor ksz9031_load_clk_skew_values()?

Absolutely, that would be more future-proof and compact, so I am all
for it. Thanks!

> A similar loop could be used in ksz9021_load_values_from_of().
>
-- 
Florian

^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-16  8:03 ` Shawn Guo
@ 2014-04-22 16:09   ` Hubert Chaumette
  0 siblings, 0 replies; 9+ messages in thread
From: Hubert Chaumette @ 2014-04-22 16:09 UTC (permalink / raw)
  To: Shawn Guo
  Cc: linux-kernel, kernel, linux, f.fainelli, linux-arm-kernel, netdev, agust

Le mercredi 16 avril 2014 à 16:03 +0800, Shawn Guo a écrit :
> On Mon, Apr 14, 2014 at 11:08:16AM +0200, Hubert Chaumette wrote:
> > - Adds support for ksz9031 PAD skew configuration over devicetree
> > - Removes hard-coded pad skew configuration for imx6q-sabrelite, now redundant
> >   with arch/arm/boot/dts/imx6qdl-sabrelite.dtsi
> > 
> > Tested on congatec conga-QEVAL board with conga-QMX6 module.
> > 
> > This patch is based on Anatolij Gustschin's patch from
> > http://www.spinics.net/lists/arm-kernel/msg319771.html
> > 
> > Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
> > ---
> >  arch/arm/mach-imx/mach-imx6q.c |  45 ----------
> >  drivers/net/phy/micrel.c       | 185 ++++++++++++++++++++++++++++++++++++++++-
> 
> You should probably leave mach-imx6q.c unchanged, because dropping the
> phy fix-up from there may break old DTBs.  And the changes on micrel.c
> should be submitted to net maintainer.
> 
> Shawn

I've re-sent it without the changes to mach-imx6q.c. Thanks for your
review.

Regards,
Hubert


^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
  2014-04-14  9:08 Hubert Chaumette
@ 2014-04-16  8:03 ` Shawn Guo
  2014-04-22 16:09   ` Hubert Chaumette
  0 siblings, 1 reply; 9+ messages in thread
From: Shawn Guo @ 2014-04-16  8:03 UTC (permalink / raw)
  To: Hubert Chaumette
  Cc: linux-kernel, kernel, linux, f.fainelli, linux-arm-kernel, netdev, agust

On Mon, Apr 14, 2014 at 11:08:16AM +0200, Hubert Chaumette wrote:
> - Adds support for ksz9031 PAD skew configuration over devicetree
> - Removes hard-coded pad skew configuration for imx6q-sabrelite, now redundant
>   with arch/arm/boot/dts/imx6qdl-sabrelite.dtsi
> 
> Tested on congatec conga-QEVAL board with conga-QMX6 module.
> 
> This patch is based on Anatolij Gustschin's patch from
> http://www.spinics.net/lists/arm-kernel/msg319771.html
> 
> Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
> ---
>  arch/arm/mach-imx/mach-imx6q.c |  45 ----------
>  drivers/net/phy/micrel.c       | 185 ++++++++++++++++++++++++++++++++++++++++-

You should probably leave mach-imx6q.c unchanged, because dropping the
phy fix-up from there may break old DTBs.  And the changes on micrel.c
should be submitted to net maintainer.

Shawn

>  2 files changed, 184 insertions(+), 46 deletions(-)
> 
> diff --git a/arch/arm/mach-imx/mach-imx6q.c b/arch/arm/mach-imx/mach-imx6q.c
> index 76e5db4..21ad961 100644
> --- a/arch/arm/mach-imx/mach-imx6q.c
> +++ b/arch/arm/mach-imx/mach-imx6q.c
> @@ -39,47 +39,6 @@
>  #include "cpuidle.h"
>  #include "hardware.h"
>  
> -/* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
> -static int ksz9021rn_phy_fixup(struct phy_device *phydev)
> -{
> -	if (IS_BUILTIN(CONFIG_PHYLIB)) {
> -		/* min rx data delay */
> -		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
> -			0x8000 | MICREL_KSZ9021_RGMII_RX_DATA_PAD_SCEW);
> -		phy_write(phydev, MICREL_KSZ9021_EXTREG_DATA_WRITE, 0x0000);
> -
> -		/* max rx/tx clock delay, min rx/tx control delay */
> -		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
> -			0x8000 | MICREL_KSZ9021_RGMII_CLK_CTRL_PAD_SCEW);
> -		phy_write(phydev, MICREL_KSZ9021_EXTREG_DATA_WRITE, 0xf0f0);
> -		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
> -			MICREL_KSZ9021_RGMII_CLK_CTRL_PAD_SCEW);
> -	}
> -
> -	return 0;
> -}
> -
> -static void mmd_write_reg(struct phy_device *dev, int device, int reg, int val)
> -{
> -	phy_write(dev, 0x0d, device);
> -	phy_write(dev, 0x0e, reg);
> -	phy_write(dev, 0x0d, (1 << 14) | device);
> -	phy_write(dev, 0x0e, val);
> -}
> -
> -static int ksz9031rn_phy_fixup(struct phy_device *dev)
> -{
> -	/*
> -	 * min rx data delay, max rx/tx clock delay,
> -	 * min rx/tx control delay
> -	 */
> -	mmd_write_reg(dev, 2, 4, 0);
> -	mmd_write_reg(dev, 2, 5, 0);
> -	mmd_write_reg(dev, 2, 8, 0x003ff);
> -
> -	return 0;
> -}
> -
>  /*
>   * fixup for PLX PEX8909 bridge to configure GPIO1-7 as output High
>   * as they are used for slots1-7 PERST#
> @@ -169,10 +128,6 @@ static int ar8035_phy_fixup(struct phy_device *dev)
>  static void __init imx6q_enet_phy_init(void)
>  {
>  	if (IS_BUILTIN(CONFIG_PHYLIB)) {
> -		phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK,
> -				ksz9021rn_phy_fixup);
> -		phy_register_fixup_for_uid(PHY_ID_KSZ9031, MICREL_PHY_ID_MASK,
> -				ksz9031rn_phy_fixup);
>  		phy_register_fixup_for_uid(PHY_ID_AR8031, 0xffffffff,
>  				ar8031_phy_fixup);
>  		phy_register_fixup_for_uid(PHY_ID_AR8035, 0xffffffef,
> diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
> index 5a8993b..df56b26 100644
> --- a/drivers/net/phy/micrel.c
> +++ b/drivers/net/phy/micrel.c
> @@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
>  	return 0;
>  }
>  
> +#define MII_KSZ9031RN_MMD_CTRL_REG	0x0d
> +#define MII_KSZ9031RN_MMD_REGDATA_REG	0x0e
> +#define OP_DATA				1
> +#define KSZ9031_PS_TO_REG		60
> +
> +/* Extended registers */
> +#define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
> +#define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
> +#define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
> +#define MII_KSZ9031RN_CLK_PAD_SKEW	8
> +
> +static int ksz9031_extended_write(struct phy_device *phydev,
> +				  u8 mode, u32 dev_addr, u32 regnum, u16 val)
> +{
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +	return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
> +}
> +
> +static int ksz9031_extended_read(struct phy_device *phydev,
> +				 u8 mode, u32 dev_addr, u32 regnum)
> +{
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
> +	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
> +	return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
> +}
> +
> +/* Two 5-bit fields register */
> +static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
> +					struct device_node *of_node,
> +					char *field1, char *field2)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 2)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +				MII_KSZ9031RN_CLK_PAD_SKEW);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xffe0) |
> +			 ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xfc1f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2,
> +			MII_KSZ9031RN_CLK_PAD_SKEW, newval);
> +}
> +
> +/* Four 4-bit fields register */
> +static int ksz9031_load_data_skew_values(struct phy_device *phydev,
> +					 struct device_node *of_node, u16 reg,
> +					 char *field1, char *field2,
> +					 char *field3, char *field4)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int val3 = -3;
> +	int val4 = -4;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field3, &val3))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field4, &val4))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 4)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xfff0) |
> +			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xff0f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +	if (val3 != -3)
> +		newval = (newval & 0xf0ff) |
> +			 (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
> +
> +	if (val4 != -4)
> +		newval = (newval & 0x0fff) |
> +			 (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
> +}
> +
> +/* Two 4-bit fields register */
> +static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
> +					 struct device_node *of_node,
> +					 char *field1, char *field2)
> +{
> +	int val1 = -1;
> +	int val2 = -2;
> +	int newval;
> +	int matches = 0;
> +
> +	if (!of_property_read_u32(of_node, field1, &val1))
> +		matches++;
> +
> +	if (!of_property_read_u32(of_node, field2, &val2))
> +		matches++;
> +
> +	if (!matches)
> +		return 0;
> +
> +	if (matches < 2)
> +		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
> +				MII_KSZ9031RN_CONTROL_PAD_SKEW);
> +	else
> +		newval = 0;
> +
> +	if (val1 != -1)
> +		newval = (newval & 0xfff0) |
> +			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
> +
> +	if (val2 != -2)
> +		newval = (newval & 0xff0f) |
> +			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
> +
> +	return ksz9031_extended_write(phydev, OP_DATA, 2,
> +			MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
> +}
> +
> +static int ksz9031_config_init(struct phy_device *phydev)
> +{
> +	struct device *dev = &phydev->dev;
> +	struct device_node *of_node = dev->of_node;
> +
> +	if (!of_node && dev->parent->of_node)
> +		of_node = dev->parent->of_node;
> +
> +	if (of_node) {
> +		ksz9031_load_clk_skew_values(phydev, of_node,
> +				"rxc-skew-ps", "txc-skew-ps");
> +
> +		ksz9031_load_data_skew_values(phydev, of_node,
> +				MII_KSZ9031RN_RX_DATA_PAD_SKEW,
> +				"rxd0-skew-ps", "rxd1-skew-ps",
> +				"rxd2-skew-ps", "rxd3-skew-ps");
> +
> +		ksz9031_load_data_skew_values(phydev, of_node,
> +				MII_KSZ9031RN_TX_DATA_PAD_SKEW,
> +				"txd0-skew-ps", "txd1-skew-ps",
> +				"txd2-skew-ps", "txd3-skew-ps");
> +
> +		ksz9031_load_ctrl_skew_values(phydev, of_node,
> +				"txen-skew-ps", "rxdv-skew-ps");
> +	}
> +	return 0;
> +}
> +
>  #define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	(1 << 6)
>  #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	(1 << 4)
> @@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
>  	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause
>  				| SUPPORTED_Asym_Pause),
>  	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
> -	.config_init	= kszphy_config_init,
> +	.config_init	= ksz9031_config_init,
>  	.config_aneg	= genphy_config_aneg,
>  	.read_status	= genphy_read_status,
>  	.ack_interrupt	= kszphy_ack_interrupt,
> -- 
> 1.9.1
> 


^ permalink raw reply	[flat|nested] 9+ messages in thread

* [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031
@ 2014-04-14  9:08 Hubert Chaumette
  2014-04-16  8:03 ` Shawn Guo
  0 siblings, 1 reply; 9+ messages in thread
From: Hubert Chaumette @ 2014-04-14  9:08 UTC (permalink / raw)
  To: linux-kernel
  Cc: Hubert Chaumette, shawn.guo, kernel, linux, f.fainelli,
	linux-arm-kernel, netdev, agust

- Adds support for ksz9031 PAD skew configuration over devicetree
- Removes hard-coded pad skew configuration for imx6q-sabrelite, now redundant
  with arch/arm/boot/dts/imx6qdl-sabrelite.dtsi

Tested on congatec conga-QEVAL board with conga-QMX6 module.

This patch is based on Anatolij Gustschin's patch from
http://www.spinics.net/lists/arm-kernel/msg319771.html

Signed-off-by: Hubert Chaumette <hchaumette@adeneo-embedded.com>
---
 arch/arm/mach-imx/mach-imx6q.c |  45 ----------
 drivers/net/phy/micrel.c       | 185 ++++++++++++++++++++++++++++++++++++++++-
 2 files changed, 184 insertions(+), 46 deletions(-)

diff --git a/arch/arm/mach-imx/mach-imx6q.c b/arch/arm/mach-imx/mach-imx6q.c
index 76e5db4..21ad961 100644
--- a/arch/arm/mach-imx/mach-imx6q.c
+++ b/arch/arm/mach-imx/mach-imx6q.c
@@ -39,47 +39,6 @@
 #include "cpuidle.h"
 #include "hardware.h"
 
-/* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
-static int ksz9021rn_phy_fixup(struct phy_device *phydev)
-{
-	if (IS_BUILTIN(CONFIG_PHYLIB)) {
-		/* min rx data delay */
-		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
-			0x8000 | MICREL_KSZ9021_RGMII_RX_DATA_PAD_SCEW);
-		phy_write(phydev, MICREL_KSZ9021_EXTREG_DATA_WRITE, 0x0000);
-
-		/* max rx/tx clock delay, min rx/tx control delay */
-		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
-			0x8000 | MICREL_KSZ9021_RGMII_CLK_CTRL_PAD_SCEW);
-		phy_write(phydev, MICREL_KSZ9021_EXTREG_DATA_WRITE, 0xf0f0);
-		phy_write(phydev, MICREL_KSZ9021_EXTREG_CTRL,
-			MICREL_KSZ9021_RGMII_CLK_CTRL_PAD_SCEW);
-	}
-
-	return 0;
-}
-
-static void mmd_write_reg(struct phy_device *dev, int device, int reg, int val)
-{
-	phy_write(dev, 0x0d, device);
-	phy_write(dev, 0x0e, reg);
-	phy_write(dev, 0x0d, (1 << 14) | device);
-	phy_write(dev, 0x0e, val);
-}
-
-static int ksz9031rn_phy_fixup(struct phy_device *dev)
-{
-	/*
-	 * min rx data delay, max rx/tx clock delay,
-	 * min rx/tx control delay
-	 */
-	mmd_write_reg(dev, 2, 4, 0);
-	mmd_write_reg(dev, 2, 5, 0);
-	mmd_write_reg(dev, 2, 8, 0x003ff);
-
-	return 0;
-}
-
 /*
  * fixup for PLX PEX8909 bridge to configure GPIO1-7 as output High
  * as they are used for slots1-7 PERST#
@@ -169,10 +128,6 @@ static int ar8035_phy_fixup(struct phy_device *dev)
 static void __init imx6q_enet_phy_init(void)
 {
 	if (IS_BUILTIN(CONFIG_PHYLIB)) {
-		phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK,
-				ksz9021rn_phy_fixup);
-		phy_register_fixup_for_uid(PHY_ID_KSZ9031, MICREL_PHY_ID_MASK,
-				ksz9031rn_phy_fixup);
 		phy_register_fixup_for_uid(PHY_ID_AR8031, 0xffffffff,
 				ar8031_phy_fixup);
 		phy_register_fixup_for_uid(PHY_ID_AR8035, 0xffffffef,
diff --git a/drivers/net/phy/micrel.c b/drivers/net/phy/micrel.c
index 5a8993b..df56b26 100644
--- a/drivers/net/phy/micrel.c
+++ b/drivers/net/phy/micrel.c
@@ -242,6 +242,189 @@ static int ksz9021_config_init(struct phy_device *phydev)
 	return 0;
 }
 
+#define MII_KSZ9031RN_MMD_CTRL_REG	0x0d
+#define MII_KSZ9031RN_MMD_REGDATA_REG	0x0e
+#define OP_DATA				1
+#define KSZ9031_PS_TO_REG		60
+
+/* Extended registers */
+#define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
+#define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
+#define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
+#define MII_KSZ9031RN_CLK_PAD_SKEW	8
+
+static int ksz9031_extended_write(struct phy_device *phydev,
+				  u8 mode, u32 dev_addr, u32 regnum, u16 val)
+{
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
+	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
+	return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
+}
+
+static int ksz9031_extended_read(struct phy_device *phydev,
+				 u8 mode, u32 dev_addr, u32 regnum)
+{
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
+	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
+	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
+	return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
+}
+
+/* Two 5-bit fields register */
+static int ksz9031_load_clk_skew_values(struct phy_device *phydev,
+					struct device_node *of_node,
+					char *field1, char *field2)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 2)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
+				MII_KSZ9031RN_CLK_PAD_SKEW);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xffe0) |
+			 ((val1 / KSZ9031_PS_TO_REG) & 0x1f);
+
+	if (val2 != -2)
+		newval = (newval & 0xfc1f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0x1f) << 5);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2,
+			MII_KSZ9031RN_CLK_PAD_SKEW, newval);
+}
+
+/* Four 4-bit fields register */
+static int ksz9031_load_data_skew_values(struct phy_device *phydev,
+					 struct device_node *of_node, u16 reg,
+					 char *field1, char *field2,
+					 char *field3, char *field4)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int val3 = -3;
+	int val4 = -4;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field3, &val3))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field4, &val4))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 4)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xfff0) |
+			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
+
+	if (val2 != -2)
+		newval = (newval & 0xff0f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
+
+	if (val3 != -3)
+		newval = (newval & 0xf0ff) |
+			 (((val3 / KSZ9031_PS_TO_REG) & 0xf) << 8);
+
+	if (val4 != -4)
+		newval = (newval & 0x0fff) |
+			 (((val4 / KSZ9031_PS_TO_REG) & 0xf) << 12);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
+}
+
+/* Two 4-bit fields register */
+static int ksz9031_load_ctrl_skew_values(struct phy_device *phydev,
+					 struct device_node *of_node,
+					 char *field1, char *field2)
+{
+	int val1 = -1;
+	int val2 = -2;
+	int newval;
+	int matches = 0;
+
+	if (!of_property_read_u32(of_node, field1, &val1))
+		matches++;
+
+	if (!of_property_read_u32(of_node, field2, &val2))
+		matches++;
+
+	if (!matches)
+		return 0;
+
+	if (matches < 2)
+		newval = ksz9031_extended_read(phydev, OP_DATA, 2,
+				MII_KSZ9031RN_CONTROL_PAD_SKEW);
+	else
+		newval = 0;
+
+	if (val1 != -1)
+		newval = (newval & 0xfff0) |
+			 (((val1 / KSZ9031_PS_TO_REG) & 0xf) << 0);
+
+	if (val2 != -2)
+		newval = (newval & 0xff0f) |
+			 (((val2 / KSZ9031_PS_TO_REG) & 0xf) << 4);
+
+	return ksz9031_extended_write(phydev, OP_DATA, 2,
+			MII_KSZ9031RN_CONTROL_PAD_SKEW, newval);
+}
+
+static int ksz9031_config_init(struct phy_device *phydev)
+{
+	struct device *dev = &phydev->dev;
+	struct device_node *of_node = dev->of_node;
+
+	if (!of_node && dev->parent->of_node)
+		of_node = dev->parent->of_node;
+
+	if (of_node) {
+		ksz9031_load_clk_skew_values(phydev, of_node,
+				"rxc-skew-ps", "txc-skew-ps");
+
+		ksz9031_load_data_skew_values(phydev, of_node,
+				MII_KSZ9031RN_RX_DATA_PAD_SKEW,
+				"rxd0-skew-ps", "rxd1-skew-ps",
+				"rxd2-skew-ps", "rxd3-skew-ps");
+
+		ksz9031_load_data_skew_values(phydev, of_node,
+				MII_KSZ9031RN_TX_DATA_PAD_SKEW,
+				"txd0-skew-ps", "txd1-skew-ps",
+				"txd2-skew-ps", "txd3-skew-ps");
+
+		ksz9031_load_ctrl_skew_values(phydev, of_node,
+				"txen-skew-ps", "rxdv-skew-ps");
+	}
+	return 0;
+}
+
 #define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
 #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	(1 << 6)
 #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	(1 << 4)
@@ -428,7 +611,7 @@ static struct phy_driver ksphy_driver[] = {
 	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause
 				| SUPPORTED_Asym_Pause),
 	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
-	.config_init	= kszphy_config_init,
+	.config_init	= ksz9031_config_init,
 	.config_aneg	= genphy_config_aneg,
 	.read_status	= genphy_read_status,
 	.ack_interrupt	= kszphy_ack_interrupt,
-- 
1.9.1


^ permalink raw reply related	[flat|nested] 9+ messages in thread

end of thread, other threads:[~2014-04-23 16:38 UTC | newest]

Thread overview: 9+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2014-04-22 15:49 [PATCH] ARM: i.MX6: Add OF configuration support for ksz9031 Hubert Chaumette
2014-04-22 16:10 ` Florian Fainelli
2014-04-23  7:35   ` Hubert Chaumette
2014-04-23 16:38     ` Florian Fainelli
2014-04-22 16:21 ` Alexandre Belloni
2014-04-23  7:01   ` Hubert Chaumette
  -- strict thread matches above, loose matches on Subject: below --
2014-04-14  9:08 Hubert Chaumette
2014-04-16  8:03 ` Shawn Guo
2014-04-22 16:09   ` Hubert Chaumette

This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).