blob: d463468442aedb6eaeee41327abae620257c8b4d [file] [log] [blame]
Gavin Shan7a82ecf2016-07-19 11:54:20 +10001/*
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
23static 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
50static 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
89static 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
113static 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
153static 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
164int 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);
190out:
191 consume_skb(skb);
192 return ret;
193}