123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- #include <linux/mrp_bridge.h>
- #include "br_private_mrp.h"
- static const u8 mrp_test_dmac[ETH_ALEN] = { 0x1, 0x15, 0x4e, 0x0, 0x0, 0x1 };
- static const u8 mrp_in_test_dmac[ETH_ALEN] = { 0x1, 0x15, 0x4e, 0x0, 0x0, 0x3 };
- static int br_mrp_process(struct net_bridge_port *p, struct sk_buff *skb);
- static struct br_frame_type mrp_frame_type __read_mostly = {
- .type = cpu_to_be16(ETH_P_MRP),
- .frame_handler = br_mrp_process,
- };
- static bool br_mrp_is_ring_port(struct net_bridge_port *p_port,
- struct net_bridge_port *s_port,
- struct net_bridge_port *port)
- {
- if (port == p_port ||
- port == s_port)
- return true;
- return false;
- }
- static bool br_mrp_is_in_port(struct net_bridge_port *i_port,
- struct net_bridge_port *port)
- {
- if (port == i_port)
- return true;
- return false;
- }
- static struct net_bridge_port *br_mrp_get_port(struct net_bridge *br,
- u32 ifindex)
- {
- struct net_bridge_port *res = NULL;
- struct net_bridge_port *port;
- list_for_each_entry(port, &br->port_list, list) {
- if (port->dev->ifindex == ifindex) {
- res = port;
- break;
- }
- }
- return res;
- }
- static struct br_mrp *br_mrp_find_id(struct net_bridge *br, u32 ring_id)
- {
- struct br_mrp *res = NULL;
- struct br_mrp *mrp;
- hlist_for_each_entry_rcu(mrp, &br->mrp_list, list,
- lockdep_rtnl_is_held()) {
- if (mrp->ring_id == ring_id) {
- res = mrp;
- break;
- }
- }
- return res;
- }
- static struct br_mrp *br_mrp_find_in_id(struct net_bridge *br, u32 in_id)
- {
- struct br_mrp *res = NULL;
- struct br_mrp *mrp;
- hlist_for_each_entry_rcu(mrp, &br->mrp_list, list,
- lockdep_rtnl_is_held()) {
- if (mrp->in_id == in_id) {
- res = mrp;
- break;
- }
- }
- return res;
- }
- static bool br_mrp_unique_ifindex(struct net_bridge *br, u32 ifindex)
- {
- struct br_mrp *mrp;
- hlist_for_each_entry_rcu(mrp, &br->mrp_list, list,
- lockdep_rtnl_is_held()) {
- struct net_bridge_port *p;
- p = rtnl_dereference(mrp->p_port);
- if (p && p->dev->ifindex == ifindex)
- return false;
- p = rtnl_dereference(mrp->s_port);
- if (p && p->dev->ifindex == ifindex)
- return false;
- p = rtnl_dereference(mrp->i_port);
- if (p && p->dev->ifindex == ifindex)
- return false;
- }
- return true;
- }
- static struct br_mrp *br_mrp_find_port(struct net_bridge *br,
- struct net_bridge_port *p)
- {
- struct br_mrp *res = NULL;
- struct br_mrp *mrp;
- hlist_for_each_entry_rcu(mrp, &br->mrp_list, list,
- lockdep_rtnl_is_held()) {
- if (rcu_access_pointer(mrp->p_port) == p ||
- rcu_access_pointer(mrp->s_port) == p ||
- rcu_access_pointer(mrp->i_port) == p) {
- res = mrp;
- break;
- }
- }
- return res;
- }
- static int br_mrp_next_seq(struct br_mrp *mrp)
- {
- mrp->seq_id++;
- return mrp->seq_id;
- }
- static struct sk_buff *br_mrp_skb_alloc(struct net_bridge_port *p,
- const u8 *src, const u8 *dst)
- {
- struct ethhdr *eth_hdr;
- struct sk_buff *skb;
- __be16 *version;
- skb = dev_alloc_skb(MRP_MAX_FRAME_LENGTH);
- if (!skb)
- return NULL;
- skb->dev = p->dev;
- skb->protocol = htons(ETH_P_MRP);
- skb->priority = MRP_FRAME_PRIO;
- skb_reserve(skb, sizeof(*eth_hdr));
- eth_hdr = skb_push(skb, sizeof(*eth_hdr));
- ether_addr_copy(eth_hdr->h_dest, dst);
- ether_addr_copy(eth_hdr->h_source, src);
- eth_hdr->h_proto = htons(ETH_P_MRP);
- version = skb_put(skb, sizeof(*version));
- *version = cpu_to_be16(MRP_VERSION);
- return skb;
- }
- static void br_mrp_skb_tlv(struct sk_buff *skb,
- enum br_mrp_tlv_header_type type,
- u8 length)
- {
- struct br_mrp_tlv_hdr *hdr;
- hdr = skb_put(skb, sizeof(*hdr));
- hdr->type = type;
- hdr->length = length;
- }
- static void br_mrp_skb_common(struct sk_buff *skb, struct br_mrp *mrp)
- {
- struct br_mrp_common_hdr *hdr;
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_COMMON, sizeof(*hdr));
- hdr = skb_put(skb, sizeof(*hdr));
- hdr->seq_id = cpu_to_be16(br_mrp_next_seq(mrp));
- memset(hdr->domain, 0xff, MRP_DOMAIN_UUID_LENGTH);
- }
- static struct sk_buff *br_mrp_alloc_test_skb(struct br_mrp *mrp,
- struct net_bridge_port *p,
- enum br_mrp_port_role_type port_role)
- {
- struct br_mrp_ring_test_hdr *hdr = NULL;
- struct sk_buff *skb = NULL;
- if (!p)
- return NULL;
- skb = br_mrp_skb_alloc(p, p->dev->dev_addr, mrp_test_dmac);
- if (!skb)
- return NULL;
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_RING_TEST, sizeof(*hdr));
- hdr = skb_put(skb, sizeof(*hdr));
- hdr->prio = cpu_to_be16(mrp->prio);
- ether_addr_copy(hdr->sa, p->br->dev->dev_addr);
- hdr->port_role = cpu_to_be16(port_role);
- hdr->state = cpu_to_be16(mrp->ring_state);
- hdr->transitions = cpu_to_be16(mrp->ring_transitions);
- hdr->timestamp = cpu_to_be32(jiffies_to_msecs(jiffies));
- br_mrp_skb_common(skb, mrp);
- /* In case the node behaves as MRA then the Test frame needs to have
- * an Option TLV which includes eventually a sub-option TLV that has
- * the type AUTO_MGR
- */
- if (mrp->ring_role == BR_MRP_RING_ROLE_MRA) {
- struct br_mrp_sub_option1_hdr *sub_opt = NULL;
- struct br_mrp_tlv_hdr *sub_tlv = NULL;
- struct br_mrp_oui_hdr *oui = NULL;
- u8 length;
- length = sizeof(*sub_opt) + sizeof(*sub_tlv) + sizeof(oui) +
- MRP_OPT_PADDING;
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_OPTION, length);
- oui = skb_put(skb, sizeof(*oui));
- memset(oui, 0x0, sizeof(*oui));
- sub_opt = skb_put(skb, sizeof(*sub_opt));
- memset(sub_opt, 0x0, sizeof(*sub_opt));
- sub_tlv = skb_put(skb, sizeof(*sub_tlv));
- sub_tlv->type = BR_MRP_SUB_TLV_HEADER_TEST_AUTO_MGR;
- /* 32 bit alligment shall be ensured therefore add 2 bytes */
- skb_put(skb, MRP_OPT_PADDING);
- }
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_END, 0x0);
- return skb;
- }
- static struct sk_buff *br_mrp_alloc_in_test_skb(struct br_mrp *mrp,
- struct net_bridge_port *p,
- enum br_mrp_port_role_type port_role)
- {
- struct br_mrp_in_test_hdr *hdr = NULL;
- struct sk_buff *skb = NULL;
- if (!p)
- return NULL;
- skb = br_mrp_skb_alloc(p, p->dev->dev_addr, mrp_in_test_dmac);
- if (!skb)
- return NULL;
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_IN_TEST, sizeof(*hdr));
- hdr = skb_put(skb, sizeof(*hdr));
- hdr->id = cpu_to_be16(mrp->in_id);
- ether_addr_copy(hdr->sa, p->br->dev->dev_addr);
- hdr->port_role = cpu_to_be16(port_role);
- hdr->state = cpu_to_be16(mrp->in_state);
- hdr->transitions = cpu_to_be16(mrp->in_transitions);
- hdr->timestamp = cpu_to_be32(jiffies_to_msecs(jiffies));
- br_mrp_skb_common(skb, mrp);
- br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_END, 0x0);
- return skb;
- }
- /* This function is continuously called in the following cases:
- * - when node role is MRM, in this case test_monitor is always set to false
- * because it needs to notify the userspace that the ring is open and needs to
- * send MRP_Test frames
- * - when node role is MRA, there are 2 subcases:
- * - when MRA behaves as MRM, in this case is similar with MRM role
- * - when MRA behaves as MRC, in this case test_monitor is set to true,
- * because it needs to detect when it stops seeing MRP_Test frames
- * from MRM node but it doesn't need to send MRP_Test frames.
- */
- static void br_mrp_test_work_expired(struct work_struct *work)
- {
- struct delayed_work *del_work = to_delayed_work(work);
- struct br_mrp *mrp = container_of(del_work, struct br_mrp, test_work);
- struct net_bridge_port *p;
- bool notify_open = false;
- struct sk_buff *skb;
- if (time_before_eq(mrp->test_end, jiffies))
- return;
- if (mrp->test_count_miss < mrp->test_max_miss) {
- mrp->test_count_miss++;
- } else {
- /* Notify that the ring is open only if the ring state is
- * closed, otherwise it would continue to notify at every
- * interval.
- * Also notify that the ring is open when the node has the
- * role MRA and behaves as MRC. The reason is that the
- * userspace needs to know when the MRM stopped sending
- * MRP_Test frames so that the current node to try to take
- * the role of a MRM.
- */
- if (mrp->ring_state == BR_MRP_RING_STATE_CLOSED ||
- mrp->test_monitor)
- notify_open = true;
- }
- rcu_read_lock();
- p = rcu_dereference(mrp->p_port);
- if (p) {
- if (!mrp->test_monitor) {
- skb = br_mrp_alloc_test_skb(mrp, p,
- BR_MRP_PORT_ROLE_PRIMARY);
- if (!skb)
- goto out;
- skb_reset_network_header(skb);
- dev_queue_xmit(skb);
- }
- if (notify_open && !mrp->ring_role_offloaded)
- br_mrp_ring_port_open(p->dev, true);
- }
- p = rcu_dereference(mrp->s_port);
- if (p) {
- if (!mrp->test_monitor) {
- skb = br_mrp_alloc_test_skb(mrp, p,
- BR_MRP_PORT_ROLE_SECONDARY);
- if (!skb)
- goto out;
- skb_reset_network_header(skb);
- dev_queue_xmit(skb);
- }
- if (notify_open && !mrp->ring_role_offloaded)
- br_mrp_ring_port_open(p->dev, true);
- }
- out:
- rcu_read_unlock();
- queue_delayed_work(system_wq, &mrp->test_work,
- usecs_to_jiffies(mrp->test_interval));
- }
- /* This function is continuously called when the node has the interconnect role
- * MIM. It would generate interconnect test frames and will send them on all 3
- * ports. But will also check if it stop receiving interconnect test frames.
- */
- static void br_mrp_in_test_work_expired(struct work_struct *work)
- {
- struct delayed_work *del_work = to_delayed_work(work);
- struct br_mrp *mrp = container_of(del_work, struct br_mrp, in_test_work);
- struct net_bridge_port *p;
- bool notify_open = false;
- struct sk_buff *skb;
- if (time_before_eq(mrp->in_test_end, jiffies))
- return;
- if (mrp->in_test_count_miss < mrp->in_test_max_miss) {
- mrp->in_test_count_miss++;
- } else {
- /* Notify that the interconnect ring is open only if the
- * interconnect ring state is closed, otherwise it would
- * continue to notify at every interval.
- */
- if (mrp->in_state == BR_MRP_IN_STATE_CLOSED)
- notify_open = true;
- }
- rcu_read_lock();
- p = rcu_dereference(mrp->p_port);
- if (p) {
- skb = br_mrp_alloc_in_test_skb(mrp, p,
- BR_MRP_PORT_ROLE_PRIMARY);
- if (!skb)
- goto out;
- skb_reset_network_header(skb);
- dev_queue_xmit(skb);
- if (notify_open && !mrp->in_role_offloaded)
- br_mrp_in_port_open(p->dev, true);
- }
- p = rcu_dereference(mrp->s_port);
- if (p) {
- skb = br_mrp_alloc_in_test_skb(mrp, p,
- BR_MRP_PORT_ROLE_SECONDARY);
- if (!skb)
- goto out;
- skb_reset_network_header(skb);
- dev_queue_xmit(skb);
- if (notify_open && !mrp->in_role_offloaded)
- br_mrp_in_port_open(p->dev, true);
- }
- p = rcu_dereference(mrp->i_port);
- if (p) {
- skb = br_mrp_alloc_in_test_skb(mrp, p,
- BR_MRP_PORT_ROLE_INTER);
- if (!skb)
- goto out;
- skb_reset_network_header(skb);
- dev_queue_xmit(skb);
- if (notify_open && !mrp->in_role_offloaded)
- br_mrp_in_port_open(p->dev, true);
- }
- out:
- rcu_read_unlock();
- queue_delayed_work(system_wq, &mrp->in_test_work,
- usecs_to_jiffies(mrp->in_test_interval));
- }
- /* Deletes the MRP instance.
- * note: called under rtnl_lock
- */
- static void br_mrp_del_impl(struct net_bridge *br, struct br_mrp *mrp)
- {
- struct net_bridge_port *p;
- u8 state;
- /* Stop sending MRP_Test frames */
- cancel_delayed_work_sync(&mrp->test_work);
- br_mrp_switchdev_send_ring_test(br, mrp, 0, 0, 0, 0);
- /* Stop sending MRP_InTest frames if has an interconnect role */
- cancel_delayed_work_sync(&mrp->in_test_work);
- br_mrp_switchdev_send_in_test(br, mrp, 0, 0, 0);
- /* Disable the roles */
- br_mrp_switchdev_set_ring_role(br, mrp, BR_MRP_RING_ROLE_DISABLED);
- p = rtnl_dereference(mrp->i_port);
- if (p)
- br_mrp_switchdev_set_in_role(br, mrp, mrp->in_id, mrp->ring_id,
- BR_MRP_IN_ROLE_DISABLED);
- br_mrp_switchdev_del(br, mrp);
- /* Reset the ports */
- p = rtnl_dereference(mrp->p_port);
- if (p) {
- spin_lock_bh(&br->lock);
- state = netif_running(br->dev) ?
- BR_STATE_FORWARDING : BR_STATE_DISABLED;
- p->state = state;
- p->flags &= ~BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- br_mrp_port_switchdev_set_state(p, state);
- rcu_assign_pointer(mrp->p_port, NULL);
- }
- p = rtnl_dereference(mrp->s_port);
- if (p) {
- spin_lock_bh(&br->lock);
- state = netif_running(br->dev) ?
- BR_STATE_FORWARDING : BR_STATE_DISABLED;
- p->state = state;
- p->flags &= ~BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- br_mrp_port_switchdev_set_state(p, state);
- rcu_assign_pointer(mrp->s_port, NULL);
- }
- p = rtnl_dereference(mrp->i_port);
- if (p) {
- spin_lock_bh(&br->lock);
- state = netif_running(br->dev) ?
- BR_STATE_FORWARDING : BR_STATE_DISABLED;
- p->state = state;
- p->flags &= ~BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- br_mrp_port_switchdev_set_state(p, state);
- rcu_assign_pointer(mrp->i_port, NULL);
- }
- hlist_del_rcu(&mrp->list);
- kfree_rcu(mrp, rcu);
- if (hlist_empty(&br->mrp_list))
- br_del_frame(br, &mrp_frame_type);
- }
- /* Adds a new MRP instance.
- * note: called under rtnl_lock
- */
- int br_mrp_add(struct net_bridge *br, struct br_mrp_instance *instance)
- {
- struct net_bridge_port *p;
- struct br_mrp *mrp;
- int err;
- /* If the ring exists, it is not possible to create another one with the
- * same ring_id
- */
- mrp = br_mrp_find_id(br, instance->ring_id);
- if (mrp)
- return -EINVAL;
- if (!br_mrp_get_port(br, instance->p_ifindex) ||
- !br_mrp_get_port(br, instance->s_ifindex))
- return -EINVAL;
- /* It is not possible to have the same port part of multiple rings */
- if (!br_mrp_unique_ifindex(br, instance->p_ifindex) ||
- !br_mrp_unique_ifindex(br, instance->s_ifindex))
- return -EINVAL;
- mrp = kzalloc(sizeof(*mrp), GFP_KERNEL);
- if (!mrp)
- return -ENOMEM;
- mrp->ring_id = instance->ring_id;
- mrp->prio = instance->prio;
- p = br_mrp_get_port(br, instance->p_ifindex);
- spin_lock_bh(&br->lock);
- p->state = BR_STATE_FORWARDING;
- p->flags |= BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- rcu_assign_pointer(mrp->p_port, p);
- p = br_mrp_get_port(br, instance->s_ifindex);
- spin_lock_bh(&br->lock);
- p->state = BR_STATE_FORWARDING;
- p->flags |= BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- rcu_assign_pointer(mrp->s_port, p);
- if (hlist_empty(&br->mrp_list))
- br_add_frame(br, &mrp_frame_type);
- INIT_DELAYED_WORK(&mrp->test_work, br_mrp_test_work_expired);
- INIT_DELAYED_WORK(&mrp->in_test_work, br_mrp_in_test_work_expired);
- hlist_add_tail_rcu(&mrp->list, &br->mrp_list);
- err = br_mrp_switchdev_add(br, mrp);
- if (err)
- goto delete_mrp;
- return 0;
- delete_mrp:
- br_mrp_del_impl(br, mrp);
- return err;
- }
- /* Deletes the MRP instance from which the port is part of
- * note: called under rtnl_lock
- */
- void br_mrp_port_del(struct net_bridge *br, struct net_bridge_port *p)
- {
- struct br_mrp *mrp = br_mrp_find_port(br, p);
- /* If the port is not part of a MRP instance just bail out */
- if (!mrp)
- return;
- br_mrp_del_impl(br, mrp);
- }
- /* Deletes existing MRP instance based on ring_id
- * note: called under rtnl_lock
- */
- int br_mrp_del(struct net_bridge *br, struct br_mrp_instance *instance)
- {
- struct br_mrp *mrp = br_mrp_find_id(br, instance->ring_id);
- if (!mrp)
- return -EINVAL;
- br_mrp_del_impl(br, mrp);
- return 0;
- }
- /* Set port state, port state can be forwarding, blocked or disabled
- * note: already called with rtnl_lock
- */
- int br_mrp_set_port_state(struct net_bridge_port *p,
- enum br_mrp_port_state_type state)
- {
- u32 port_state;
- if (!p || !(p->flags & BR_MRP_AWARE))
- return -EINVAL;
- spin_lock_bh(&p->br->lock);
- if (state == BR_MRP_PORT_STATE_FORWARDING)
- port_state = BR_STATE_FORWARDING;
- else
- port_state = BR_STATE_BLOCKING;
- p->state = port_state;
- spin_unlock_bh(&p->br->lock);
- br_mrp_port_switchdev_set_state(p, port_state);
- return 0;
- }
- /* Set port role, port role can be primary or secondary
- * note: already called with rtnl_lock
- */
- int br_mrp_set_port_role(struct net_bridge_port *p,
- enum br_mrp_port_role_type role)
- {
- struct br_mrp *mrp;
- if (!p || !(p->flags & BR_MRP_AWARE))
- return -EINVAL;
- mrp = br_mrp_find_port(p->br, p);
- if (!mrp)
- return -EINVAL;
- switch (role) {
- case BR_MRP_PORT_ROLE_PRIMARY:
- rcu_assign_pointer(mrp->p_port, p);
- break;
- case BR_MRP_PORT_ROLE_SECONDARY:
- rcu_assign_pointer(mrp->s_port, p);
- break;
- default:
- return -EINVAL;
- }
- br_mrp_port_switchdev_set_role(p, role);
- return 0;
- }
- /* Set ring state, ring state can be only Open or Closed
- * note: already called with rtnl_lock
- */
- int br_mrp_set_ring_state(struct net_bridge *br,
- struct br_mrp_ring_state *state)
- {
- struct br_mrp *mrp = br_mrp_find_id(br, state->ring_id);
- if (!mrp)
- return -EINVAL;
- if (mrp->ring_state != state->ring_state)
- mrp->ring_transitions++;
- mrp->ring_state = state->ring_state;
- br_mrp_switchdev_set_ring_state(br, mrp, state->ring_state);
- return 0;
- }
- /* Set ring role, ring role can be only MRM(Media Redundancy Manager) or
- * MRC(Media Redundancy Client).
- * note: already called with rtnl_lock
- */
- int br_mrp_set_ring_role(struct net_bridge *br,
- struct br_mrp_ring_role *role)
- {
- struct br_mrp *mrp = br_mrp_find_id(br, role->ring_id);
- enum br_mrp_hw_support support;
- if (!mrp)
- return -EINVAL;
- mrp->ring_role = role->ring_role;
- /* If there is an error just bailed out */
- support = br_mrp_switchdev_set_ring_role(br, mrp, role->ring_role);
- if (support == BR_MRP_NONE)
- return -EOPNOTSUPP;
- /* Now detect if the HW actually applied the role or not. If the HW
- * applied the role it means that the SW will not to do those operations
- * anymore. For example if the role ir MRM then the HW will notify the
- * SW when ring is open, but if the is not pushed to the HW the SW will
- * need to detect when the ring is open
- */
- mrp->ring_role_offloaded = support == BR_MRP_SW ? 0 : 1;
- return 0;
- }
- /* Start to generate or monitor MRP test frames, the frames are generated by
- * HW and if it fails, they are generated by the SW.
- * note: already called with rtnl_lock
- */
- int br_mrp_start_test(struct net_bridge *br,
- struct br_mrp_start_test *test)
- {
- struct br_mrp *mrp = br_mrp_find_id(br, test->ring_id);
- enum br_mrp_hw_support support;
- if (!mrp)
- return -EINVAL;
- /* Try to push it to the HW and if it fails then continue with SW
- * implementation and if that also fails then return error.
- */
- support = br_mrp_switchdev_send_ring_test(br, mrp, test->interval,
- test->max_miss, test->period,
- test->monitor);
- if (support == BR_MRP_NONE)
- return -EOPNOTSUPP;
- if (support == BR_MRP_HW)
- return 0;
- mrp->test_interval = test->interval;
- mrp->test_end = jiffies + usecs_to_jiffies(test->period);
- mrp->test_max_miss = test->max_miss;
- mrp->test_monitor = test->monitor;
- mrp->test_count_miss = 0;
- queue_delayed_work(system_wq, &mrp->test_work,
- usecs_to_jiffies(test->interval));
- return 0;
- }
- /* Set in state, int state can be only Open or Closed
- * note: already called with rtnl_lock
- */
- int br_mrp_set_in_state(struct net_bridge *br, struct br_mrp_in_state *state)
- {
- struct br_mrp *mrp = br_mrp_find_in_id(br, state->in_id);
- if (!mrp)
- return -EINVAL;
- if (mrp->in_state != state->in_state)
- mrp->in_transitions++;
- mrp->in_state = state->in_state;
- br_mrp_switchdev_set_in_state(br, mrp, state->in_state);
- return 0;
- }
- /* Set in role, in role can be only MIM(Media Interconnection Manager) or
- * MIC(Media Interconnection Client).
- * note: already called with rtnl_lock
- */
- int br_mrp_set_in_role(struct net_bridge *br, struct br_mrp_in_role *role)
- {
- struct br_mrp *mrp = br_mrp_find_id(br, role->ring_id);
- enum br_mrp_hw_support support;
- struct net_bridge_port *p;
- if (!mrp)
- return -EINVAL;
- if (!br_mrp_get_port(br, role->i_ifindex))
- return -EINVAL;
- if (role->in_role == BR_MRP_IN_ROLE_DISABLED) {
- u8 state;
- /* It is not allowed to disable a port that doesn't exist */
- p = rtnl_dereference(mrp->i_port);
- if (!p)
- return -EINVAL;
- /* Stop the generating MRP_InTest frames */
- cancel_delayed_work_sync(&mrp->in_test_work);
- br_mrp_switchdev_send_in_test(br, mrp, 0, 0, 0);
- /* Remove the port */
- spin_lock_bh(&br->lock);
- state = netif_running(br->dev) ?
- BR_STATE_FORWARDING : BR_STATE_DISABLED;
- p->state = state;
- p->flags &= ~BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- br_mrp_port_switchdev_set_state(p, state);
- rcu_assign_pointer(mrp->i_port, NULL);
- mrp->in_role = role->in_role;
- mrp->in_id = 0;
- return 0;
- }
- /* It is not possible to have the same port part of multiple rings */
- if (!br_mrp_unique_ifindex(br, role->i_ifindex))
- return -EINVAL;
- /* It is not allowed to set a different interconnect port if the mrp
- * instance has already one. First it needs to be disabled and after
- * that set the new port
- */
- if (rcu_access_pointer(mrp->i_port))
- return -EINVAL;
- p = br_mrp_get_port(br, role->i_ifindex);
- spin_lock_bh(&br->lock);
- p->state = BR_STATE_FORWARDING;
- p->flags |= BR_MRP_AWARE;
- spin_unlock_bh(&br->lock);
- rcu_assign_pointer(mrp->i_port, p);
- mrp->in_role = role->in_role;
- mrp->in_id = role->in_id;
- /* If there is an error just bailed out */
- support = br_mrp_switchdev_set_in_role(br, mrp, role->in_id,
- role->ring_id, role->in_role);
- if (support == BR_MRP_NONE)
- return -EOPNOTSUPP;
- /* Now detect if the HW actually applied the role or not. If the HW
- * applied the role it means that the SW will not to do those operations
- * anymore. For example if the role is MIM then the HW will notify the
- * SW when interconnect ring is open, but if the is not pushed to the HW
- * the SW will need to detect when the interconnect ring is open.
- */
- mrp->in_role_offloaded = support == BR_MRP_SW ? 0 : 1;
- return 0;
- }
- /* Start to generate MRP_InTest frames, the frames are generated by
- * HW and if it fails, they are generated by the SW.
- * note: already called with rtnl_lock
- */
- int br_mrp_start_in_test(struct net_bridge *br,
- struct br_mrp_start_in_test *in_test)
- {
- struct br_mrp *mrp = br_mrp_find_in_id(br, in_test->in_id);
- enum br_mrp_hw_support support;
- if (!mrp)
- return -EINVAL;
- if (mrp->in_role != BR_MRP_IN_ROLE_MIM)
- return -EINVAL;
- /* Try to push it to the HW and if it fails then continue with SW
- * implementation and if that also fails then return error.
- */
- support = br_mrp_switchdev_send_in_test(br, mrp, in_test->interval,
- in_test->max_miss,
- in_test->period);
- if (support == BR_MRP_NONE)
- return -EOPNOTSUPP;
- if (support == BR_MRP_HW)
- return 0;
- mrp->in_test_interval = in_test->interval;
- mrp->in_test_end = jiffies + usecs_to_jiffies(in_test->period);
- mrp->in_test_max_miss = in_test->max_miss;
- mrp->in_test_count_miss = 0;
- queue_delayed_work(system_wq, &mrp->in_test_work,
- usecs_to_jiffies(in_test->interval));
- return 0;
- }
- /* Determine if the frame type is a ring frame */
- static bool br_mrp_ring_frame(struct sk_buff *skb)
- {
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return false;
- if (hdr->type == BR_MRP_TLV_HEADER_RING_TEST ||
- hdr->type == BR_MRP_TLV_HEADER_RING_TOPO ||
- hdr->type == BR_MRP_TLV_HEADER_RING_LINK_DOWN ||
- hdr->type == BR_MRP_TLV_HEADER_RING_LINK_UP ||
- hdr->type == BR_MRP_TLV_HEADER_OPTION)
- return true;
- return false;
- }
- /* Determine if the frame type is an interconnect frame */
- static bool br_mrp_in_frame(struct sk_buff *skb)
- {
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return false;
- if (hdr->type == BR_MRP_TLV_HEADER_IN_TEST ||
- hdr->type == BR_MRP_TLV_HEADER_IN_TOPO ||
- hdr->type == BR_MRP_TLV_HEADER_IN_LINK_DOWN ||
- hdr->type == BR_MRP_TLV_HEADER_IN_LINK_UP ||
- hdr->type == BR_MRP_TLV_HEADER_IN_LINK_STATUS)
- return true;
- return false;
- }
- /* Process only MRP Test frame. All the other MRP frames are processed by
- * userspace application
- * note: already called with rcu_read_lock
- */
- static void br_mrp_mrm_process(struct br_mrp *mrp, struct net_bridge_port *port,
- struct sk_buff *skb)
- {
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- /* Each MRP header starts with a version field which is 16 bits.
- * Therefore skip the version and get directly the TLV header.
- */
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return;
- if (hdr->type != BR_MRP_TLV_HEADER_RING_TEST)
- return;
- mrp->test_count_miss = 0;
- /* Notify the userspace that the ring is closed only when the ring is
- * not closed
- */
- if (mrp->ring_state != BR_MRP_RING_STATE_CLOSED)
- br_mrp_ring_port_open(port->dev, false);
- }
- /* Determine if the test hdr has a better priority than the node */
- static bool br_mrp_test_better_than_own(struct br_mrp *mrp,
- struct net_bridge *br,
- const struct br_mrp_ring_test_hdr *hdr)
- {
- u16 prio = be16_to_cpu(hdr->prio);
- if (prio < mrp->prio ||
- (prio == mrp->prio &&
- ether_addr_to_u64(hdr->sa) < ether_addr_to_u64(br->dev->dev_addr)))
- return true;
- return false;
- }
- /* Process only MRP Test frame. All the other MRP frames are processed by
- * userspace application
- * note: already called with rcu_read_lock
- */
- static void br_mrp_mra_process(struct br_mrp *mrp, struct net_bridge *br,
- struct net_bridge_port *port,
- struct sk_buff *skb)
- {
- const struct br_mrp_ring_test_hdr *test_hdr;
- struct br_mrp_ring_test_hdr _test_hdr;
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- /* Each MRP header starts with a version field which is 16 bits.
- * Therefore skip the version and get directly the TLV header.
- */
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return;
- if (hdr->type != BR_MRP_TLV_HEADER_RING_TEST)
- return;
- test_hdr = skb_header_pointer(skb, sizeof(uint16_t) + sizeof(_hdr),
- sizeof(_test_hdr), &_test_hdr);
- if (!test_hdr)
- return;
- /* Only frames that have a better priority than the node will
- * clear the miss counter because otherwise the node will need to behave
- * as MRM.
- */
- if (br_mrp_test_better_than_own(mrp, br, test_hdr))
- mrp->test_count_miss = 0;
- }
- /* Process only MRP InTest frame. All the other MRP frames are processed by
- * userspace application
- * note: already called with rcu_read_lock
- */
- static bool br_mrp_mim_process(struct br_mrp *mrp, struct net_bridge_port *port,
- struct sk_buff *skb)
- {
- const struct br_mrp_in_test_hdr *in_hdr;
- struct br_mrp_in_test_hdr _in_hdr;
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- /* Each MRP header starts with a version field which is 16 bits.
- * Therefore skip the version and get directly the TLV header.
- */
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return false;
- /* The check for InTest frame type was already done */
- in_hdr = skb_header_pointer(skb, sizeof(uint16_t) + sizeof(_hdr),
- sizeof(_in_hdr), &_in_hdr);
- if (!in_hdr)
- return false;
- /* It needs to process only it's own InTest frames. */
- if (mrp->in_id != ntohs(in_hdr->id))
- return false;
- mrp->in_test_count_miss = 0;
- /* Notify the userspace that the ring is closed only when the ring is
- * not closed
- */
- if (mrp->in_state != BR_MRP_IN_STATE_CLOSED)
- br_mrp_in_port_open(port->dev, false);
- return true;
- }
- /* Get the MRP frame type
- * note: already called with rcu_read_lock
- */
- static u8 br_mrp_get_frame_type(struct sk_buff *skb)
- {
- const struct br_mrp_tlv_hdr *hdr;
- struct br_mrp_tlv_hdr _hdr;
- /* Each MRP header starts with a version field which is 16 bits.
- * Therefore skip the version and get directly the TLV header.
- */
- hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
- if (!hdr)
- return 0xff;
- return hdr->type;
- }
- static bool br_mrp_mrm_behaviour(struct br_mrp *mrp)
- {
- if (mrp->ring_role == BR_MRP_RING_ROLE_MRM ||
- (mrp->ring_role == BR_MRP_RING_ROLE_MRA && !mrp->test_monitor))
- return true;
- return false;
- }
- static bool br_mrp_mrc_behaviour(struct br_mrp *mrp)
- {
- if (mrp->ring_role == BR_MRP_RING_ROLE_MRC ||
- (mrp->ring_role == BR_MRP_RING_ROLE_MRA && mrp->test_monitor))
- return true;
- return false;
- }
- /* This will just forward the frame to the other mrp ring ports, depending on
- * the frame type, ring role and interconnect role
- * note: already called with rcu_read_lock
- */
- static int br_mrp_rcv(struct net_bridge_port *p,
- struct sk_buff *skb, struct net_device *dev)
- {
- struct net_bridge_port *p_port, *s_port, *i_port = NULL;
- struct net_bridge_port *p_dst, *s_dst, *i_dst = NULL;
- struct net_bridge *br;
- struct br_mrp *mrp;
- /* If port is disabled don't accept any frames */
- if (p->state == BR_STATE_DISABLED)
- return 0;
- br = p->br;
- mrp = br_mrp_find_port(br, p);
- if (unlikely(!mrp))
- return 0;
- p_port = rcu_dereference(mrp->p_port);
- if (!p_port)
- return 0;
- p_dst = p_port;
- s_port = rcu_dereference(mrp->s_port);
- if (!s_port)
- return 0;
- s_dst = s_port;
- /* If the frame is a ring frame then it is not required to check the
- * interconnect role and ports to process or forward the frame
- */
- if (br_mrp_ring_frame(skb)) {
- /* If the role is MRM then don't forward the frames */
- if (mrp->ring_role == BR_MRP_RING_ROLE_MRM) {
- br_mrp_mrm_process(mrp, p, skb);
- goto no_forward;
- }
- /* If the role is MRA then don't forward the frames if it
- * behaves as MRM node
- */
- if (mrp->ring_role == BR_MRP_RING_ROLE_MRA) {
- if (!mrp->test_monitor) {
- br_mrp_mrm_process(mrp, p, skb);
- goto no_forward;
- }
- br_mrp_mra_process(mrp, br, p, skb);
- }
- goto forward;
- }
- if (br_mrp_in_frame(skb)) {
- u8 in_type = br_mrp_get_frame_type(skb);
- i_port = rcu_dereference(mrp->i_port);
- i_dst = i_port;
- /* If the ring port is in block state it should not forward
- * In_Test frames
- */
- if (br_mrp_is_ring_port(p_port, s_port, p) &&
- p->state == BR_STATE_BLOCKING &&
- in_type == BR_MRP_TLV_HEADER_IN_TEST)
- goto no_forward;
- /* Nodes that behaves as MRM needs to stop forwarding the
- * frames in case the ring is closed, otherwise will be a loop.
- * In this case the frame is no forward between the ring ports.
- */
- if (br_mrp_mrm_behaviour(mrp) &&
- br_mrp_is_ring_port(p_port, s_port, p) &&
- (s_port->state != BR_STATE_FORWARDING ||
- p_port->state != BR_STATE_FORWARDING)) {
- p_dst = NULL;
- s_dst = NULL;
- }
- /* A node that behaves as MRC and doesn't have a interconnect
- * role then it should forward all frames between the ring ports
- * because it doesn't have an interconnect port
- */
- if (br_mrp_mrc_behaviour(mrp) &&
- mrp->in_role == BR_MRP_IN_ROLE_DISABLED)
- goto forward;
- if (mrp->in_role == BR_MRP_IN_ROLE_MIM) {
- if (in_type == BR_MRP_TLV_HEADER_IN_TEST) {
- /* MIM should not forward it's own InTest
- * frames
- */
- if (br_mrp_mim_process(mrp, p, skb)) {
- goto no_forward;
- } else {
- if (br_mrp_is_ring_port(p_port, s_port,
- p))
- i_dst = NULL;
- if (br_mrp_is_in_port(i_port, p))
- goto no_forward;
- }
- } else {
- /* MIM should forward IntLinkChange/Status and
- * IntTopoChange between ring ports but MIM
- * should not forward IntLinkChange/Status and
- * IntTopoChange if the frame was received at
- * the interconnect port
- */
- if (br_mrp_is_ring_port(p_port, s_port, p))
- i_dst = NULL;
- if (br_mrp_is_in_port(i_port, p))
- goto no_forward;
- }
- }
- if (mrp->in_role == BR_MRP_IN_ROLE_MIC) {
- /* MIC should forward InTest frames on all ports
- * regardless of the received port
- */
- if (in_type == BR_MRP_TLV_HEADER_IN_TEST)
- goto forward;
- /* MIC should forward IntLinkChange frames only if they
- * are received on ring ports to all the ports
- */
- if (br_mrp_is_ring_port(p_port, s_port, p) &&
- (in_type == BR_MRP_TLV_HEADER_IN_LINK_UP ||
- in_type == BR_MRP_TLV_HEADER_IN_LINK_DOWN))
- goto forward;
- /* MIC should forward IntLinkStatus frames only to
- * interconnect port if it was received on a ring port.
- * If it is received on interconnect port then, it
- * should be forward on both ring ports
- */
- if (br_mrp_is_ring_port(p_port, s_port, p) &&
- in_type == BR_MRP_TLV_HEADER_IN_LINK_STATUS) {
- p_dst = NULL;
- s_dst = NULL;
- }
- /* Should forward the InTopo frames only between the
- * ring ports
- */
- if (in_type == BR_MRP_TLV_HEADER_IN_TOPO) {
- i_dst = NULL;
- goto forward;
- }
- /* In all the other cases don't forward the frames */
- goto no_forward;
- }
- }
- forward:
- if (p_dst)
- br_forward(p_dst, skb, true, false);
- if (s_dst)
- br_forward(s_dst, skb, true, false);
- if (i_dst)
- br_forward(i_dst, skb, true, false);
- no_forward:
- return 1;
- }
- /* Check if the frame was received on a port that is part of MRP ring
- * and if the frame has MRP eth. In that case process the frame otherwise do
- * normal forwarding.
- * note: already called with rcu_read_lock
- */
- static int br_mrp_process(struct net_bridge_port *p, struct sk_buff *skb)
- {
- /* If there is no MRP instance do normal forwarding */
- if (likely(!(p->flags & BR_MRP_AWARE)))
- goto out;
- return br_mrp_rcv(p, skb, p->dev);
- out:
- return 0;
- }
- bool br_mrp_enabled(struct net_bridge *br)
- {
- return !hlist_empty(&br->mrp_list);
- }
|