// SPDX-License-Identifier: GPL-2.0 /* Copyright (c) 2018, Sensor-Technik Wiedemann GmbH * Copyright (c) 2018-2019, Vladimir Oltean <[email protected]> */ #define pr_fmt(fmt) … #include <linux/delay.h> #include <linux/module.h> #include <linux/printk.h> #include <linux/spi/spi.h> #include <linux/errno.h> #include <linux/gpio/consumer.h> #include <linux/phylink.h> #include <linux/of.h> #include <linux/of_net.h> #include <linux/of_mdio.h> #include <linux/pcs/pcs-xpcs.h> #include <linux/netdev_features.h> #include <linux/netdevice.h> #include <linux/if_bridge.h> #include <linux/if_ether.h> #include <linux/dsa/8021q.h> #include <linux/units.h> #include "sja1105.h" #include "sja1105_tas.h" #define SJA1105_UNKNOWN_MULTICAST … /* Configure the optional reset pin and bring up switch */ static int sja1105_hw_reset(struct device *dev, unsigned int pulse_len, unsigned int startup_delay) { … } static void sja1105_port_allow_traffic(struct sja1105_l2_forwarding_entry *l2_fwd, int from, int to, bool allow) { … } static bool sja1105_can_forward(struct sja1105_l2_forwarding_entry *l2_fwd, int from, int to) { … } static int sja1105_is_vlan_configured(struct sja1105_private *priv, u16 vid) { … } static int sja1105_drop_untagged(struct dsa_switch *ds, int port, bool drop) { … } static int sja1105_pvid_apply(struct sja1105_private *priv, int port, u16 pvid) { … } static int sja1105_commit_pvid(struct dsa_switch *ds, int port) { … } static int sja1105_init_mac_settings(struct sja1105_private *priv) { … } static int sja1105_init_mii_settings(struct sja1105_private *priv) { … } static int sja1105_init_static_fdb(struct sja1105_private *priv) { … } static int sja1105_init_l2_lookup_params(struct sja1105_private *priv) { … } /* Set up a default VLAN for untagged traffic injected from the CPU * using management routes (e.g. STP, PTP) as opposed to tag_8021q. * All DT-defined ports are members of this VLAN, and there are no * restrictions on forwarding (since the CPU selects the destination). * Frames from this VLAN will always be transmitted as untagged, and * neither the bridge nor the 8021q module cannot create this VLAN ID. */ static int sja1105_init_static_vlan(struct sja1105_private *priv) { … } static int sja1105_init_l2_forwarding(struct sja1105_private *priv) { … } static int sja1110_init_pcp_remapping(struct sja1105_private *priv) { … } static int sja1105_init_l2_forwarding_params(struct sja1105_private *priv) { … } void sja1105_frame_memory_partitioning(struct sja1105_private *priv) { … } /* SJA1110 TDMACONFIGIDX values: * * | 100 Mbps ports | 1Gbps ports | 2.5Gbps ports | Disabled ports * -----+----------------+---------------+---------------+--------------- * 0 | 0, [5:10] | [1:2] | [3:4] | retag * 1 |0, [5:10], retag| [1:2] | [3:4] | - * 2 | 0, [5:10] | [1:3], retag | 4 | - * 3 | 0, [5:10] |[1:2], 4, retag| 3 | - * 4 | 0, 2, [5:10] | 1, retag | [3:4] | - * 5 | 0, 1, [5:10] | 2, retag | [3:4] | - * 14 | 0, [5:10] | [1:4], retag | - | - * 15 | [5:10] | [0:4], retag | - | - */ static void sja1110_select_tdmaconfigidx(struct sja1105_private *priv) { … } static int sja1105_init_topology(struct sja1105_private *priv, struct sja1105_general_params_entry *general_params) { … } static int sja1105_init_general_params(struct sja1105_private *priv) { … } static int sja1105_init_avb_params(struct sja1105_private *priv) { … } /* The L2 policing table is 2-stage. The table is looked up for each frame * according to the ingress port, whether it was broadcast or not, and the * classified traffic class (given by VLAN PCP). This portion of the lookup is * fixed, and gives access to the SHARINDX, an indirection register pointing * within the policing table itself, which is used to resolve the policer that * will be used for this frame. * * Stage 1 Stage 2 * +------------+--------+ +---------------------------------+ * |Port 0 TC 0 |SHARINDX| | Policer 0: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * |Port 0 TC 1 |SHARINDX| | Policer 1: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * ... | Policer 2: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * |Port 0 TC 7 |SHARINDX| | Policer 3: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * |Port 1 TC 0 |SHARINDX| | Policer 4: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * ... | Policer 5: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * |Port 1 TC 7 |SHARINDX| | Policer 6: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * ... | Policer 7: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * |Port 4 TC 7 |SHARINDX| ... * +------------+--------+ * |Port 0 BCAST|SHARINDX| ... * +------------+--------+ * |Port 1 BCAST|SHARINDX| ... * +------------+--------+ * ... ... * +------------+--------+ +---------------------------------+ * |Port 4 BCAST|SHARINDX| | Policer 44: Rate, Burst, MTU | * +------------+--------+ +---------------------------------+ * * In this driver, we shall use policers 0-4 as statically alocated port * (matchall) policers. So we need to make the SHARINDX for all lookups * corresponding to this ingress port (8 VLAN PCP lookups and 1 broadcast * lookup) equal. * The remaining policers (40) shall be dynamically allocated for flower * policers, where the key is either vlan_prio or dst_mac ff:ff:ff:ff:ff:ff. */ #define SJA1105_RATE_MBPS(speed) … static int sja1105_init_l2_policing(struct sja1105_private *priv) { … } static int sja1105_static_config_load(struct sja1105_private *priv) { … } /* This is the "new way" for a MAC driver to configure its RGMII delay lines, * based on the explicit "rx-internal-delay-ps" and "tx-internal-delay-ps" * properties. It has the advantage of working with fixed links and with PHYs * that apply RGMII delays too, and the MAC driver needs not perform any * special checks. * * Previously we were acting upon the "phy-mode" property when we were * operating in fixed-link, basically acting as a PHY, but with a reversed * interpretation: PHY_INTERFACE_MODE_RGMII_TXID means that the MAC should * behave as if it is connected to a PHY which has applied RGMII delays in the * TX direction. So if anything, RX delays should have been added by the MAC, * but we were adding TX delays. * * If the "{rx,tx}-internal-delay-ps" properties are not specified, we fall * back to the legacy behavior and apply delays on fixed-link ports based on * the reverse interpretation of the phy-mode. This is a deviation from the * expected default behavior which is to simply apply no delays. To achieve * that behavior with the new bindings, it is mandatory to specify * "{rx,tx}-internal-delay-ps" with a value of 0. */ static int sja1105_parse_rgmii_delays(struct sja1105_private *priv, int port, struct device_node *port_dn) { … } static int sja1105_parse_ports_node(struct sja1105_private *priv, struct device_node *ports_node) { … } static int sja1105_parse_dt(struct sja1105_private *priv) { … } /* Convert link speed from SJA1105 to ethtool encoding */ static int sja1105_port_speed_to_ethtool(struct sja1105_private *priv, u64 speed) { … } /* Set link speed in the MAC configuration for a specific port. */ static int sja1105_adjust_port_config(struct sja1105_private *priv, int port, int speed_mbps) { … } static struct phylink_pcs * sja1105_mac_select_pcs(struct phylink_config *config, phy_interface_t iface) { … } static void sja1105_mac_config(struct phylink_config *config, unsigned int mode, const struct phylink_link_state *state) { … } static void sja1105_mac_link_down(struct phylink_config *config, unsigned int mode, phy_interface_t interface) { … } static void sja1105_mac_link_up(struct phylink_config *config, struct phy_device *phydev, unsigned int mode, phy_interface_t interface, int speed, int duplex, bool tx_pause, bool rx_pause) { … } static void sja1105_phylink_get_caps(struct dsa_switch *ds, int port, struct phylink_config *config) { … } static int sja1105_find_static_fdb_entry(struct sja1105_private *priv, int port, const struct sja1105_l2_lookup_entry *requested) { … } /* We want FDB entries added statically through the bridge command to persist * across switch resets, which are a common thing during normal SJA1105 * operation. So we have to back them up in the static configuration tables * and hence apply them on next static config upload... yay! */ static int sja1105_static_fdb_change(struct sja1105_private *priv, int port, const struct sja1105_l2_lookup_entry *requested, bool keep) { … } /* First-generation switches have a 4-way set associative TCAM that * holds the FDB entries. An FDB index spans from 0 to 1023 and is comprised of * a "bin" (grouping of 4 entries) and a "way" (an entry within a bin). * For the placement of a newly learnt FDB entry, the switch selects the bin * based on a hash function, and the way within that bin incrementally. */ static int sja1105et_fdb_index(int bin, int way) { … } static int sja1105et_is_fdb_entry_in_bin(struct sja1105_private *priv, int bin, const u8 *addr, u16 vid, struct sja1105_l2_lookup_entry *match, int *last_unused) { … } int sja1105et_fdb_add(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid) { … } int sja1105et_fdb_del(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid) { … } int sja1105pqrs_fdb_add(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid) { … } int sja1105pqrs_fdb_del(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid) { … } static int sja1105_fdb_add(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid, struct dsa_db db) { … } static int __sja1105_fdb_del(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid, struct dsa_db db) { … } static int sja1105_fdb_del(struct dsa_switch *ds, int port, const unsigned char *addr, u16 vid, struct dsa_db db) { … } static int sja1105_fdb_dump(struct dsa_switch *ds, int port, dsa_fdb_dump_cb_t *cb, void *data) { … } static void sja1105_fast_age(struct dsa_switch *ds, int port) { … } static int sja1105_mdb_add(struct dsa_switch *ds, int port, const struct switchdev_obj_port_mdb *mdb, struct dsa_db db) { … } static int sja1105_mdb_del(struct dsa_switch *ds, int port, const struct switchdev_obj_port_mdb *mdb, struct dsa_db db) { … } /* Common function for unicast and broadcast flood configuration. * Flooding is configured between each {ingress, egress} port pair, and since * the bridge's semantics are those of "egress flooding", it means we must * enable flooding towards this port from all ingress ports that are in the * same forwarding domain. */ static int sja1105_manage_flood_domains(struct sja1105_private *priv) { … } static int sja1105_bridge_member(struct dsa_switch *ds, int port, struct dsa_bridge bridge, bool member) { … } static void sja1105_bridge_stp_state_set(struct dsa_switch *ds, int port, u8 state) { … } static int sja1105_bridge_join(struct dsa_switch *ds, int port, struct dsa_bridge bridge, bool *tx_fwd_offload, struct netlink_ext_ack *extack) { … } static void sja1105_bridge_leave(struct dsa_switch *ds, int port, struct dsa_bridge bridge) { … } /* Port 0 (the uC port) does not have CBS shapers */ #define SJA1110_FIXED_CBS(port, prio) … static int sja1105_find_cbs_shaper(struct sja1105_private *priv, int port, int prio) { … } static int sja1105_find_unused_cbs_shaper(struct sja1105_private *priv) { … } static int sja1105_delete_cbs_shaper(struct sja1105_private *priv, int port, int prio) { … } static int sja1105_setup_tc_cbs(struct dsa_switch *ds, int port, struct tc_cbs_qopt_offload *offload) { … } static int sja1105_reload_cbs(struct sja1105_private *priv) { … } static const char * const sja1105_reset_reasons[] = …; /* For situations where we need to change a setting at runtime that is only * available through the static configuration, resetting the switch in order * to upload the new static config is unavoidable. Back up the settings we * modify at runtime (currently only MAC) and restore them after uploading, * such that this operation is relatively seamless. */ int sja1105_static_config_reload(struct sja1105_private *priv, enum sja1105_reset_reason reason) { … } static enum dsa_tag_protocol sja1105_get_tag_protocol(struct dsa_switch *ds, int port, enum dsa_tag_protocol mp) { … } /* The TPID setting belongs to the General Parameters table, * which can only be partially reconfigured at runtime (and not the TPID). * So a switch reset is required. */ int sja1105_vlan_filtering(struct dsa_switch *ds, int port, bool enabled, struct netlink_ext_ack *extack) { … } static int sja1105_vlan_add(struct sja1105_private *priv, int port, u16 vid, u16 flags, bool allowed_ingress) { … } static int sja1105_vlan_del(struct sja1105_private *priv, int port, u16 vid) { … } static int sja1105_bridge_vlan_add(struct dsa_switch *ds, int port, const struct switchdev_obj_port_vlan *vlan, struct netlink_ext_ack *extack) { … } static int sja1105_bridge_vlan_del(struct dsa_switch *ds, int port, const struct switchdev_obj_port_vlan *vlan) { … } static int sja1105_dsa_8021q_vlan_add(struct dsa_switch *ds, int port, u16 vid, u16 flags) { … } static int sja1105_dsa_8021q_vlan_del(struct dsa_switch *ds, int port, u16 vid) { … } static int sja1105_prechangeupper(struct dsa_switch *ds, int port, struct netdev_notifier_changeupper_info *info) { … } static int sja1105_mgmt_xmit(struct dsa_switch *ds, int port, int slot, struct sk_buff *skb, bool takets) { … } #define work_to_xmit_work(w) … /* Deferred work is unfortunately necessary because setting up the management * route cannot be done from atomit context (SPI transfer takes a sleepable * lock on the bus) */ static void sja1105_port_deferred_xmit(struct kthread_work *work) { … } static int sja1105_connect_tag_protocol(struct dsa_switch *ds, enum dsa_tag_protocol proto) { … } /* The MAXAGE setting belongs to the L2 Forwarding Parameters table, * which cannot be reconfigured at runtime. So a switch reset is required. */ static int sja1105_set_ageing_time(struct dsa_switch *ds, unsigned int ageing_time) { … } static int sja1105_change_mtu(struct dsa_switch *ds, int port, int new_mtu) { … } static int sja1105_get_max_mtu(struct dsa_switch *ds, int port) { … } static int sja1105_port_setup_tc(struct dsa_switch *ds, int port, enum tc_setup_type type, void *type_data) { … } /* We have a single mirror (@to) port, but can configure ingress and egress * mirroring on all other (@from) ports. * We need to allow mirroring rules only as long as the @to port is always the * same, and we need to unset the @to port from mirr_port only when there is no * mirroring rule that references it. */ static int sja1105_mirror_apply(struct sja1105_private *priv, int from, int to, bool ingress, bool enabled) { … } static int sja1105_mirror_add(struct dsa_switch *ds, int port, struct dsa_mall_mirror_tc_entry *mirror, bool ingress, struct netlink_ext_ack *extack) { … } static void sja1105_mirror_del(struct dsa_switch *ds, int port, struct dsa_mall_mirror_tc_entry *mirror) { … } static int sja1105_port_policer_add(struct dsa_switch *ds, int port, struct dsa_mall_policer_tc_entry *policer) { … } static void sja1105_port_policer_del(struct dsa_switch *ds, int port) { … } static int sja1105_port_set_learning(struct sja1105_private *priv, int port, bool enabled) { … } static int sja1105_port_ucast_bcast_flood(struct sja1105_private *priv, int to, struct switchdev_brport_flags flags) { … } static int sja1105_port_mcast_flood(struct sja1105_private *priv, int to, struct switchdev_brport_flags flags, struct netlink_ext_ack *extack) { … } static int sja1105_port_pre_bridge_flags(struct dsa_switch *ds, int port, struct switchdev_brport_flags flags, struct netlink_ext_ack *extack) { … } static int sja1105_port_bridge_flags(struct dsa_switch *ds, int port, struct switchdev_brport_flags flags, struct netlink_ext_ack *extack) { … } /* The programming model for the SJA1105 switch is "all-at-once" via static * configuration tables. Some of these can be dynamically modified at runtime, * but not the xMII mode parameters table. * Furthermode, some PHYs may not have crystals for generating their clocks * (e.g. RMII). Instead, their 50MHz clock is supplied via the SJA1105 port's * ref_clk pin. So port clocking needs to be initialized early, before * connecting to PHYs is attempted, otherwise they won't respond through MDIO. * Setting correct PHY link speed does not matter now. * But dsa_user_phy_setup is called later than sja1105_setup, so the PHY * bindings are not yet parsed by DSA core. We need to parse early so that we * can populate the xMII mode parameters table. */ static int sja1105_setup(struct dsa_switch *ds) { … } static void sja1105_teardown(struct dsa_switch *ds) { … } static const struct phylink_mac_ops sja1105_phylink_mac_ops = …; static const struct dsa_switch_ops sja1105_switch_ops = …; static const struct of_device_id sja1105_dt_ids[]; static int sja1105_check_device_id(struct sja1105_private *priv) { … } static int sja1105_probe(struct spi_device *spi) { … } static void sja1105_remove(struct spi_device *spi) { … } static void sja1105_shutdown(struct spi_device *spi) { … } static const struct of_device_id sja1105_dt_ids[] = …; MODULE_DEVICE_TABLE(of, sja1105_dt_ids); static const struct spi_device_id sja1105_spi_ids[] = …; MODULE_DEVICE_TABLE(spi, sja1105_spi_ids); static struct spi_driver sja1105_driver = …; module_spi_driver(…) …; MODULE_AUTHOR(…) …; MODULE_AUTHOR(…) …; MODULE_DESCRIPTION(…) …; MODULE_LICENSE(…) …;
Codebase Browser
linux