dsa/sja1105/sja1105_main.c

126 	int match, rc;
134 	rc = sja1105_pvid_apply(priv, port, pvid);
135 	if (rc)
136 		return rc;
896 	int rc;
898 	rc = sja1105_init_topology(priv, &default_general_params);
899 	if (rc)
900 		return rc;
1064 	int rc;
1067 	rc = sja1105_static_config_init(&priv->static_config,
1070 	if (rc)
1071 		return rc;
1074 	rc = sja1105_init_mac_settings(priv);
1075 	if (rc < 0)
1076 		return rc;
1077 	rc = sja1105_init_mii_settings(priv);
1078 	if (rc < 0)
1079 		return rc;
1080 	rc = sja1105_init_static_fdb(priv);
1081 	if (rc < 0)
1082 		return rc;
1083 	rc = sja1105_init_static_vlan(priv);
1084 	if (rc < 0)
1085 		return rc;
1086 	rc = sja1105_init_l2_lookup_params(priv);
1087 	if (rc < 0)
1088 		return rc;
1089 	rc = sja1105_init_l2_forwarding(priv);
1090 	if (rc < 0)
1091 		return rc;
1092 	rc = sja1105_init_l2_forwarding_params(priv);
1093 	if (rc < 0)
1094 		return rc;
1095 	rc = sja1105_init_l2_policing(priv);
1096 	if (rc < 0)
1097 		return rc;
1098 	rc = sja1105_init_general_params(priv);
1099 	if (rc < 0)
1100 		return rc;
1101 	rc = sja1105_init_avb_params(priv);
1102 	if (rc < 0)
1103 		return rc;
1104 	rc = sja1110_init_pcp_remapping(priv);
1105 	if (rc < 0)
1106 		return rc;
1250 	int rc;
1260 	rc = sja1105_parse_ports_node(priv, ports_node);
1263 	return rc;
1288 	int rc;
1341 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_MAC_CONFIG, port,
1343 	if (rc < 0) {
1344 		dev_err(dev, "Failed to write MAC config: %d\n", rc);
1345 		return rc;
1468 	int rc, match;
1479 		rc = sja1105_table_resize(table, table->entry_count + 1);
1480 		if (rc)
1481 			return rc;
1558 	int bin, way, rc;
1603 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1606 	if (rc < 0)
1607 		return rc;
1614 		rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1616 		if (rc == -ENOENT)
1618 		if (rc)
1619 			return rc;
1624 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1626 		if (rc)
1627 			return rc;
1640 	int index, bin, way, rc;
1662 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1664 	if (rc < 0)
1665 		return rc;
1675 	int rc, i;
1686 	rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1688 	if (rc == 0 && tmp.index != SJA1105_MAX_L2_LOOKUP_COUNT - 1) {
1709 		rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1711 		if (rc < 0)
1723 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1726 	if (rc < 0)
1727 		return rc;
1742 	rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1744 	if (rc < 0) {
1747 			port, addr, vid, ERR_PTR(rc));
1748 		return rc;
1752 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1754 		if (rc < 0)
1755 			return rc;
1767 	int rc;
1775 	rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1777 	if (rc < 0)
1790 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
1792 	if (rc < 0)
1793 		return rc;
1803 	int rc;
1819 	rc = priv->info->fdb_add_cmd(ds, port, addr, vid);
1822 	return rc;
1852 	int rc;
1855 	rc = __sja1105_fdb_del(ds, port, addr, vid, db);
1858 	return rc;
1871 		int rc;
1873 		rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1876 		if (rc == -ENOENT)
1878 		if (rc) {
1879 			dev_err(dev, "Failed to dump FDB: %d\n", rc);
1880 			return rc;
1903 		rc = cb(macaddr, l2_lookup.vlanid, l2_lookup.lockeds, data);
1904 		if (rc)
1905 			return rc;
1928 		int rc;
1930 		rc = sja1105_dynamic_config_read(priv, BLK_IDX_L2_LOOKUP,
1933 		if (rc == -ENOENT)
1935 		if (rc) {
1937 				ERR_PTR(rc));
1950 		rc = __sja1105_fdb_del(ds, port, macaddr, l2_lookup.vlanid, db);
1951 		if (rc) {
1954 				macaddr, l2_lookup.vlanid, ERR_PTR(rc));
1986 	int from, to, rc;
2011 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_FORWARDING,
2013 		if (rc < 0)
2014 			return rc;
2025 	int i, rc;
2051 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_FORWARDING,
2053 		if (rc < 0)
2054 			return rc;
2057 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_FORWARDING,
2059 	if (rc)
2060 		return rc;
2062 	rc = sja1105_commit_pvid(ds, port);
2063 	if (rc)
2064 		return rc;
2119 	int rc;
2121 	rc = sja1105_bridge_member(ds, port, bridge, true);
2122 	if (rc)
2123 		return rc;
2125 	rc = dsa_tag_8021q_bridge_join(ds, port, bridge);
2126 	if (rc) {
2128 		return rc;
2250 	int rc = 0, i;
2264 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_CBS, i, cbs,
2266 		if (rc)
2270 	return rc;
2298 	int rc, i;
2324 	rc = __sja1105_ptp_gettimex(ds, &now, &ptp_sts_before);
2325 	if (rc < 0) {
2331 	rc = sja1105_static_config_upload(priv);
2332 	if (rc < 0) {
2337 	rc = __sja1105_ptp_settime(ds, 0, &ptp_sts_after);
2338 	if (rc < 0) {
2367 		rc = priv->info->clocking_setup(priv);
2368 		if (rc < 0)
2376 		rc = sja1105_adjust_port_config(priv, i, speed_mbps[i]);
2377 		if (rc < 0)
2388 		rc = xpcs_do_config(xpcs, priv->phy_mode[i], NULL, neg_mode);
2389 		if (rc < 0)
2409 	rc = sja1105_reload_cbs(priv);
2410 	if (rc < 0)
2416 	return rc;
2440 	int rc;
2471 		rc = sja1105_commit_pvid(ds, port);
2472 		if (rc)
2473 			return rc;
2476 	rc = sja1105_static_config_reload(priv, SJA1105_VLAN_FILTERING);
2477 	if (rc)
2480 	return rc;
2488 	int match, rc;
2494 		rc = sja1105_table_resize(table, table->entry_count + 1);
2495 		if (rc)
2496 			return rc;
2526 	int match, rc;
2552 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_VLAN_LOOKUP, vid,
2554 	if (rc < 0)
2555 		return rc;
2569 	int rc;
2583 	rc = sja1105_vlan_add(priv, port, vlan->vid, flags, true);
2584 	if (rc)
2585 		return rc;
2597 	int rc;
2599 	rc = sja1105_vlan_del(priv, port, vlan->vid);
2600 	if (rc)
2601 		return rc;
2614 	int rc;
2622 	rc = sja1105_vlan_add(priv, port, vid, flags, allowed_ingress);
2623 	if (rc)
2624 		return rc;
2674 	int rc;
2684 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_MGMT_ROUTE,
2686 	if (rc < 0) {
2688 		return rc;
2696 		rc = sja1105_dynamic_config_read(priv, BLK_IDX_MGMT_ROUTE,
2698 		if (rc < 0) {
2849 	int rc;
2883 		rc = sja1105_dynamic_config_write(priv, BLK_IDX_GENERAL_PARAMS,
2885 		if (rc < 0)
2886 			return rc;
2984 	int match, rc;
2999 		rc = -ENOSPC;
3008 	rc = sja1105_dynamic_config_write(priv, BLK_IDX_L2_LOOKUP,
3014 	return rc;
3047 	int rc;
3052 		rc = sja1105_port_set_learning(priv, port, learn_ena);
3053 		if (rc)
3054 			return rc;
3058 		rc = sja1105_port_ucast_bcast_flood(priv, port, flags);
3059 		if (rc)
3060 			return rc;
3068 		rc = sja1105_port_mcast_flood(priv, port, flags,
3070 		if (rc)
3071 			return rc;
3092 	int rc;
3095 		rc = priv->info->disable_microcontroller(priv);
3096 		if (rc < 0) {
3099 				ERR_PTR(rc));
3100 			return rc;
3105 	rc = sja1105_static_config_load(priv);
3106 	if (rc < 0) {
3107 		dev_err(ds->dev, "Failed to load static config: %d\n", rc);
3108 		return rc;
3113 		rc = priv->info->clocking_setup(priv);
3114 		if (rc < 0) {
3117 				ERR_PTR(rc));
3125 	rc = sja1105_ptp_clock_register(ds);
3126 	if (rc < 0) {
3127 		dev_err(ds->dev, "Failed to register PTP clock: %d\n", rc);
3131 	rc = sja1105_mdiobus_register(ds);
3132 	if (rc < 0) {
3134 			ERR_PTR(rc));
3138 	rc = sja1105_devlink_setup(ds);
3139 	if (rc < 0)
3143 	rc = dsa_tag_8021q_register(ds, htons(ETH_P_8021Q));
3145 	if (rc)
3182 	return rc;
3259 	int rc;
3261 	rc = sja1105_xfer_u32(priv, SPI_READ, regs->device_id, &device_id,
3263 	if (rc < 0)
3264 		return rc;
3266 	rc = sja1105_xfer_buf(priv, SPI_READ, regs->prod_id, prod_id,
3268 	if (rc < 0)
3269 		return rc;
3304 	int rc;
3311 	rc = sja1105_hw_reset(dev, 1, 1);
3312 	if (rc)
3313 		return rc;
3327 	rc = spi_setup(spi);
3328 	if (rc < 0) {
3330 		return rc;
3363 	rc = sja1105_check_device_id(priv);
3364 	if (rc < 0) {
3365 		dev_err(dev, "Device ID check failed: %d\n", rc);
3366 		return rc;
3387 	rc = sja1105_parse_dt(priv);
3388 	if (rc < 0) {
3389 		dev_err(ds->dev, "Failed to parse DT: %d\n", rc);
3390 		return rc;