]>
Commit | Line | Data |
---|---|---|
948faa46 SH |
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 | ||
81f3ddf2 | 39 | #include "main.h" |
948faa46 SH |
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 | ||
81f3ddf2 | 56 | struct sk_buff * |
948faa46 SH |
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 | ||
5d7c64a7 | 78 | int nfp_flower_cmsg_portmod(struct nfp_repr *repr, bool carrier_ok) |
948faa46 | 79 | { |
948faa46 SH |
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; | |
5d7c64a7 | 92 | msg->mtu = cpu_to_be16(repr->netdev->mtu); |
948faa46 SH |
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 | ||
bb3afda4 | 118 | if (link) |
948faa46 | 119 | netif_carrier_on(netdev); |
bb3afda4 | 120 | else |
948faa46 | 121 | netif_carrier_off(netdev); |
948faa46 SH |
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; | |
81f3ddf2 PJV |
143 | case NFP_FLOWER_CMSG_TYPE_FLOW_STATS: |
144 | nfp_flower_rx_flow_stats(app, skb); | |
145 | break; | |
948faa46 SH |
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 | } |