2 * Copyright Gavin Shan, IBM Corporation 2016.
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.
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>
17 #include <net/net_namespace.h>
23 static int ncsi_validate_aen_pkt(struct ncsi_aen_pkt_hdr *h,
24 const unsigned short payload)
29 if (h->common.revision != NCSI_PKT_REVISION)
31 if (ntohs(h->common.length) != payload)
34 /* Validate checksum, which might be zeroes if the
35 * sender doesn't support checksum according to NCSI
38 pchecksum = (__be32 *)((void *)(h + 1) + payload - 4);
39 if (ntohl(*pchecksum) == 0)
42 checksum = ncsi_calculate_checksum((unsigned char *)h,
43 sizeof(*h) + payload - 4);
44 if (*pchecksum != htonl(checksum))
50 static int ncsi_aen_handler_lsc(struct ncsi_dev_priv *ndp,
51 struct ncsi_aen_pkt_hdr *h)
53 struct ncsi_aen_lsc_pkt *lsc;
54 struct ncsi_channel *nc;
55 struct ncsi_channel_mode *ncm;
58 unsigned long old_data, data;
61 /* Find the NCSI channel */
62 ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc);
66 /* Update the link status */
67 lsc = (struct ncsi_aen_lsc_pkt *)h;
69 spin_lock_irqsave(&nc->lock, flags);
70 ncm = &nc->modes[NCSI_MODE_LINK];
71 old_data = ncm->data[2];
72 data = ntohl(lsc->status);
74 ncm->data[4] = ntohl(lsc->oem_status);
76 netdev_dbg(ndp->ndev.dev, "NCSI: LSC AEN - channel %u state %s\n",
77 nc->id, data & 0x1 ? "up" : "down");
79 chained = !list_empty(&nc->link);
81 spin_unlock_irqrestore(&nc->lock, flags);
83 if (!((old_data ^ data) & 0x1) || chained)
85 if (!(state == NCSI_CHANNEL_INACTIVE && (data & 0x1)) &&
86 !(state == NCSI_CHANNEL_ACTIVE && !(data & 0x1)))
89 if (state == NCSI_CHANNEL_ACTIVE)
90 ndp->flags |= NCSI_DEV_RESHUFFLE;
92 ncsi_stop_channel_monitor(nc);
93 spin_lock_irqsave(&ndp->lock, flags);
94 list_add_tail_rcu(&nc->link, &ndp->channel_queue);
95 spin_unlock_irqrestore(&ndp->lock, flags);
97 return ncsi_process_next_channel(ndp);
100 static int ncsi_aen_handler_cr(struct ncsi_dev_priv *ndp,
101 struct ncsi_aen_pkt_hdr *h)
103 struct ncsi_channel *nc;
106 /* Find the NCSI channel */
107 ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc);
111 spin_lock_irqsave(&nc->lock, flags);
112 if (!list_empty(&nc->link) ||
113 nc->state != NCSI_CHANNEL_ACTIVE) {
114 spin_unlock_irqrestore(&nc->lock, flags);
117 spin_unlock_irqrestore(&nc->lock, flags);
119 ncsi_stop_channel_monitor(nc);
120 spin_lock_irqsave(&nc->lock, flags);
121 nc->state = NCSI_CHANNEL_INVISIBLE;
122 spin_unlock_irqrestore(&nc->lock, flags);
124 spin_lock_irqsave(&ndp->lock, flags);
125 nc->state = NCSI_CHANNEL_INACTIVE;
126 list_add_tail_rcu(&nc->link, &ndp->channel_queue);
127 spin_unlock_irqrestore(&ndp->lock, flags);
129 return ncsi_process_next_channel(ndp);
132 static int ncsi_aen_handler_hncdsc(struct ncsi_dev_priv *ndp,
133 struct ncsi_aen_pkt_hdr *h)
135 struct ncsi_channel *nc;
136 struct ncsi_channel_mode *ncm;
137 struct ncsi_aen_hncdsc_pkt *hncdsc;
140 /* Find the NCSI channel */
141 ncsi_find_package_and_channel(ndp, h->common.channel, NULL, &nc);
145 spin_lock_irqsave(&nc->lock, flags);
146 ncm = &nc->modes[NCSI_MODE_LINK];
147 hncdsc = (struct ncsi_aen_hncdsc_pkt *)h;
148 ncm->data[3] = ntohl(hncdsc->status);
149 spin_unlock_irqrestore(&nc->lock, flags);
150 netdev_dbg(ndp->ndev.dev,
151 "NCSI: host driver %srunning on channel %u\n",
152 ncm->data[3] & 0x1 ? "" : "not ", nc->id);
157 static struct ncsi_aen_handler {
160 int (*handler)(struct ncsi_dev_priv *ndp,
161 struct ncsi_aen_pkt_hdr *h);
162 } ncsi_aen_handlers[] = {
163 { NCSI_PKT_AEN_LSC, 12, ncsi_aen_handler_lsc },
164 { NCSI_PKT_AEN_CR, 4, ncsi_aen_handler_cr },
165 { NCSI_PKT_AEN_HNCDSC, 8, ncsi_aen_handler_hncdsc }
168 int ncsi_aen_handler(struct ncsi_dev_priv *ndp, struct sk_buff *skb)
170 struct ncsi_aen_pkt_hdr *h;
171 struct ncsi_aen_handler *nah = NULL;
174 /* Find the handler */
175 h = (struct ncsi_aen_pkt_hdr *)skb_network_header(skb);
176 for (i = 0; i < ARRAY_SIZE(ncsi_aen_handlers); i++) {
177 if (ncsi_aen_handlers[i].type == h->type) {
178 nah = &ncsi_aen_handlers[i];
184 netdev_warn(ndp->ndev.dev, "Invalid AEN (0x%x) received\n",
189 ret = ncsi_validate_aen_pkt(h, nah->payload);
191 netdev_warn(ndp->ndev.dev,
192 "NCSI: 'bad' packet ignored for AEN type 0x%x\n",
197 ret = nah->handler(ndp, h);
199 netdev_err(ndp->ndev.dev,
200 "NCSI: Handler for AEN type 0x%x returned %d\n",