Commit | Line | Data |
---|---|---|
7a82ecf4 GS |
1 | /* |
2 | * Copyright Gavin Shan, IBM Corporation 2016. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License as published by | |
6 | * the Free Software Foundation; either version 2 of the License, or | |
7 | * (at your option) any later version. | |
8 | */ | |
9 | ||
10 | #include <linux/module.h> | |
11 | #include <linux/kernel.h> | |
12 | #include <linux/init.h> | |
13 | #include <linux/netdevice.h> | |
14 | #include <linux/skbuff.h> | |
15 | ||
16 | #include <net/ncsi.h> | |
17 | #include <net/net_namespace.h> | |
18 | #include <net/sock.h> | |
19 | ||
20 | #include "internal.h" | |
21 | #include "ncsi-pkt.h" | |
22 | ||
23 | static int ncsi_validate_aen_pkt(struct ncsi_aen_pkt_hdr *h, | |
24 | const unsigned short payload) | |
25 | { | |
26 | u32 checksum; | |
27 | __be32 *pchecksum; | |
28 | ||
29 | if (h->common.revision != NCSI_PKT_REVISION) | |
30 | return -EINVAL; | |
31 | if (ntohs(h->common.length) != payload) | |
32 | return -EINVAL; | |
33 | ||
34 | /* Validate checksum, which might be zeroes if the | |
35 | * sender doesn't support checksum according to NCSI | |
36 | * specification. | |
37 | */ | |
38 | pchecksum = (__be32 *)((void *)(h + 1) + payload - 4); | |
39 | if (ntohl(*pchecksum) == 0) | |
40 | return 0; | |
41 | ||
42 | checksum = ncsi_calculate_checksum((unsigned char *)h, | |
43 | sizeof(*h) + payload - 4); | |
44 | if (*pchecksum != htonl(checksum)) | |
45 | return -EINVAL; | |
46 | ||
47 | return 0; | |
48 | } | |
49 | ||
50 | static int ncsi_aen_handler_lsc(struct ncsi_dev_priv *ndp, | |
51 | struct ncsi_aen_pkt_hdr *h) | |
52 | { | |
53 | struct ncsi_aen_lsc_pkt *lsc; | |
54 | struct ncsi_channel *nc; | |
55 | struct ncsi_channel_mode *ncm; | |
56 | unsigned long old_data; | |
57 | unsigned long flags; | |
58 | ||
59 | /* Find the NCSI channel */ | |
60 | ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc); | |
61 | if (!nc) | |
62 | return -ENODEV; | |
63 | ||
64 | /* Update the link status */ | |
65 | ncm = &nc->modes[NCSI_MODE_LINK]; | |
66 | lsc = (struct ncsi_aen_lsc_pkt *)h; | |
67 | old_data = ncm->data[2]; | |
68 | ncm->data[2] = ntohl(lsc->status); | |
69 | ncm->data[4] = ntohl(lsc->oem_status); | |
70 | if (!((old_data ^ ncm->data[2]) & 0x1) || | |
71 | !list_empty(&nc->link)) | |
72 | return 0; | |
73 | if (!(nc->state == NCSI_CHANNEL_INACTIVE && (ncm->data[2] & 0x1)) && | |
74 | !(nc->state == NCSI_CHANNEL_ACTIVE && !(ncm->data[2] & 0x1))) | |
75 | return 0; | |
76 | ||
77 | if (!(ndp->flags & NCSI_DEV_HWA) && | |
78 | nc->state == NCSI_CHANNEL_ACTIVE) | |
79 | ndp->flags |= NCSI_DEV_RESHUFFLE; | |
80 | ||
81 | ncsi_stop_channel_monitor(nc); | |
82 | spin_lock_irqsave(&ndp->lock, flags); | |
83 | list_add_tail_rcu(&nc->link, &ndp->channel_queue); | |
84 | spin_unlock_irqrestore(&ndp->lock, flags); | |
85 | ||
86 | return ncsi_process_next_channel(ndp); | |
87 | } | |
88 | ||
89 | static int ncsi_aen_handler_cr(struct ncsi_dev_priv *ndp, | |
90 | struct ncsi_aen_pkt_hdr *h) | |
91 | { | |
92 | struct ncsi_channel *nc; | |
93 | unsigned long flags; | |
94 | ||
95 | /* Find the NCSI channel */ | |
96 | ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc); | |
97 | if (!nc) | |
98 | return -ENODEV; | |
99 | ||
100 | if (!list_empty(&nc->link) || | |
101 | nc->state != NCSI_CHANNEL_ACTIVE) | |
102 | return 0; | |
103 | ||
104 | ncsi_stop_channel_monitor(nc); | |
105 | spin_lock_irqsave(&ndp->lock, flags); | |
106 | xchg(&nc->state, NCSI_CHANNEL_INACTIVE); | |
107 | list_add_tail_rcu(&nc->link, &ndp->channel_queue); | |
108 | spin_unlock_irqrestore(&ndp->lock, flags); | |
109 | ||
110 | return ncsi_process_next_channel(ndp); | |
111 | } | |
112 | ||
113 | static int ncsi_aen_handler_hncdsc(struct ncsi_dev_priv *ndp, | |
114 | struct ncsi_aen_pkt_hdr *h) | |
115 | { | |
116 | struct ncsi_channel *nc; | |
117 | struct ncsi_channel_mode *ncm; | |
118 | struct ncsi_aen_hncdsc_pkt *hncdsc; | |
119 | unsigned long flags; | |
120 | ||
121 | /* Find the NCSI channel */ | |
122 | ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc); | |
123 | if (!nc) | |
124 | return -ENODEV; | |
125 | ||
126 | /* If the channel is active one, we need reconfigure it */ | |
127 | ncm = &nc->modes[NCSI_MODE_LINK]; | |
128 | hncdsc = (struct ncsi_aen_hncdsc_pkt *)h; | |
129 | ncm->data[3] = ntohl(hncdsc->status); | |
130 | if (!list_empty(&nc->link) || | |
131 | nc->state != NCSI_CHANNEL_ACTIVE || | |
132 | (ncm->data[3] & 0x1)) | |
133 | return 0; | |
134 | ||
135 | if (ndp->flags & NCSI_DEV_HWA) | |
136 | ndp->flags |= NCSI_DEV_RESHUFFLE; | |
137 | ||
138 | /* If this channel is the active one and the link doesn't | |
139 | * work, we have to choose another channel to be active one. | |
140 | * The logic here is exactly similar to what we do when link | |
141 | * is down on the active channel. | |
142 | */ | |
143 | ncsi_stop_channel_monitor(nc); | |
144 | spin_lock_irqsave(&ndp->lock, flags); | |
145 | list_add_tail_rcu(&nc->link, &ndp->channel_queue); | |
146 | spin_unlock_irqrestore(&ndp->lock, flags); | |
147 | ||
148 | ncsi_process_next_channel(ndp); | |
149 | ||
150 | return 0; | |
151 | } | |
152 | ||
153 | static struct ncsi_aen_handler { | |
154 | unsigned char type; | |
155 | int payload; | |
156 | int (*handler)(struct ncsi_dev_priv *ndp, | |
157 | struct ncsi_aen_pkt_hdr *h); | |
158 | } ncsi_aen_handlers[] = { | |
159 | { NCSI_PKT_AEN_LSC, 12, ncsi_aen_handler_lsc }, | |
160 | { NCSI_PKT_AEN_CR, 4, ncsi_aen_handler_cr }, | |
161 | { NCSI_PKT_AEN_HNCDSC, 4, ncsi_aen_handler_hncdsc } | |
162 | }; | |
163 | ||
164 | int ncsi_aen_handler(struct ncsi_dev_priv *ndp, struct sk_buff *skb) | |
165 | { | |
166 | struct ncsi_aen_pkt_hdr *h; | |
167 | struct ncsi_aen_handler *nah = NULL; | |
168 | int i, ret; | |
169 | ||
170 | /* Find the handler */ | |
171 | h = (struct ncsi_aen_pkt_hdr *)skb_network_header(skb); | |
172 | for (i = 0; i < ARRAY_SIZE(ncsi_aen_handlers); i++) { | |
173 | if (ncsi_aen_handlers[i].type == h->type) { | |
174 | nah = &ncsi_aen_handlers[i]; | |
175 | break; | |
176 | } | |
177 | } | |
178 | ||
179 | if (!nah) { | |
180 | netdev_warn(ndp->ndev.dev, "Invalid AEN (0x%x) received\n", | |
181 | h->type); | |
182 | return -ENOENT; | |
183 | } | |
184 | ||
185 | ret = ncsi_validate_aen_pkt(h, nah->payload); | |
186 | if (ret) | |
187 | goto out; | |
188 | ||
189 | ret = nah->handler(ndp, h); | |
190 | out: | |
191 | consume_skb(skb); | |
192 | return ret; | |
193 | } |