drivers/net/ethernet/netronome/nfp/flower/cmsg.c

   1 /*
   2  * Copyright (C) 2015-2017 Netronome Systems, Inc.
   3  *
   4  * This software is dual licensed under the GNU General License Version 2,
   5  * June 1991 as shown in the file COPYING in the top-level directory of this
   6  * source tree or the BSD 2-Clause License provided below.  You have the
   7  * option to license this software under the complete terms of either license.
   8  *
   9  * The BSD 2-Clause License:
  10  *
  11  *     Redistribution and use in source and binary forms, with or
  12  *     without modification, are permitted provided that the following
  13  *     conditions are met:
  14  *
  15  *      1. Redistributions of source code must retain the above
  16  *         copyright notice, this list of conditions and the following
  17  *         disclaimer.
  18  *
  19  *      2. Redistributions in binary form must reproduce the above
  20  *         copyright notice, this list of conditions and the following
  21  *         disclaimer in the documentation and/or other materials
  22  *         provided with the distribution.
  23  *
  24  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31  * SOFTWARE.
  32  */
  33
  34 #include <linux/bitfield.h>
  35 #include <linux/netdevice.h>
  36 #include <linux/skbuff.h>
  37 #include <net/dst_metadata.h>
  38
  39 #include "main.h"
  40 #include "../nfpcore/nfp_cpp.h"
  41 #include "../nfp_net_repr.h"
  42 #include "./cmsg.h"
  43
  44 #define nfp_flower_cmsg_warn(app, fmt, args...)                         \
  45         do {                                                            \
  46                 if (net_ratelimit())                                    \
  47                         nfp_warn((app)->cpp, fmt, ## args);             \
  48         } while (0)
  49
  50 static struct nfp_flower_cmsg_hdr *
  51 nfp_flower_cmsg_get_hdr(struct sk_buff *skb)
  52 {
  53         return (struct nfp_flower_cmsg_hdr *)skb->data;
  54 }
  55
  56 struct sk_buff *
  57 nfp_flower_cmsg_alloc(struct nfp_app *app, unsigned int size,
  58                       enum nfp_flower_cmsg_type_port type)
  59 {
  60         struct nfp_flower_cmsg_hdr *ch;
  61         struct sk_buff *skb;
  62
  63         size += NFP_FLOWER_CMSG_HLEN;
  64
  65         skb = nfp_app_ctrl_msg_alloc(app, size, GFP_KERNEL);
  66         if (!skb)
  67                 return NULL;
  68
  69         ch = nfp_flower_cmsg_get_hdr(skb);
  70         ch->pad = 0;
  71         ch->version = NFP_FLOWER_CMSG_VER1;
  72         ch->type = type;
  73         skb_put(skb, size);
  74
  75         return skb;
  76 }
  77
  78 int nfp_flower_cmsg_portmod(struct nfp_repr *repr, bool carrier_ok)
  79 {
  80         struct nfp_flower_cmsg_portmod *msg;
  81         struct sk_buff *skb;
  82
  83         skb = nfp_flower_cmsg_alloc(repr->app, sizeof(*msg),
  84                                     NFP_FLOWER_CMSG_TYPE_PORT_MOD);
  85         if (!skb)
  86                 return -ENOMEM;
  87
  88         msg = nfp_flower_cmsg_get_data(skb);
  89         msg->portnum = cpu_to_be32(repr->dst->u.port_info.port_id);
  90         msg->reserved = 0;
  91         msg->info = carrier_ok;
  92         msg->mtu = cpu_to_be16(repr->netdev->mtu);
  93
  94         nfp_ctrl_tx(repr->app->ctrl, skb);
  95
  96         return 0;
  97 }
  98
  99 static void
 100 nfp_flower_cmsg_portmod_rx(struct nfp_app *app, struct sk_buff *skb)
 101 {
 102         struct nfp_flower_cmsg_portmod *msg;
 103         struct net_device *netdev;
 104         bool link;
 105
 106         msg = nfp_flower_cmsg_get_data(skb);
 107         link = msg->info & NFP_FLOWER_CMSG_PORTMOD_INFO_LINK;
 108
 109         rcu_read_lock();
 110         netdev = nfp_app_repr_get(app, be32_to_cpu(msg->portnum));
 111         if (!netdev) {
 112                 nfp_flower_cmsg_warn(app, "ctrl msg for unknown port 0x%08x\n",
 113                                      be32_to_cpu(msg->portnum));
 114                 rcu_read_unlock();
 115                 return;
 116         }
 117
 118         if (link)
 119                 netif_carrier_on(netdev);
 120         else
 121                 netif_carrier_off(netdev);
 122         rcu_read_unlock();
 123 }
 124
 125 void nfp_flower_cmsg_rx(struct nfp_app *app, struct sk_buff *skb)
 126 {
 127         struct nfp_flower_cmsg_hdr *cmsg_hdr;
 128         enum nfp_flower_cmsg_type_port type;
 129
 130         cmsg_hdr = nfp_flower_cmsg_get_hdr(skb);
 131
 132         if (unlikely(cmsg_hdr->version != NFP_FLOWER_CMSG_VER1)) {
 133                 nfp_flower_cmsg_warn(app, "Cannot handle repr control version %u\n",
 134                                      cmsg_hdr->version);
 135                 goto out;
 136         }
 137
 138         type = cmsg_hdr->type;
 139         switch (type) {
 140         case NFP_FLOWER_CMSG_TYPE_PORT_MOD:
 141                 nfp_flower_cmsg_portmod_rx(app, skb);
 142                 break;
 143         case NFP_FLOWER_CMSG_TYPE_FLOW_STATS:
 144                 nfp_flower_rx_flow_stats(app, skb);
 145                 break;
 146         default:
 147                 nfp_flower_cmsg_warn(app, "Cannot handle invalid repr control type %u\n",
 148                                      type);
 149         }
 150
 151 out:
 152         dev_kfree_skb_any(skb);
 153 }