@@ -1833,12 +1836,281 @@ static bool ftgmac100_has_child_node(struct device_node *np, const char *name)
return ret;
}
+static int ftgmac100_get_ast2600_rgmii_flag(u32 delay)
+{
+ if ((delay > 500 && delay < 1500) ||
+ (delay > 2500 && delay < 7500))
+ return AST2600_RGMII_KEEP_DELAY;
+
+ return AST2600_RGMII_DIS_DELAY;
+}
+
+static int ftgmac100_check_ast2600_rgmii_delay(struct regmap *scu,
+ u32 delay_unit,
+ int mac_id, int dly_reg)
+{
+ u32 delay_value;
+ u32 tx_delay;
+ u32 rx_delay;
+ int tx_flag;
+ int rx_flag;
+
+ regmap_read(scu, dly_reg, &delay_value);
+ if (mac_id == 0 || mac_id == 2) {
+ tx_delay = FIELD_GET(ASPEED_MAC0_2_TX_DLY, delay_value);
+ rx_delay = FIELD_GET(ASPEED_MAC0_2_RX_DLY, delay_value);
+ } else {
+ tx_delay = FIELD_GET(ASPEED_MAC1_3_TX_DLY, delay_value);
+ rx_delay = FIELD_GET(ASPEED_MAC1_3_RX_DLY, delay_value);
+ }
+
+ /* Due to the hardware design reason, for MAC2/3 on AST2600,
+ * the zero delay ns on RX is configured by setting value 0x1a.
+ * List as below:
+ * 0x1a, 0x1b, ... , 0x1f, 0x00, 0x01, ... , 0x19
+ * Covert for calculation purpose.
+ * 0x00, 0x01, ... , 0x19, 0x1a, 0x1b, ... , 0x1f
+ */
+ if (mac_id == 2 || mac_id == 3)
+ rx_delay = (rx_delay + 0x06) & 0x1f;
+
+ tx_delay *= delay_unit;
+ rx_delay *= delay_unit;
+
+ tx_flag = ftgmac100_get_ast2600_rgmii_flag(tx_delay);
+ rx_flag = ftgmac100_get_ast2600_rgmii_flag(rx_delay);
+
+ if (tx_flag == AST2600_RGMII_KEEP_DELAY ||
+ rx_flag == AST2600_RGMII_KEEP_DELAY) {
+ return AST2600_RGMII_KEEP_DELAY;
+ }
+
+ return AST2600_RGMII_DIS_DELAY;
+}
+
+static int ftgmac100_set_ast2600_rgmii_delay(struct ftgmac100 *priv,
+ s32 rgmii_tx_delay,
+ s32 rgmii_rx_delay,
+ phy_interface_t *phy_intf)
+{
+ struct device *dev = priv->dev;
+ struct device_node *np;
+ u32 rgmii_delay_unit;
+ u32 rx_delay_index;
+ u32 tx_delay_index;
+ struct regmap *scu;
+ int dly_mask;
+ int dly_reg;
+ int mac_id;
+
+ np = dev->of_node;
+
+ scu = syscon_regmap_lookup_by_phandle(np, "aspeed,scu");
+ if (IS_ERR(scu)) {
+ dev_err(dev, "failed to get aspeed,scu");
+ return PTR_ERR(scu);
+ }
+
+ /* According to the register base address to specify the corresponding
+ * values.
+ */
+ switch (priv->res->start) {
+ case AST2600_MAC0_BASE_ADDR:
+ mac_id = 0;
+ rgmii_delay_unit = AST2600_MAC01_CLK_DLY_UNIT;
+ dly_reg = AST2600_MAC01_CLK_DLY;
+ break;
+ case AST2600_MAC1_BASE_ADDR:
+ mac_id = 1;
+ rgmii_delay_unit = AST2600_MAC01_CLK_DLY_UNIT;
+ dly_reg = AST2600_MAC01_CLK_DLY;
+ break;
+ case AST2600_MAC2_BASE_ADDR:
+ mac_id = 2;
+ rgmii_delay_unit = AST2600_MAC23_CLK_DLY_UNIT;
+ dly_reg = AST2600_MAC23_CLK_DLY;
+ break;
+ case AST2600_MAC3_BASE_ADDR:
+ mac_id = 3;
+ rgmii_delay_unit = AST2600_MAC23_CLK_DLY_UNIT;
+ dly_reg = AST2600_MAC23_CLK_DLY;
+ break;
+ default:
+ dev_err(dev, "Invalid mac base address");
+ return -EINVAL;
+ }
+
+ if (of_phy_is_fixed_link(np)) {
+ if (rgmii_tx_delay < 0 || rgmii_rx_delay < 0) {
+ dev_err(dev,
+ "Add rx/tx-internal-delay-ps for fixed-link\n");
+ /* Keep original RGMII delay value*/
+ return 0;
+ }
+
+ /* Must have both of rx/tx-internal-delay-ps for fixed-link */
+ goto conf_delay;
+ }
+
+ if (*phy_intf == PHY_INTERFACE_MODE_RGMII_RXID ||
+ *phy_intf == PHY_INTERFACE_MODE_RGMII_TXID)
+ goto out_warn;
+
+ if (*phy_intf != PHY_INTERFACE_MODE_RGMII &&
+ *phy_intf != PHY_INTERFACE_MODE_RGMII_ID)
+ return 0;
+
+ /* Both rx/tx-internal-delay-ps are not existed. */
+ if (rgmii_tx_delay < 0 && rgmii_rx_delay < 0) {
+ int flag;
+
+ flag = ftgmac100_check_ast2600_rgmii_delay(scu,
+ rgmii_delay_unit,
+ mac_id,
+ dly_reg);
+ if (flag == AST2600_RGMII_KEEP_DELAY)
+ goto out_warn;
+
+ if (*phy_intf == PHY_INTERFACE_MODE_RGMII) {
+ dev_err(dev, "Update phy-mode to 'rgmii-id'\n");
+ /* Forced phy interface to RGMII_ID and MAC will disable
+ * RGMII delay.
+ */
+ *phy_intf = PHY_INTERFACE_MODE_RGMII_ID;
+ }
+ } else {
+ /* Please refer to ethernet-controller.yaml. */
+ if (*phy_intf == PHY_INTERFACE_MODE_RGMII &&
+ (rgmii_tx_delay == 2000 || rgmii_rx_delay == 2000)) {
+ dev_warn(dev,
+ "RX/TX delay cannot set to 2000 on 'rgmii'\n");
+ return -EINVAL;
+ }
+ }
+
+ /* The value is negative, which means the rx/tx-internal-delay-ps
+ * property is not existed in dts. Therefore, set to default 0.
+ */
+ if (rgmii_tx_delay < 0)
+ rgmii_tx_delay = 0;
+ if (rgmii_rx_delay < 0)
+ rgmii_rx_delay = 0;
+
+conf_delay:
+ tx_delay_index = DIV_ROUND_CLOSEST(rgmii_tx_delay, rgmii_delay_unit);
+ if (tx_delay_index >= 32) {
+ dev_err(dev, "The %u ps of TX delay is out of range\n",
+ rgmii_tx_delay);
+ return -EINVAL;
+ }
+
+ rx_delay_index = DIV_ROUND_CLOSEST(rgmii_rx_delay, rgmii_delay_unit);
+ if (rx_delay_index >= 32) {
+ dev_err(dev, "The %u ps of RX delay is out of range\n",
+ rgmii_rx_delay);
+ return -EINVAL;
+ }
+
+ /* Due to the hardware design reason, for MAC2/3 on AST2600, the zero
+ * delay ns on RX is configured by setting value 0x1a.
+ * List as below:
+ * 0x1a -> 0 ns, 0x1b -> 0.25 ns, ... , 0x1f -> 1.25 ns,
+ * 0x00 -> 1.5 ns, 0x01 -> 1.75 ns, ... , 0x19 -> 7.75 ns, 0x1a -> 0 ns
+ */
+ if (mac_id == 2 || mac_id == 3)
+ rx_delay_index = (AST2600_MAC23_RX_DLY_0_NS + rx_delay_index) &
+ AST2600_MAC_TX_RX_DLY_MASK;
+
+ if (mac_id == 0 || mac_id == 2) {
+ dly_mask = ASPEED_MAC0_2_TX_DLY | ASPEED_MAC0_2_RX_DLY;
+ tx_delay_index = FIELD_PREP(ASPEED_MAC0_2_TX_DLY, tx_delay_index);
+ rx_delay_index = FIELD_PREP(ASPEED_MAC0_2_RX_DLY, rx_delay_index);
+ } else {
+ dly_mask = ASPEED_MAC1_3_TX_DLY | ASPEED_MAC1_3_RX_DLY;
+ tx_delay_index = FIELD_PREP(ASPEED_MAC1_3_TX_DLY, tx_delay_index);
+ rx_delay_index = FIELD_PREP(ASPEED_MAC1_3_RX_DLY, rx_delay_index);
+ }
+
+ regmap_update_bits(scu, dly_reg, dly_mask, tx_delay_index | rx_delay_index);
+
+ return 0;
+
+out_warn:
+ /* Print the warning message. Keep the phy-mode and the RGMII delay value. */
+ dev_warn(dev, "Update phy-mode to 'rgmii-id' and add rx/tx-internal-delay-ps\n");
+
+ return 0;
+}
+
+static int ftgmac100_set_internal_delay(struct ftgmac100 *priv,
+ phy_interface_t *phy_intf)
+{
+ struct device_node *np = priv->dev->of_node;
+ s32 rgmii_tx_delay;
+ s32 rgmii_rx_delay;
+ int err;
+
+ err = of_get_phy_mode(np, phy_intf);
+ if (err) {
+ dev_err(priv->dev, "Failed to get phy mode: %d\n", err);
+ return err;
+ }
+
+ if (!(of_device_is_compatible(np, "aspeed,ast2600-mac")))
+ return 0;
+
+ /* AST2600 needs to know if the "tx/rx-internal-delay-ps" properties
+ * are existed in dts. If not existed, set -1 and delay is equal to 0.
+ */
+ if (of_property_read_u32(np, "tx-internal-delay-ps", &rgmii_tx_delay))
+ rgmii_tx_delay = -1;
+ if (of_property_read_u32(np, "rx-internal-delay-ps", &rgmii_rx_delay))
+ rgmii_rx_delay = -1;
+
+ err = ftgmac100_set_ast2600_rgmii_delay(priv,
+ rgmii_tx_delay,
+ rgmii_rx_delay,
+ phy_intf);
+
+ return err;
+}
+
+static struct phy_device *ftgmac100_ast2600_phy_get(struct net_device *dev,
+ struct device_node *np,
+ void (*hndlr)(struct net_device *),
+ phy_interface_t phy_intf)
+{
+ struct device_node *phy_np;
+ struct phy_device *phy;
+ int ret;
+
+ if (of_phy_is_fixed_link(np)) {
+ ret = of_phy_register_fixed_link(np);
+ if (ret < 0) {
+ netdev_err(dev, "broken fixed-link specification\n");
+ return NULL;
+ }
+ phy_np = of_node_get(np);
+ } else {
+ phy_np = of_parse_phandle(np, "phy-handle", 0);
+ if (!phy_np)
+ return NULL;
+ }
+
+ phy = of_phy_connect(dev, phy_np, hndlr, 0, phy_intf);
+
+ of_node_put(phy_np);
+
+ return phy;
+}
+
static int ftgmac100_probe(struct platform_device *pdev)
{
struct resource *res;
int irq;
struct net_device *netdev;
struct phy_device *phydev;
+ phy_interface_t phy_intf;
struct ftgmac100 *priv;
struct device_node *np;
int err = 0;@@ -1955,8 +2231,16 @@ static int ftgmac100_probe(struct platform_device *pdev)
goto err_setup_mdio;
}
- phy = of_phy_get_and_connect(priv->netdev, np,
- &ftgmac100_adjust_link);
+ /* Because AST2600 will use the RGMII delay to determine
+ * which phy interface to use.
+ */
+ if (of_device_is_compatible(np, "aspeed,ast2600-mac"))
+ phy = ftgmac100_ast2600_phy_get(priv->netdev, np,
+ &ftgmac100_adjust_link,
+ phy_intf);
+ else
+ phy = of_phy_get_and_connect(priv->netdev, np,
+ &ftgmac100_adjust_link);
if (!phy) {
dev_err(&pdev->dev, "Failed to connect to phy\n");
err = -EINVAL;