2 * Copyright (c) 2006 - 2008 NetEffect, Inc. All rights reserved.
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
35 #define TCPOPT_TIMESTAMP 8
37 #include <asm/atomic.h>
38 #include <linux/skbuff.h>
40 #include <linux/tcp.h>
41 #include <linux/init.h>
42 #include <linux/if_arp.h>
43 #include <linux/if_vlan.h>
44 #include <linux/notifier.h>
45 #include <linux/net.h>
46 #include <linux/types.h>
47 #include <linux/timer.h>
48 #include <linux/time.h>
49 #include <linux/delay.h>
50 #include <linux/etherdevice.h>
51 #include <linux/netdevice.h>
52 #include <linux/random.h>
53 #include <linux/list.h>
54 #include <linux/threads.h>
56 #include <net/neighbour.h>
57 #include <net/route.h>
58 #include <net/ip_fib.h>
63 u32 cm_packets_bounced;
64 u32 cm_packets_dropped;
65 u32 cm_packets_retrans;
66 u32 cm_packets_created;
67 u32 cm_packets_received;
68 u32 cm_listens_created;
69 u32 cm_listens_destroyed;
71 atomic_t cm_loopbacks;
72 atomic_t cm_nodes_created;
73 atomic_t cm_nodes_destroyed;
74 atomic_t cm_accel_dropped_pkts;
75 atomic_t cm_resets_recvd;
77 static inline int mini_cm_accelerated(struct nes_cm_core *,
78 struct nes_cm_node *);
79 static struct nes_cm_listener *mini_cm_listen(struct nes_cm_core *,
80 struct nes_vnic *, struct nes_cm_info *);
81 static int mini_cm_del_listen(struct nes_cm_core *, struct nes_cm_listener *);
82 static struct nes_cm_node *mini_cm_connect(struct nes_cm_core *,
83 struct nes_vnic *, u16, void *, struct nes_cm_info *);
84 static int mini_cm_close(struct nes_cm_core *, struct nes_cm_node *);
85 static int mini_cm_accept(struct nes_cm_core *, struct ietf_mpa_frame *,
86 struct nes_cm_node *);
87 static int mini_cm_reject(struct nes_cm_core *, struct ietf_mpa_frame *,
88 struct nes_cm_node *);
89 static int mini_cm_recv_pkt(struct nes_cm_core *, struct nes_vnic *,
91 static int mini_cm_dealloc_core(struct nes_cm_core *);
92 static int mini_cm_get(struct nes_cm_core *);
93 static int mini_cm_set(struct nes_cm_core *, u32, u32);
95 static struct sk_buff *form_cm_frame(struct sk_buff *, struct nes_cm_node *,
96 void *, u32, void *, u32, u8);
97 static struct sk_buff *get_free_pkt(struct nes_cm_node *cm_node);
98 static int add_ref_cm_node(struct nes_cm_node *);
99 static int rem_ref_cm_node(struct nes_cm_core *, struct nes_cm_node *);
101 static int nes_cm_disconn_true(struct nes_qp *);
102 static int nes_cm_post_event(struct nes_cm_event *event);
103 static int nes_disconnect(struct nes_qp *nesqp, int abrupt);
104 static void nes_disconnect_worker(struct work_struct *work);
106 static int send_mpa_request(struct nes_cm_node *, struct sk_buff *);
107 static int send_syn(struct nes_cm_node *, u32, struct sk_buff *);
108 static int send_reset(struct nes_cm_node *, struct sk_buff *);
109 static int send_ack(struct nes_cm_node *cm_node, struct sk_buff *skb);
110 static int send_fin(struct nes_cm_node *cm_node, struct sk_buff *skb);
111 static void process_packet(struct nes_cm_node *, struct sk_buff *,
112 struct nes_cm_core *);
114 static void active_open_err(struct nes_cm_node *, struct sk_buff *, int);
115 static void passive_open_err(struct nes_cm_node *, struct sk_buff *, int);
116 static void cleanup_retrans_entry(struct nes_cm_node *);
117 static void handle_rcv_mpa(struct nes_cm_node *, struct sk_buff *,
118 enum nes_cm_event_type);
119 static void free_retrans_entry(struct nes_cm_node *cm_node);
120 static int handle_tcp_options(struct nes_cm_node *cm_node, struct tcphdr *tcph,
121 struct sk_buff *skb, int optionsize, int passive);
123 /* CM event handler functions */
124 static void cm_event_connected(struct nes_cm_event *);
125 static void cm_event_connect_error(struct nes_cm_event *);
126 static void cm_event_reset(struct nes_cm_event *);
127 static void cm_event_mpa_req(struct nes_cm_event *);
129 static void print_core(struct nes_cm_core *core);
131 /* External CM API Interface */
132 /* instance of function pointers for client API */
133 /* set address of this instance to cm_core->cm_ops at cm_core alloc */
134 static struct nes_cm_ops nes_cm_api = {
143 mini_cm_dealloc_core,
148 static struct nes_cm_core *g_cm_core;
150 atomic_t cm_connects;
152 atomic_t cm_disconnects;
154 atomic_t cm_connecteds;
155 atomic_t cm_connect_reqs;
162 static struct nes_cm_event *create_event(struct nes_cm_node *cm_node,
163 enum nes_cm_event_type type)
165 struct nes_cm_event *event;
170 /* allocate an empty event */
171 event = kzalloc(sizeof(*event), GFP_ATOMIC);
177 event->cm_node = cm_node;
178 event->cm_info.rem_addr = cm_node->rem_addr;
179 event->cm_info.loc_addr = cm_node->loc_addr;
180 event->cm_info.rem_port = cm_node->rem_port;
181 event->cm_info.loc_port = cm_node->loc_port;
182 event->cm_info.cm_id = cm_node->cm_id;
184 nes_debug(NES_DBG_CM, "cm_node=%p Created event=%p, type=%u, "
185 "dst_addr=%08x[%x], src_addr=%08x[%x]\n",
186 cm_node, event, type, event->cm_info.loc_addr,
187 event->cm_info.loc_port, event->cm_info.rem_addr,
188 event->cm_info.rem_port);
190 nes_cm_post_event(event);
198 static int send_mpa_request(struct nes_cm_node *cm_node, struct sk_buff *skb)
202 nes_debug(NES_DBG_CM, "skb set to NULL\n");
206 /* send an MPA Request frame */
207 form_cm_frame(skb, cm_node, NULL, 0, &cm_node->mpa_frame,
208 cm_node->mpa_frame_size, SET_ACK);
210 ret = schedule_nes_timer(cm_node, skb, NES_TIMER_TYPE_SEND, 1, 0);
219 * recv_mpa - process a received TCP pkt, we are expecting an
222 static int parse_mpa(struct nes_cm_node *cm_node, u8 *buffer, u32 len)
224 struct ietf_mpa_frame *mpa_frame;
226 /* assume req frame is in tcp data payload */
227 if (len < sizeof(struct ietf_mpa_frame)) {
228 nes_debug(NES_DBG_CM, "The received ietf buffer was too small (%x)\n", len);
232 mpa_frame = (struct ietf_mpa_frame *)buffer;
233 cm_node->mpa_frame_size = ntohs(mpa_frame->priv_data_len);
235 if (cm_node->mpa_frame_size + sizeof(struct ietf_mpa_frame) != len) {
236 nes_debug(NES_DBG_CM, "The received ietf buffer was not right"
237 " complete (%x + %x != %x)\n",
238 cm_node->mpa_frame_size, (u32)sizeof(struct ietf_mpa_frame), len);
242 /* copy entire MPA frame to our cm_node's frame */
243 memcpy(cm_node->mpa_frame_buf, buffer + sizeof(struct ietf_mpa_frame),
244 cm_node->mpa_frame_size);
251 * form_cm_frame - get a free packet and build empty frame Use
252 * node info to build.
254 static struct sk_buff *form_cm_frame(struct sk_buff *skb,
255 struct nes_cm_node *cm_node, void *options, u32 optionsize,
256 void *data, u32 datasize, u8 flags)
262 u16 packetsize = sizeof(*iph);
264 packetsize += sizeof(*tcph);
265 packetsize += optionsize + datasize;
267 memset(skb->data, 0x00, ETH_HLEN + sizeof(*iph) + sizeof(*tcph));
270 buf = skb_put(skb, packetsize + ETH_HLEN);
272 ethh = (struct ethhdr *) buf;
275 iph = (struct iphdr *)buf;
277 tcph = (struct tcphdr *)buf;
278 skb_reset_mac_header(skb);
279 skb_set_network_header(skb, ETH_HLEN);
280 skb_set_transport_header(skb, ETH_HLEN+sizeof(*iph));
281 buf += sizeof(*tcph);
283 skb->ip_summed = CHECKSUM_PARTIAL;
284 skb->protocol = htons(0x800);
286 skb->mac_len = ETH_HLEN;
288 memcpy(ethh->h_dest, cm_node->rem_mac, ETH_ALEN);
289 memcpy(ethh->h_source, cm_node->loc_mac, ETH_ALEN);
290 ethh->h_proto = htons(0x0800);
292 iph->version = IPVERSION;
293 iph->ihl = 5; /* 5 * 4Byte words, IP headr len */
295 iph->tot_len = htons(packetsize);
296 iph->id = htons(++cm_node->tcp_cntxt.loc_id);
298 iph->frag_off = htons(0x4000);
300 iph->protocol = 0x06; /* IPPROTO_TCP */
302 iph->saddr = htonl(cm_node->loc_addr);
303 iph->daddr = htonl(cm_node->rem_addr);
305 tcph->source = htons(cm_node->loc_port);
306 tcph->dest = htons(cm_node->rem_port);
307 tcph->seq = htonl(cm_node->tcp_cntxt.loc_seq_num);
309 if (flags & SET_ACK) {
310 cm_node->tcp_cntxt.loc_ack_num = cm_node->tcp_cntxt.rcv_nxt;
311 tcph->ack_seq = htonl(cm_node->tcp_cntxt.loc_ack_num);
316 if (flags & SET_SYN) {
317 cm_node->tcp_cntxt.loc_seq_num++;
320 cm_node->tcp_cntxt.loc_seq_num += datasize;
322 if (flags & SET_FIN) {
323 cm_node->tcp_cntxt.loc_seq_num++;
330 tcph->doff = (u16)((sizeof(*tcph) + optionsize + 3) >> 2);
331 tcph->window = htons(cm_node->tcp_cntxt.rcv_wnd);
334 memcpy(buf, options, optionsize);
337 memcpy(buf, data, datasize);
339 skb_shinfo(skb)->nr_frags = 0;
340 cm_packets_created++;
347 * print_core - dump a cm core
349 static void print_core(struct nes_cm_core *core)
351 nes_debug(NES_DBG_CM, "---------------------------------------------\n");
352 nes_debug(NES_DBG_CM, "CM Core -- (core = %p )\n", core);
355 nes_debug(NES_DBG_CM, "---------------------------------------------\n");
357 nes_debug(NES_DBG_CM, "State : %u \n", core->state);
359 nes_debug(NES_DBG_CM, "Tx Free cnt : %u \n", skb_queue_len(&core->tx_free_list));
360 nes_debug(NES_DBG_CM, "Listen Nodes : %u \n", atomic_read(&core->listen_node_cnt));
361 nes_debug(NES_DBG_CM, "Active Nodes : %u \n", atomic_read(&core->node_cnt));
363 nes_debug(NES_DBG_CM, "core : %p \n", core);
365 nes_debug(NES_DBG_CM, "-------------- end core ---------------\n");
371 * note - cm_node needs to be protected before calling this. Encase in:
372 * rem_ref_cm_node(cm_core, cm_node);add_ref_cm_node(cm_node);
374 int schedule_nes_timer(struct nes_cm_node *cm_node, struct sk_buff *skb,
375 enum nes_timer_type type, int send_retrans,
376 int close_when_complete)
379 struct nes_cm_core *cm_core = cm_node->cm_core;
380 struct nes_timer_entry *new_send;
386 new_send = kzalloc(sizeof(*new_send), GFP_ATOMIC);
390 /* new_send->timetosend = currenttime */
391 new_send->retrycount = NES_DEFAULT_RETRYS;
392 new_send->retranscount = NES_DEFAULT_RETRANS;
394 new_send->timetosend = jiffies;
395 new_send->type = type;
396 new_send->netdev = cm_node->netdev;
397 new_send->send_retrans = send_retrans;
398 new_send->close_when_complete = close_when_complete;
400 if (type == NES_TIMER_TYPE_CLOSE) {
401 new_send->timetosend += (HZ/10);
402 spin_lock_irqsave(&cm_node->recv_list_lock, flags);
403 list_add_tail(&new_send->list, &cm_node->recv_list);
404 spin_unlock_irqrestore(&cm_node->recv_list_lock, flags);
407 if (type == NES_TIMER_TYPE_SEND) {
408 new_send->seq_num = ntohl(tcp_hdr(skb)->seq);
409 atomic_inc(&new_send->skb->users);
410 spin_lock_irqsave(&cm_node->retrans_list_lock, flags);
411 cm_node->send_entry = new_send;
412 add_ref_cm_node(cm_node);
413 spin_unlock_irqrestore(&cm_node->retrans_list_lock, flags);
414 new_send->timetosend = jiffies + NES_RETRY_TIMEOUT;
416 ret = nes_nic_cm_xmit(new_send->skb, cm_node->netdev);
417 if (ret != NETDEV_TX_OK) {
418 nes_debug(NES_DBG_CM, "Error sending packet %p "
419 "(jiffies = %lu)\n", new_send, jiffies);
420 atomic_dec(&new_send->skb->users);
421 new_send->timetosend = jiffies;
425 cleanup_retrans_entry(cm_node);
426 if (close_when_complete)
427 rem_ref_cm_node(cm_core, cm_node);
433 was_timer_set = timer_pending(&cm_core->tcp_timer);
435 if (!was_timer_set) {
436 cm_core->tcp_timer.expires = new_send->timetosend;
437 add_timer(&cm_core->tcp_timer);
447 static void nes_cm_timer_tick(unsigned long pass)
449 unsigned long flags, qplockflags;
450 unsigned long nexttimeout = jiffies + NES_LONG_TIME;
451 struct iw_cm_id *cm_id;
452 struct nes_cm_node *cm_node;
453 struct nes_timer_entry *send_entry, *recv_entry;
454 struct list_head *list_core, *list_core_temp;
455 struct list_head *list_node, *list_node_temp;
456 struct nes_cm_core *cm_core = g_cm_core;
457 struct nes_qp *nesqp;
459 int ret = NETDEV_TX_OK;
460 enum nes_cm_node_state last_state;
462 struct list_head timer_list;
463 INIT_LIST_HEAD(&timer_list);
464 spin_lock_irqsave(&cm_core->ht_lock, flags);
466 list_for_each_safe(list_node, list_core_temp,
467 &cm_core->connected_nodes) {
468 cm_node = container_of(list_node, struct nes_cm_node, list);
469 if (!list_empty(&cm_node->recv_list) || (cm_node->send_entry)) {
470 add_ref_cm_node(cm_node);
471 list_add(&cm_node->timer_entry, &timer_list);
474 spin_unlock_irqrestore(&cm_core->ht_lock, flags);
476 list_for_each_safe(list_node, list_core_temp, &timer_list) {
477 cm_node = container_of(list_node, struct nes_cm_node,
479 spin_lock_irqsave(&cm_node->recv_list_lock, flags);
480 list_for_each_safe(list_core, list_node_temp,
481 &cm_node->recv_list) {
482 recv_entry = container_of(list_core,
483 struct nes_timer_entry, list);
486 if (time_after(recv_entry->timetosend, jiffies)) {
487 if (nexttimeout > recv_entry->timetosend ||
489 nexttimeout = recv_entry->timetosend;
494 list_del(&recv_entry->list);
495 cm_id = cm_node->cm_id;
496 spin_unlock_irqrestore(&cm_node->recv_list_lock, flags);
497 nesqp = (struct nes_qp *)recv_entry->skb;
498 spin_lock_irqsave(&nesqp->lock, qplockflags);
500 nes_debug(NES_DBG_CM, "QP%u: cm_id = %p, "
501 "refcount = %d: HIT A "
502 "NES_TIMER_TYPE_CLOSE with something "
503 "to do!!!\n", nesqp->hwqp.qp_id, cm_id,
504 atomic_read(&nesqp->refcount));
505 nesqp->hw_tcp_state = NES_AEQE_TCP_STATE_CLOSED;
506 nesqp->last_aeq = NES_AEQE_AEID_RESET_SENT;
507 nesqp->ibqp_state = IB_QPS_ERR;
508 spin_unlock_irqrestore(&nesqp->lock,
510 nes_cm_disconn(nesqp);
512 spin_unlock_irqrestore(&nesqp->lock,
514 nes_debug(NES_DBG_CM, "QP%u: cm_id = %p, "
515 "refcount = %d: HIT A "
516 "NES_TIMER_TYPE_CLOSE with nothing "
517 "to do!!!\n", nesqp->hwqp.qp_id, cm_id,
518 atomic_read(&nesqp->refcount));
521 cm_id->rem_ref(cm_id);
524 spin_lock_irqsave(&cm_node->recv_list_lock, flags);
526 spin_unlock_irqrestore(&cm_node->recv_list_lock, flags);
528 spin_lock_irqsave(&cm_node->retrans_list_lock, flags);
530 send_entry = cm_node->send_entry;
533 if (time_after(send_entry->timetosend, jiffies)) {
534 if (cm_node->state != NES_CM_STATE_TSA) {
536 send_entry->timetosend) ||
539 send_entry->timetosend;
544 free_retrans_entry(cm_node);
549 if ((cm_node->state == NES_CM_STATE_TSA) ||
550 (cm_node->state == NES_CM_STATE_CLOSED)) {
551 free_retrans_entry(cm_node);
555 if (!send_entry->retranscount ||
556 !send_entry->retrycount) {
557 cm_packets_dropped++;
558 last_state = cm_node->state;
559 cm_node->state = NES_CM_STATE_CLOSED;
560 free_retrans_entry(cm_node);
561 spin_unlock_irqrestore(
562 &cm_node->retrans_list_lock, flags);
563 if (last_state == NES_CM_STATE_SYN_RCVD)
564 rem_ref_cm_node(cm_core, cm_node);
566 create_event(cm_node,
567 NES_CM_EVENT_ABORTED);
568 spin_lock_irqsave(&cm_node->retrans_list_lock,
572 atomic_inc(&send_entry->skb->users);
573 cm_packets_retrans++;
574 nes_debug(NES_DBG_CM, "Retransmitting send_entry %p "
575 "for node %p, jiffies = %lu, time to send = "
576 "%lu, retranscount = %u, send_entry->seq_num = "
577 "0x%08X, cm_node->tcp_cntxt.rem_ack_num = "
578 "0x%08X\n", send_entry, cm_node, jiffies,
579 send_entry->timetosend,
580 send_entry->retranscount,
582 cm_node->tcp_cntxt.rem_ack_num);
584 spin_unlock_irqrestore(&cm_node->retrans_list_lock,
586 ret = nes_nic_cm_xmit(send_entry->skb, cm_node->netdev);
587 spin_lock_irqsave(&cm_node->retrans_list_lock, flags);
588 if (ret != NETDEV_TX_OK) {
589 nes_debug(NES_DBG_CM, "rexmit failed for "
590 "node=%p\n", cm_node);
591 cm_packets_bounced++;
592 atomic_dec(&send_entry->skb->users);
593 send_entry->retrycount--;
594 nexttimeout = jiffies + NES_SHORT_TIME;
600 nes_debug(NES_DBG_CM, "Packet Sent: retrans count = "
601 "%u, retry count = %u.\n",
602 send_entry->retranscount,
603 send_entry->retrycount);
604 if (send_entry->send_retrans) {
605 send_entry->retranscount--;
606 send_entry->timetosend = jiffies +
608 if (nexttimeout > send_entry->timetosend ||
610 nexttimeout = send_entry->timetosend;
614 int close_when_complete;
615 close_when_complete =
616 send_entry->close_when_complete;
617 nes_debug(NES_DBG_CM, "cm_node=%p state=%d\n",
618 cm_node, cm_node->state);
619 free_retrans_entry(cm_node);
620 if (close_when_complete)
621 rem_ref_cm_node(cm_node->cm_core,
626 spin_unlock_irqrestore(&cm_node->retrans_list_lock, flags);
627 rem_ref_cm_node(cm_node->cm_core, cm_node);
628 if (ret != NETDEV_TX_OK) {
629 nes_debug(NES_DBG_CM, "rexmit failed for cm_node=%p\n",
636 if (!timer_pending(&cm_core->tcp_timer)) {
637 cm_core->tcp_timer.expires = nexttimeout;
638 add_timer(&cm_core->tcp_timer);
647 static int send_syn(struct nes_cm_node *cm_node, u32 sendack,
652 char optionsbuffer[sizeof(struct option_mss) +
653 sizeof(struct option_windowscale) + sizeof(struct option_base) +
654 TCP_OPTIONS_PADDING];
657 /* Sending MSS option */
658 union all_known_options *options;
663 options = (union all_known_options *)&optionsbuffer[optionssize];
664 options->as_mss.optionnum = OPTION_NUMBER_MSS;
665 options->as_mss.length = sizeof(struct option_mss);
666 options->as_mss.mss = htons(cm_node->tcp_cntxt.mss);
667 optionssize += sizeof(struct option_mss);
669 options = (union all_known_options *)&optionsbuffer[optionssize];
670 options->as_windowscale.optionnum = OPTION_NUMBER_WINDOW_SCALE;
671 options->as_windowscale.length = sizeof(struct option_windowscale);
672 options->as_windowscale.shiftcount = cm_node->tcp_cntxt.rcv_wscale;
673 optionssize += sizeof(struct option_windowscale);
675 if (sendack && !(NES_DRV_OPT_SUPRESS_OPTION_BC & nes_drv_opt)) {
676 options = (union all_known_options *)&optionsbuffer[optionssize];
677 options->as_base.optionnum = OPTION_NUMBER_WRITE0;
678 options->as_base.length = sizeof(struct option_base);
679 optionssize += sizeof(struct option_base);
680 /* we need the size to be a multiple of 4 */
681 options = (union all_known_options *)&optionsbuffer[optionssize];
684 options = (union all_known_options *)&optionsbuffer[optionssize];
689 options = (union all_known_options *)&optionsbuffer[optionssize];
690 options->as_end = OPTION_NUMBER_END;
694 skb = get_free_pkt(cm_node);
696 nes_debug(NES_DBG_CM, "Failed to get a Free pkt\n");
703 form_cm_frame(skb, cm_node, optionsbuffer, optionssize, NULL, 0, flags);
704 ret = schedule_nes_timer(cm_node, skb, NES_TIMER_TYPE_SEND, 1, 0);
713 static int send_reset(struct nes_cm_node *cm_node, struct sk_buff *skb)
716 int flags = SET_RST | SET_ACK;
719 skb = get_free_pkt(cm_node);
721 nes_debug(NES_DBG_CM, "Failed to get a Free pkt\n");
725 form_cm_frame(skb, cm_node, NULL, 0, NULL, 0, flags);
726 ret = schedule_nes_timer(cm_node, skb, NES_TIMER_TYPE_SEND, 0, 1);
735 static int send_ack(struct nes_cm_node *cm_node, struct sk_buff *skb)
740 skb = get_free_pkt(cm_node);
743 nes_debug(NES_DBG_CM, "Failed to get a Free pkt\n");
747 form_cm_frame(skb, cm_node, NULL, 0, NULL, 0, SET_ACK);
748 ret = schedule_nes_timer(cm_node, skb, NES_TIMER_TYPE_SEND, 0, 0);
757 static int send_fin(struct nes_cm_node *cm_node, struct sk_buff *skb)
761 /* if we didn't get a frame get one */
763 skb = get_free_pkt(cm_node);
766 nes_debug(NES_DBG_CM, "Failed to get a Free pkt\n");
770 form_cm_frame(skb, cm_node, NULL, 0, NULL, 0, SET_ACK | SET_FIN);
771 ret = schedule_nes_timer(cm_node, skb, NES_TIMER_TYPE_SEND, 1, 0);
780 static struct sk_buff *get_free_pkt(struct nes_cm_node *cm_node)
782 struct sk_buff *skb, *new_skb;
784 /* check to see if we need to repopulate the free tx pkt queue */
785 if (skb_queue_len(&cm_node->cm_core->tx_free_list) < NES_CM_FREE_PKT_LO_WATERMARK) {
786 while (skb_queue_len(&cm_node->cm_core->tx_free_list) <
787 cm_node->cm_core->free_tx_pkt_max) {
788 /* replace the frame we took, we won't get it back */
789 new_skb = dev_alloc_skb(cm_node->cm_core->mtu);
791 /* add a replacement frame to the free tx list head */
792 skb_queue_head(&cm_node->cm_core->tx_free_list, new_skb);
796 skb = skb_dequeue(&cm_node->cm_core->tx_free_list);
803 * make_hashkey - generate hash key from node tuple
805 static inline int make_hashkey(u16 loc_port, nes_addr_t loc_addr, u16 rem_port,
810 hashkey = loc_addr + rem_addr + loc_port + rem_port;
811 hashkey = (hashkey % NES_CM_HASHTABLE_SIZE);
818 * find_node - find a cm node that matches the reference cm node
820 static struct nes_cm_node *find_node(struct nes_cm_core *cm_core,
821 u16 rem_port, nes_addr_t rem_addr, u16 loc_port, nes_addr_t loc_addr)
825 struct list_head *hte;
826 struct nes_cm_node *cm_node;
828 /* make a hash index key for this packet */
829 hashkey = make_hashkey(loc_port, loc_addr, rem_port, rem_addr);
831 /* get a handle on the hte */
832 hte = &cm_core->connected_nodes;
834 nes_debug(NES_DBG_CM, "Searching for an owner node: " NIPQUAD_FMT ":%x from core %p->%p\n",
835 HIPQUAD(loc_addr), loc_port, cm_core, hte);
837 /* walk list and find cm_node associated with this session ID */
838 spin_lock_irqsave(&cm_core->ht_lock, flags);
839 list_for_each_entry(cm_node, hte, list) {
840 /* compare quad, return node handle if a match */
841 nes_debug(NES_DBG_CM, "finding node %x:%x =? %x:%x ^ %x:%x =? %x:%x\n",
842 cm_node->loc_addr, cm_node->loc_port,
844 cm_node->rem_addr, cm_node->rem_port,
846 if ((cm_node->loc_addr == loc_addr) && (cm_node->loc_port == loc_port) &&
847 (cm_node->rem_addr == rem_addr) && (cm_node->rem_port == rem_port)) {
848 add_ref_cm_node(cm_node);
849 spin_unlock_irqrestore(&cm_core->ht_lock, flags);
853 spin_unlock_irqrestore(&cm_core->ht_lock, flags);
861 * find_listener - find a cm node listening on this addr-port pair
863 static struct nes_cm_listener *find_listener(struct nes_cm_core *cm_core,
864 nes_addr_t dst_addr, u16 dst_port, enum nes_cm_listener_state listener_state)
867 struct nes_cm_listener *listen_node;
869 /* walk list and find cm_node associated with this session ID */
870 spin_lock_irqsave(&cm_core->listen_list_lock, flags);
871 list_for_each_entry(listen_node, &cm_core->listen_list.list, list) {
872 /* compare node pair, return node handle if a match */
873 if (((listen_node->loc_addr == dst_addr) ||
874 listen_node->loc_addr == 0x00000000) &&
875 (listen_node->loc_port == dst_port) &&
876 (listener_state & listen_node->listener_state)) {
877 atomic_inc(&listen_node->ref_count);
878 spin_unlock_irqrestore(&cm_core->listen_list_lock, flags);
882 spin_unlock_irqrestore(&cm_core->listen_list_lock, flags);
884 nes_debug(NES_DBG_CM, "Unable to find listener for " NIPQUAD_FMT ":%x\n",
885 HIPQUAD(dst_addr), dst_port);
893 * add_hte_node - add a cm node to the hash table
895 static int add_hte_node(struct nes_cm_core *cm_core, struct nes_cm_node *cm_node)
899 struct list_head *hte;
901 if (!cm_node || !cm_core)
904 nes_debug(NES_DBG_CM, "Adding Node %p to Active Connection HT\n",
907 /* first, make an index into our hash table */
908 hashkey = make_hashkey(cm_node->loc_port, cm_node->loc_addr,
909 cm_node->rem_port, cm_node->rem_addr);
910 cm_node->hashkey = hashkey;
912 spin_lock_irqsave(&cm_core->ht_lock, flags);
914 /* get a handle on the hash table element (list head for this slot) */
915 hte = &cm_core->connected_nodes;
916 list_add_tail(&cm_node->list, hte);
917 atomic_inc(&cm_core->ht_node_cnt);
919 spin_unlock_irqrestore(&cm_core->ht_lock, flags);
926 * mini_cm_dec_refcnt_listen
928 static int mini_cm_dec_refcnt_listen(struct nes_cm_core *cm_core,
929 struct nes_cm_listener *listener, int free_hanging_nodes)
933 struct list_head *list_pos = NULL;
934 struct list_head *list_temp = NULL;
935 struct nes_cm_node *cm_node = NULL;
936 struct list_head reset_list;
938 nes_debug(NES_DBG_CM, "attempting listener= %p free_nodes= %d, "
939 "refcnt=%d\n", listener, free_hanging_nodes,
940 atomic_read(&listener->ref_count));
941 /* free non-accelerated child nodes for this listener */
942 INIT_LIST_HEAD(&reset_list);
943 if (free_hanging_nodes) {
944 spin_lock_irqsave(&cm_core->ht_lock, flags);
945 list_for_each_safe(list_pos, list_temp,
946 &g_cm_core->connected_nodes) {
947 cm_node = container_of(list_pos, struct nes_cm_node,
949 if ((cm_node->listener == listener) &&
950 (!cm_node->accelerated)) {
951 add_ref_cm_node(cm_node);
952 list_add(&cm_node->reset_entry, &reset_list);
955 spin_unlock_irqrestore(&cm_core->ht_lock, flags);
958 list_for_each_safe(list_pos, list_temp, &reset_list) {
959 cm_node = container_of(list_pos, struct nes_cm_node,
961 cleanup_retrans_entry(cm_node);
962 send_reset(cm_node, NULL);
963 rem_ref_cm_node(cm_node->cm_core, cm_node);
966 spin_lock_irqsave(&cm_core->listen_list_lock, flags);
967 if (!atomic_dec_return(&listener->ref_count)) {
968 list_del(&listener->list);
970 /* decrement our listen node count */
971 atomic_dec(&cm_core->listen_node_cnt);
973 spin_unlock_irqrestore(&cm_core->listen_list_lock, flags);
975 if (listener->nesvnic) {
976 nes_manage_apbvt(listener->nesvnic, listener->loc_port,
977 PCI_FUNC(listener->nesvnic->nesdev->pcidev->devfn), NES_MANAGE_APBVT_DEL);
980 nes_debug(NES_DBG_CM, "destroying listener (%p)\n", listener);
985 cm_listens_destroyed++;
987 spin_unlock_irqrestore(&cm_core->listen_list_lock, flags);
990 if (atomic_read(&listener->pend_accepts_cnt) > 0)
991 nes_debug(NES_DBG_CM, "destroying listener (%p)"
992 " with non-zero pending accepts=%u\n",
993 listener, atomic_read(&listener->pend_accepts_cnt));
1001 * mini_cm_del_listen
1003 static int mini_cm_del_listen(struct nes_cm_core *cm_core,
1004 struct nes_cm_listener *listener)
1006 listener->listener_state = NES_CM_LISTENER_PASSIVE_STATE;
1007 listener->cm_id = NULL; /* going to be destroyed pretty soon */
1008 return mini_cm_dec_refcnt_listen(cm_core, listener, 1);
1013 * mini_cm_accelerated
1015 static inline int mini_cm_accelerated(struct nes_cm_core *cm_core,
1016 struct nes_cm_node *cm_node)
1019 cm_node->accelerated = 1;
1021 if (cm_node->accept_pend) {
1022 BUG_ON(!cm_node->listener);
1023 atomic_dec(&cm_node->listener->pend_accepts_cnt);
1024 BUG_ON(atomic_read(&cm_node->listener->pend_accepts_cnt) < 0);
1027 was_timer_set = timer_pending(&cm_core->tcp_timer);
1028 if (!was_timer_set) {
1029 cm_core->tcp_timer.expires = jiffies + NES_SHORT_TIME;
1030 add_timer(&cm_core->tcp_timer);
1038 * nes_addr_resolve_neigh
1040 static int nes_addr_resolve_neigh(struct nes_vnic *nesvnic, u32 dst_ip)
1044 struct neighbour *neigh;
1046 DECLARE_MAC_BUF(mac);
1048 memset(&fl, 0, sizeof fl);
1049 fl.nl_u.ip4_u.daddr = htonl(dst_ip);
1050 if (ip_route_output_key(&init_net, &rt, &fl)) {
1051 printk("%s: ip_route_output_key failed for 0x%08X\n",
1056 neigh = neigh_lookup(&arp_tbl, &rt->rt_gateway, nesvnic->netdev);
1058 if (neigh->nud_state & NUD_VALID) {
1059 nes_debug(NES_DBG_CM, "Neighbor MAC address for 0x%08X"
1060 " is %s, Gateway is 0x%08X \n", dst_ip,
1061 print_mac(mac, neigh->ha), ntohl(rt->rt_gateway));
1062 nes_manage_arp_cache(nesvnic->netdev, neigh->ha,
1063 dst_ip, NES_ARP_ADD);
1064 rc = nes_arp_table(nesvnic->nesdev, dst_ip, NULL,
1067 neigh_release(neigh);
1070 if ((neigh == NULL) || (!(neigh->nud_state & NUD_VALID)))
1071 neigh_event_send(rt->u.dst.neighbour, NULL);
1079 * make_cm_node - create a new instance of a cm node
1081 static struct nes_cm_node *make_cm_node(struct nes_cm_core *cm_core,
1082 struct nes_vnic *nesvnic, struct nes_cm_info *cm_info,
1083 struct nes_cm_listener *listener)
1085 struct nes_cm_node *cm_node;
1088 struct nes_device *nesdev;
1089 struct nes_adapter *nesadapter;
1090 DECLARE_MAC_BUF(mac);
1092 /* create an hte and cm_node for this instance */
1093 cm_node = kzalloc(sizeof(*cm_node), GFP_ATOMIC);
1097 /* set our node specific transport info */
1098 cm_node->loc_addr = cm_info->loc_addr;
1099 cm_node->rem_addr = cm_info->rem_addr;
1100 cm_node->loc_port = cm_info->loc_port;
1101 cm_node->rem_port = cm_info->rem_port;
1102 cm_node->send_write0 = send_first;
1103 nes_debug(NES_DBG_CM, "Make node addresses : loc = " NIPQUAD_FMT
1104 ":%x, rem = " NIPQUAD_FMT ":%x\n",
1105 HIPQUAD(cm_node->loc_addr), cm_node->loc_port,
1106 HIPQUAD(cm_node->rem_addr), cm_node->rem_port);
1107 cm_node->listener = listener;
1108 cm_node->netdev = nesvnic->netdev;
1109 cm_node->cm_id = cm_info->cm_id;
1110 memcpy(cm_node->loc_mac, nesvnic->netdev->dev_addr, ETH_ALEN);
1112 nes_debug(NES_DBG_CM, "listener=%p, cm_id=%p\n", cm_node->listener,
1115 spin_lock_init(&cm_node->retrans_list_lock);
1116 INIT_LIST_HEAD(&cm_node->recv_list);
1117 spin_lock_init(&cm_node->recv_list_lock);
1119 cm_node->loopbackpartner = NULL;
1120 atomic_set(&cm_node->ref_count, 1);
1121 /* associate our parent CM core */
1122 cm_node->cm_core = cm_core;
1123 cm_node->tcp_cntxt.loc_id = NES_CM_DEF_LOCAL_ID;
1124 cm_node->tcp_cntxt.rcv_wscale = NES_CM_DEFAULT_RCV_WND_SCALE;
1125 cm_node->tcp_cntxt.rcv_wnd = NES_CM_DEFAULT_RCV_WND_SCALED >>
1126 NES_CM_DEFAULT_RCV_WND_SCALE;
1127 ts = current_kernel_time();
1128 cm_node->tcp_cntxt.loc_seq_num = htonl(ts.tv_nsec);
1129 cm_node->tcp_cntxt.mss = nesvnic->max_frame_size - sizeof(struct iphdr) -
1130 sizeof(struct tcphdr) - ETH_HLEN - VLAN_HLEN;
1131 cm_node->tcp_cntxt.rcv_nxt = 0;
1132 /* get a unique session ID , add thread_id to an upcounter to handle race */
1133 atomic_inc(&cm_core->node_cnt);
1134 cm_node->conn_type = cm_info->conn_type;
1135 cm_node->apbvt_set = 0;
1136 cm_node->accept_pend = 0;
1138 cm_node->nesvnic = nesvnic;
1139 /* get some device handles, for arp lookup */
1140 nesdev = nesvnic->nesdev;
1141 nesadapter = nesdev->nesadapter;
1143 cm_node->loopbackpartner = NULL;
1144 /* get the mac addr for the remote node */
1145 arpindex = nes_arp_table(nesdev, cm_node->rem_addr, NULL, NES_ARP_RESOLVE);
1147 arpindex = nes_addr_resolve_neigh(nesvnic, cm_info->rem_addr);
1154 /* copy the mac addr to node context */
1155 memcpy(cm_node->rem_mac, nesadapter->arp_table[arpindex].mac_addr, ETH_ALEN);
1156 nes_debug(NES_DBG_CM, "Remote mac addr from arp table: %s\n",
1157 print_mac(mac, cm_node->rem_mac));
1159 add_hte_node(cm_core, cm_node);
1160 atomic_inc(&cm_nodes_created);
1167 * add_ref_cm_node - destroy an instance of a cm node
1169 static int add_ref_cm_node(struct nes_cm_node *cm_node)
1171 atomic_inc(&cm_node->ref_count);
1177 * rem_ref_cm_node - destroy an instance of a cm node
1179 static int rem_ref_cm_node(struct nes_cm_core *cm_core,
1180 struct nes_cm_node *cm_node)
1182 unsigned long flags, qplockflags;
1183 struct nes_timer_entry *recv_entry;
1184 struct iw_cm_id *cm_id;
1185 struct list_head *list_core, *list_node_temp;
1186 struct nes_qp *nesqp;
1191 spin_lock_irqsave(&cm_node->cm_core->ht_lock, flags);
1192 if (atomic_dec_return(&cm_node->ref_count)) {
1193 spin_unlock_irqrestore(&cm_node->cm_core->ht_lock, flags);
1196 list_del(&cm_node->list);
1197 atomic_dec(&cm_core->ht_node_cnt);
1198 spin_unlock_irqrestore(&cm_node->cm_core->ht_lock, flags);
1200 /* if the node is destroyed before connection was accelerated */
1201 if (!cm_node->accelerated && cm_node->accept_pend) {
1202 BUG_ON(!cm_node->listener);
1203 atomic_dec(&cm_node->listener->pend_accepts_cnt);
1204 BUG_ON(atomic_read(&cm_node->listener->pend_accepts_cnt) < 0);
1206 BUG_ON(cm_node->send_entry);
1207 spin_lock_irqsave(&cm_node->recv_list_lock, flags);
1208 list_for_each_safe(list_core, list_node_temp, &cm_node->recv_list) {
1209 recv_entry = container_of(list_core, struct nes_timer_entry,
1211 list_del(&recv_entry->list);
1212 cm_id = cm_node->cm_id;
1213 spin_unlock_irqrestore(&cm_node->recv_list_lock, flags);
1214 nesqp = (struct nes_qp *)recv_entry->skb;
1215 spin_lock_irqsave(&nesqp->lock, qplockflags);
1217 nes_debug(NES_DBG_CM, "QP%u: cm_id = %p: HIT A "
1218 "NES_TIMER_TYPE_CLOSE with something to do!\n",
1219 nesqp->hwqp.qp_id, cm_id);
1220 nesqp->hw_tcp_state = NES_AEQE_TCP_STATE_CLOSED;
1221 nesqp->last_aeq = NES_AEQE_AEID_RESET_SENT;
1222 nesqp->ibqp_state = IB_QPS_ERR;
1223 spin_unlock_irqrestore(&nesqp->lock, qplockflags);
1224 nes_cm_disconn(nesqp);
1226 spin_unlock_irqrestore(&nesqp->lock, qplockflags);
1227 nes_debug(NES_DBG_CM, "QP%u: cm_id = %p: HIT A "
1228 "NES_TIMER_TYPE_CLOSE with nothing to do!\n",
1229 nesqp->hwqp.qp_id, cm_id);
1231 cm_id->rem_ref(cm_id);
1234 spin_lock_irqsave(&cm_node->recv_list_lock, flags);
1236 spin_unlock_irqrestore(&cm_node->recv_list_lock, flags);
1238 if (cm_node->listener) {
1239 mini_cm_dec_refcnt_listen(cm_core, cm_node->listener, 0);
1241 if (cm_node->apbvt_set && cm_node->nesvnic) {
1242 nes_manage_apbvt(cm_node->nesvnic, cm_node->loc_port,
1244 cm_node->nesvnic->nesdev->pcidev->devfn),
1245 NES_MANAGE_APBVT_DEL);
1249 atomic_dec(&cm_core->node_cnt);
1250 atomic_inc(&cm_nodes_destroyed);
1251 nesqp = cm_node->nesqp;
1253 nesqp->cm_node = NULL;
1254 nes_rem_ref(&nesqp->ibqp);
1255 cm_node->nesqp = NULL;
1266 static int process_options(struct nes_cm_node *cm_node, u8 *optionsloc,
1267 u32 optionsize, u32 syn_packet)
1271 union all_known_options *all_options;
1272 char got_mss_option = 0;
1274 while (offset < optionsize) {
1275 all_options = (union all_known_options *)(optionsloc + offset);
1276 switch (all_options->as_base.optionnum) {
1277 case OPTION_NUMBER_END:
1278 offset = optionsize;
1280 case OPTION_NUMBER_NONE:
1283 case OPTION_NUMBER_MSS:
1284 nes_debug(NES_DBG_CM, "%s: MSS Length: %d Offset: %d "
1285 "Size: %d\n", __func__,
1286 all_options->as_mss.length, offset, optionsize);
1288 if (all_options->as_mss.length != 4) {
1291 tmp = ntohs(all_options->as_mss.mss);
1292 if (tmp > 0 && tmp <
1293 cm_node->tcp_cntxt.mss)
1294 cm_node->tcp_cntxt.mss = tmp;
1297 case OPTION_NUMBER_WINDOW_SCALE:
1298 cm_node->tcp_cntxt.snd_wscale =
1299 all_options->as_windowscale.shiftcount;
1301 case OPTION_NUMBER_WRITE0:
1302 cm_node->send_write0 = 1;
1305 nes_debug(NES_DBG_CM, "TCP Option not understood: %x\n",
1306 all_options->as_base.optionnum);
1309 offset += all_options->as_base.length;
1311 if ((!got_mss_option) && (syn_packet))
1312 cm_node->tcp_cntxt.mss = NES_CM_DEFAULT_MSS;
1316 static void drop_packet(struct sk_buff *skb)
1318 atomic_inc(&cm_accel_dropped_pkts);
1319 dev_kfree_skb_any(skb);
1322 static void handle_fin_pkt(struct nes_cm_node *cm_node, struct sk_buff *skb,
1323 struct tcphdr *tcph)
1325 atomic_inc(&cm_resets_recvd);
1326 nes_debug(NES_DBG_CM, "Received FIN, cm_node = %p, state = %u. "
1327 "refcnt=%d\n", cm_node, cm_node->state,
1328 atomic_read(&cm_node->ref_count));
1329 cm_node->tcp_cntxt.rcv_nxt++;
1330 cleanup_retrans_entry(cm_node);
1331 switch (cm_node->state) {
1332 case NES_CM_STATE_SYN_RCVD:
1333 case NES_CM_STATE_SYN_SENT:
1334 case NES_CM_STATE_ESTABLISHED:
1335 case NES_CM_STATE_MPAREQ_SENT:
1336 cm_node->state = NES_CM_STATE_LAST_ACK;
1337 send_fin(cm_node, skb);
1339 case NES_CM_STATE_FIN_WAIT1:
1340 cm_node->state = NES_CM_STATE_CLOSING;
1341 send_ack(cm_node, skb);
1343 case NES_CM_STATE_FIN_WAIT2:
1344 cm_node->state = NES_CM_STATE_TIME_WAIT;
1345 send_ack(cm_node, skb);
1346 cm_node->state = NES_CM_STATE_CLOSED;
1348 case NES_CM_STATE_TSA:
1350 nes_debug(NES_DBG_CM, "Error Rcvd FIN for node-%p state = %d\n",
1351 cm_node, cm_node->state);
1358 static void handle_rst_pkt(struct nes_cm_node *cm_node, struct sk_buff *skb,
1359 struct tcphdr *tcph)
1362 int reset = 0; /* whether to send reset in case of err.. */
1364 atomic_inc(&cm_resets_recvd);
1365 nes_debug(NES_DBG_CM, "Received Reset, cm_node = %p, state = %u."
1366 " refcnt=%d\n", cm_node, cm_node->state,
1367 atomic_read(&cm_node->ref_count));
1368 cleanup_retrans_entry(cm_node);
1369 switch (cm_node->state) {
1370 case NES_CM_STATE_SYN_SENT:
1371 case NES_CM_STATE_MPAREQ_SENT:
1372 nes_debug(NES_DBG_CM, "%s[%u] create abort for cm_node=%p "
1373 "listener=%p state=%d\n", __func__, __LINE__, cm_node,
1374 cm_node->listener, cm_node->state);
1375 active_open_err(cm_node, skb, reset);
1377 case NES_CM_STATE_MPAREQ_RCVD:
1378 passive_state = atomic_add_return(1, &cm_node->passive_state);
1379 if (passive_state == NES_SEND_RESET_EVENT)
1380 create_event(cm_node, NES_CM_EVENT_RESET);
1381 cleanup_retrans_entry(cm_node);
1382 cm_node->state = NES_CM_STATE_CLOSED;
1383 dev_kfree_skb_any(skb);
1385 case NES_CM_STATE_ESTABLISHED:
1386 case NES_CM_STATE_SYN_RCVD:
1387 case NES_CM_STATE_LISTENING:
1388 nes_debug(NES_DBG_CM, "Bad state %s[%u]\n", __func__, __LINE__);
1389 passive_open_err(cm_node, skb, reset);
1391 case NES_CM_STATE_TSA:
1392 active_open_err(cm_node, skb, reset);
1394 case NES_CM_STATE_CLOSED:
1395 cleanup_retrans_entry(cm_node);
1404 static void handle_rcv_mpa(struct nes_cm_node *cm_node, struct sk_buff *skb,
1405 enum nes_cm_event_type type)
1409 int datasize = skb->len;
1410 u8 *dataloc = skb->data;
1411 ret = parse_mpa(cm_node, dataloc, datasize);
1413 nes_debug(NES_DBG_CM, "didn't like MPA Request\n");
1414 if (type == NES_CM_EVENT_CONNECTED) {
1415 nes_debug(NES_DBG_CM, "%s[%u] create abort for "
1416 "cm_node=%p listener=%p state=%d\n", __func__,
1417 __LINE__, cm_node, cm_node->listener,
1419 active_open_err(cm_node, skb, 1);
1421 passive_open_err(cm_node, skb, 1);
1424 cleanup_retrans_entry(cm_node);
1425 dev_kfree_skb_any(skb);
1426 if (type == NES_CM_EVENT_CONNECTED)
1427 cm_node->state = NES_CM_STATE_TSA;
1429 atomic_set(&cm_node->passive_state,
1430 NES_PASSIVE_STATE_INDICATED);
1431 create_event(cm_node, type);
1437 static void indicate_pkt_err(struct nes_cm_node *cm_node, struct sk_buff *skb)
1439 switch (cm_node->state) {
1440 case NES_CM_STATE_SYN_SENT:
1441 case NES_CM_STATE_MPAREQ_SENT:
1442 nes_debug(NES_DBG_CM, "%s[%u] create abort for cm_node=%p "
1443 "listener=%p state=%d\n", __func__, __LINE__, cm_node,
1444 cm_node->listener, cm_node->state);
1445 active_open_err(cm_node, skb, 1);
1447 case NES_CM_STATE_ESTABLISHED:
1448 case NES_CM_STATE_SYN_RCVD:
1449 passive_open_err(cm_node, skb, 1);
1451 case NES_CM_STATE_TSA:
1457 static int check_syn(struct nes_cm_node *cm_node, struct tcphdr *tcph,
1458 struct sk_buff *skb)
1462 err = ((ntohl(tcph->ack_seq) == cm_node->tcp_cntxt.loc_seq_num))? 0 : 1;
1464 active_open_err(cm_node, skb, 1);
1469 static int check_seq(struct nes_cm_node *cm_node, struct tcphdr *tcph,
1470 struct sk_buff *skb)
1475 u32 loc_seq_num = cm_node->tcp_cntxt.loc_seq_num;
1476 u32 rcv_nxt = cm_node->tcp_cntxt.rcv_nxt;
1478 seq = ntohl(tcph->seq);
1479 ack_seq = ntohl(tcph->ack_seq);
1480 rcv_wnd = cm_node->tcp_cntxt.rcv_wnd;
1481 if (ack_seq != loc_seq_num)
1483 else if ((seq + rcv_wnd) < rcv_nxt)
1486 nes_debug(NES_DBG_CM, "%s[%u] create abort for cm_node=%p "
1487 "listener=%p state=%d\n", __func__, __LINE__, cm_node,
1488 cm_node->listener, cm_node->state);
1489 indicate_pkt_err(cm_node, skb);
1490 nes_debug(NES_DBG_CM, "seq ERROR cm_node =%p seq=0x%08X "
1491 "rcv_nxt=0x%08X rcv_wnd=0x%x\n", cm_node, seq, rcv_nxt,
1498 * handle_syn_pkt() is for Passive node. The syn packet is received when a node
1499 * is created with a listener or it may comein as rexmitted packet which in
1500 * that case will be just dropped.
1503 static void handle_syn_pkt(struct nes_cm_node *cm_node, struct sk_buff *skb,
1504 struct tcphdr *tcph)
1510 optionsize = (tcph->doff << 2) - sizeof(struct tcphdr);
1512 inc_sequence = ntohl(tcph->seq);
1514 switch (cm_node->state) {
1515 case NES_CM_STATE_SYN_SENT:
1516 case NES_CM_STATE_MPAREQ_SENT:
1517 /* Rcvd syn on active open connection*/
1518 active_open_err(cm_node, skb, 1);
1520 case NES_CM_STATE_LISTENING:
1522 cm_node->accept_pend = 1;
1523 atomic_inc(&cm_node->listener->pend_accepts_cnt);
1524 if (atomic_read(&cm_node->listener->pend_accepts_cnt) >
1525 cm_node->listener->backlog) {
1526 nes_debug(NES_DBG_CM, "drop syn due to backlog "
1529 passive_open_err(cm_node, skb, 0);
1532 ret = handle_tcp_options(cm_node, tcph, skb, optionsize,
1535 passive_open_err(cm_node, skb, 0);
1539 cm_node->tcp_cntxt.rcv_nxt = inc_sequence + 1;
1540 BUG_ON(cm_node->send_entry);
1541 cm_node->state = NES_CM_STATE_SYN_RCVD;
1542 send_syn(cm_node, 1, skb);
1544 case NES_CM_STATE_CLOSED:
1545 cleanup_retrans_entry(cm_node);
1546 send_reset(cm_node, skb);
1548 case NES_CM_STATE_TSA:
1549 case NES_CM_STATE_ESTABLISHED:
1550 case NES_CM_STATE_FIN_WAIT1:
1551 case NES_CM_STATE_FIN_WAIT2:
1552 case NES_CM_STATE_MPAREQ_RCVD:
1553 case NES_CM_STATE_LAST_ACK:
1554 case NES_CM_STATE_CLOSING:
1555 case NES_CM_STATE_UNKNOWN:
1562 static void handle_synack_pkt(struct nes_cm_node *cm_node, struct sk_buff *skb,
1563 struct tcphdr *tcph)
1570 optionsize = (tcph->doff << 2) - sizeof(struct tcphdr);
1572 inc_sequence = ntohl(tcph->seq);
1573 switch (cm_node->state) {
1574 case NES_CM_STATE_SYN_SENT:
1576 if (check_syn(cm_node, tcph, skb))
1578 cm_node->tcp_cntxt.rem_ack_num = ntohl(tcph->ack_seq);
1580 ret = handle_tcp_options(cm_node, tcph, skb, optionsize, 0);
1582 nes_debug(NES_DBG_CM, "cm_node=%p tcp_options failed\n",
1586 cleanup_retrans_entry(cm_node);
1587 cm_node->tcp_cntxt.rcv_nxt = inc_sequence + 1;
1588 send_mpa_request(cm_node, skb);
1589 cm_node->state = NES_CM_STATE_MPAREQ_SENT;
1591 case NES_CM_STATE_MPAREQ_RCVD:
1592 /* passive open, so should not be here */
1593 passive_open_err(cm_node, skb, 1);
1595 case NES_CM_STATE_LISTENING:
1596 case NES_CM_STATE_CLOSED:
1597 cm_node->tcp_cntxt.loc_seq_num = ntohl(tcph->ack_seq);
1598 cleanup_retrans_entry(cm_node);
1599 send_reset(cm_node, skb);
1601 case NES_CM_STATE_ESTABLISHED:
1602 case NES_CM_STATE_FIN_WAIT1:
1603 case NES_CM_STATE_FIN_WAIT2:
1604 case NES_CM_STATE_LAST_ACK:
1605 case NES_CM_STATE_TSA:
1606 case NES_CM_STATE_CLOSING:
1607 case NES_CM_STATE_UNKNOWN:
1608 case NES_CM_STATE_MPAREQ_SENT:
1615 static void handle_ack_pkt(struct nes_cm_node *cm_node, struct sk_buff *skb,
1616 struct tcphdr *tcph)
1624 u32 temp_seq = cm_node->tcp_cntxt.loc_seq_num;
1626 optionsize = (tcph->doff << 2) - sizeof(struct tcphdr);
1627 cm_node->tcp_cntxt.loc_seq_num = ntohl(tcph->ack_seq);
1629 if (check_seq(cm_node, tcph, skb))
1632 skb_pull(skb, tcph->doff << 2);
1633 inc_sequence = ntohl(tcph->seq);
1634 rem_seq = ntohl(tcph->seq);
1635 rem_seq_ack = ntohl(tcph->ack_seq);
1636 datasize = skb->len;
1638 switch (cm_node->state) {
1639 case NES_CM_STATE_SYN_RCVD:
1641 ret = handle_tcp_options(cm_node, tcph, skb, optionsize, 1);
1644 cm_node->tcp_cntxt.rem_ack_num = ntohl(tcph->ack_seq);
1645 cm_node->tcp_cntxt.loc_seq_num = temp_seq;
1646 if (cm_node->tcp_cntxt.rem_ack_num !=
1647 cm_node->tcp_cntxt.loc_seq_num) {
1648 nes_debug(NES_DBG_CM, "rem_ack_num != loc_seq_num\n");
1649 cleanup_retrans_entry(cm_node);
1650 send_reset(cm_node, skb);
1653 cm_node->state = NES_CM_STATE_ESTABLISHED;
1655 cm_node->tcp_cntxt.rcv_nxt = inc_sequence + datasize;
1656 cm_node->state = NES_CM_STATE_MPAREQ_RCVD;
1657 handle_rcv_mpa(cm_node, skb, NES_CM_EVENT_MPA_REQ);
1658 } else { /* rcvd ACK only */
1659 dev_kfree_skb_any(skb);
1660 cleanup_retrans_entry(cm_node);
1663 case NES_CM_STATE_ESTABLISHED:
1665 /* We expect mpa frame to be received only */
1667 cm_node->tcp_cntxt.rcv_nxt = inc_sequence + datasize;
1668 cm_node->state = NES_CM_STATE_MPAREQ_RCVD;
1669 handle_rcv_mpa(cm_node, skb,
1670 NES_CM_EVENT_MPA_REQ);
1674 case NES_CM_STATE_MPAREQ_SENT:
1675 cm_node->tcp_cntxt.rem_ack_num = ntohl(tcph->ack_seq);
1677 cm_node->tcp_cntxt.rcv_nxt = inc_sequence + datasize;
1678 handle_rcv_mpa(cm_node, skb, NES_CM_EVENT_CONNECTED);
1679 } else { /* Could be just an ack pkt.. */
1680 cleanup_retrans_entry(cm_node);
1681 dev_kfree_skb_any(skb);
1684 case NES_CM_STATE_LISTENING:
1685 case NES_CM_STATE_CLOSED:
1686 cleanup_retrans_entry(cm_node);
1687 send_reset(cm_node, skb);
1689 case NES_CM_STATE_FIN_WAIT1:
1690 case NES_CM_STATE_SYN_SENT:
1691 case NES_CM_STATE_FIN_WAIT2:
1692 case NES_CM_STATE_TSA:
1693 case NES_CM_STATE_MPAREQ_RCVD:
1694 case NES_CM_STATE_LAST_ACK:
1695 case NES_CM_STATE_CLOSING:
1696 case NES_CM_STATE_UNKNOWN:
1705 static int handle_tcp_options(struct nes_cm_node *cm_node, struct tcphdr *tcph,
1706 struct sk_buff *skb, int optionsize, int passive)
1708 u8 *optionsloc = (u8 *)&tcph[1];
1710 if (process_options(cm_node, optionsloc, optionsize,
1712 nes_debug(NES_DBG_CM, "%s: Node %p, Sending RESET\n",
1715 passive_open_err(cm_node, skb, 1);
1717 active_open_err(cm_node, skb, 1);
1722 cm_node->tcp_cntxt.snd_wnd = ntohs(tcph->window) <<
1723 cm_node->tcp_cntxt.snd_wscale;
1725 if (cm_node->tcp_cntxt.snd_wnd > cm_node->tcp_cntxt.max_snd_wnd)
1726 cm_node->tcp_cntxt.max_snd_wnd = cm_node->tcp_cntxt.snd_wnd;
1731 * active_open_err() will send reset() if flag set..
1732 * It will also send ABORT event.
1735 static void active_open_err(struct nes_cm_node *cm_node, struct sk_buff *skb,
1738 cleanup_retrans_entry(cm_node);
1740 nes_debug(NES_DBG_CM, "ERROR active err called for cm_node=%p, "
1741 "state=%d\n", cm_node, cm_node->state);
1742 add_ref_cm_node(cm_node);
1743 send_reset(cm_node, skb);
1745 dev_kfree_skb_any(skb);
1747 cm_node->state = NES_CM_STATE_CLOSED;
1748 create_event(cm_node, NES_CM_EVENT_ABORTED);
1752 * passive_open_err() will either do a reset() or will free up the skb and
1753 * remove the cm_node.
1756 static void passive_open_err(struct nes_cm_node *cm_node, struct sk_buff *skb,
1759 cleanup_retrans_entry(cm_node);
1760 cm_node->state = NES_CM_STATE_CLOSED;
1762 nes_debug(NES_DBG_CM, "passive_open_err sending RST for "
1763 "cm_node=%p state =%d\n", cm_node, cm_node->state);
1764 send_reset(cm_node, skb);
1766 dev_kfree_skb_any(skb);
1767 rem_ref_cm_node(cm_node->cm_core, cm_node);
1772 * free_retrans_entry() routines assumes that the retrans_list_lock has
1773 * been acquired before calling.
1775 static void free_retrans_entry(struct nes_cm_node *cm_node)
1777 struct nes_timer_entry *send_entry;
1778 send_entry = cm_node->send_entry;
1780 cm_node->send_entry = NULL;
1781 dev_kfree_skb_any(send_entry->skb);
1783 rem_ref_cm_node(cm_node->cm_core, cm_node);
1787 static void cleanup_retrans_entry(struct nes_cm_node *cm_node)
1789 unsigned long flags;
1791 spin_lock_irqsave(&cm_node->retrans_list_lock, flags);
1792 free_retrans_entry(cm_node);
1793 spin_unlock_irqrestore(&cm_node->retrans_list_lock, flags);
1798 * Returns skb if to be freed, else it will return NULL if already used..
1800 static void process_packet(struct nes_cm_node *cm_node, struct sk_buff *skb,
1801 struct nes_cm_core *cm_core)
1803 enum nes_tcpip_pkt_type pkt_type = NES_PKT_TYPE_UNKNOWN;
1804 struct tcphdr *tcph = tcp_hdr(skb);
1805 skb_pull(skb, ip_hdr(skb)->ihl << 2);
1807 nes_debug(NES_DBG_CM, "process_packet: cm_node=%p state =%d syn=%d "
1808 "ack=%d rst=%d fin=%d\n", cm_node, cm_node->state, tcph->syn,
1809 tcph->ack, tcph->rst, tcph->fin);
1812 pkt_type = NES_PKT_TYPE_RST;
1813 else if (tcph->syn) {
1814 pkt_type = NES_PKT_TYPE_SYN;
1816 pkt_type = NES_PKT_TYPE_SYNACK;
1817 } else if (tcph->fin)
1818 pkt_type = NES_PKT_TYPE_FIN;
1820 pkt_type = NES_PKT_TYPE_ACK;
1823 case NES_PKT_TYPE_SYN:
1824 handle_syn_pkt(cm_node, skb, tcph);
1826 case NES_PKT_TYPE_SYNACK:
1827 handle_synack_pkt(cm_node, skb, tcph);
1829 case NES_PKT_TYPE_ACK:
1830 handle_ack_pkt(cm_node, skb, tcph);
1832 case NES_PKT_TYPE_RST:
1833 handle_rst_pkt(cm_node, skb, tcph);
1835 case NES_PKT_TYPE_FIN:
1836 handle_fin_pkt(cm_node, skb, tcph);
1845 * mini_cm_listen - create a listen node with params
1847 static struct nes_cm_listener *mini_cm_listen(struct nes_cm_core *cm_core,
1848 struct nes_vnic *nesvnic, struct nes_cm_info *cm_info)
1850 struct nes_cm_listener *listener;
1851 unsigned long flags;
1853 nes_debug(NES_DBG_CM, "Search for 0x%08x : 0x%04x\n",
1854 cm_info->loc_addr, cm_info->loc_port);
1856 /* cannot have multiple matching listeners */
1857 listener = find_listener(cm_core, htonl(cm_info->loc_addr),
1858 htons(cm_info->loc_port), NES_CM_LISTENER_EITHER_STATE);
1859 if (listener && listener->listener_state == NES_CM_LISTENER_ACTIVE_STATE) {
1860 /* find automatically incs ref count ??? */
1861 atomic_dec(&listener->ref_count);
1862 nes_debug(NES_DBG_CM, "Not creating listener since it already exists\n");
1867 /* create a CM listen node (1/2 node to compare incoming traffic to) */
1868 listener = kzalloc(sizeof(*listener), GFP_ATOMIC);
1870 nes_debug(NES_DBG_CM, "Not creating listener memory allocation failed\n");
1874 listener->loc_addr = htonl(cm_info->loc_addr);
1875 listener->loc_port = htons(cm_info->loc_port);
1876 listener->reused_node = 0;
1878 atomic_set(&listener->ref_count, 1);
1881 /* find already inc'ed the ref count */
1883 listener->reused_node = 1;
1886 listener->cm_id = cm_info->cm_id;
1887 atomic_set(&listener->pend_accepts_cnt, 0);
1888 listener->cm_core = cm_core;
1889 listener->nesvnic = nesvnic;
1890 atomic_inc(&cm_core->node_cnt);
1892 listener->conn_type = cm_info->conn_type;
1893 listener->backlog = cm_info->backlog;
1894 listener->listener_state = NES_CM_LISTENER_ACTIVE_STATE;
1896 if (!listener->reused_node) {
1897 spin_lock_irqsave(&cm_core->listen_list_lock, flags);
1898 list_add(&listener->list, &cm_core->listen_list.list);
1899 spin_unlock_irqrestore(&cm_core->listen_list_lock, flags);
1900 atomic_inc(&cm_core->listen_node_cnt);
1903 nes_debug(NES_DBG_CM, "Api - listen(): addr=0x%08X, port=0x%04x,"
1904 " listener = %p, backlog = %d, cm_id = %p.\n",
1905 cm_info->loc_addr, cm_info->loc_port,
1906 listener, listener->backlog, listener->cm_id);
1913 * mini_cm_connect - make a connection node with params
1915 static struct nes_cm_node *mini_cm_connect(struct nes_cm_core *cm_core,
1916 struct nes_vnic *nesvnic, u16 private_data_len,
1917 void *private_data, struct nes_cm_info *cm_info)
1920 struct nes_cm_node *cm_node;
1921 struct nes_cm_listener *loopbackremotelistener;
1922 struct nes_cm_node *loopbackremotenode;
1923 struct nes_cm_info loopback_cm_info;
1924 u16 mpa_frame_size = sizeof(struct ietf_mpa_frame) + private_data_len;
1925 struct ietf_mpa_frame *mpa_frame = NULL;
1927 /* create a CM connection node */
1928 cm_node = make_cm_node(cm_core, nesvnic, cm_info, NULL);
1931 mpa_frame = &cm_node->mpa_frame;
1932 strcpy(mpa_frame->key, IEFT_MPA_KEY_REQ);
1933 mpa_frame->flags = IETF_MPA_FLAGS_CRC;
1934 mpa_frame->rev = IETF_MPA_VERSION;
1935 mpa_frame->priv_data_len = htons(private_data_len);
1937 /* set our node side to client (active) side */
1938 cm_node->tcp_cntxt.client = 1;
1939 cm_node->tcp_cntxt.rcv_wscale = NES_CM_DEFAULT_RCV_WND_SCALE;
1941 if (cm_info->loc_addr == cm_info->rem_addr) {
1942 loopbackremotelistener = find_listener(cm_core,
1943 ntohl(nesvnic->local_ipaddr), cm_node->rem_port,
1944 NES_CM_LISTENER_ACTIVE_STATE);
1945 if (loopbackremotelistener == NULL) {
1946 create_event(cm_node, NES_CM_EVENT_ABORTED);
1948 atomic_inc(&cm_loopbacks);
1949 loopback_cm_info = *cm_info;
1950 loopback_cm_info.loc_port = cm_info->rem_port;
1951 loopback_cm_info.rem_port = cm_info->loc_port;
1952 loopback_cm_info.cm_id = loopbackremotelistener->cm_id;
1953 loopbackremotenode = make_cm_node(cm_core, nesvnic,
1954 &loopback_cm_info, loopbackremotelistener);
1955 loopbackremotenode->loopbackpartner = cm_node;
1956 loopbackremotenode->tcp_cntxt.rcv_wscale =
1957 NES_CM_DEFAULT_RCV_WND_SCALE;
1958 cm_node->loopbackpartner = loopbackremotenode;
1959 memcpy(loopbackremotenode->mpa_frame_buf, private_data,
1961 loopbackremotenode->mpa_frame_size = private_data_len;
1963 /* we are done handling this state. */
1964 /* set node to a TSA state */
1965 cm_node->state = NES_CM_STATE_TSA;
1966 cm_node->tcp_cntxt.rcv_nxt =
1967 loopbackremotenode->tcp_cntxt.loc_seq_num;
1968 loopbackremotenode->tcp_cntxt.rcv_nxt =
1969 cm_node->tcp_cntxt.loc_seq_num;
1970 cm_node->tcp_cntxt.max_snd_wnd =
1971 loopbackremotenode->tcp_cntxt.rcv_wnd;
1972 loopbackremotenode->tcp_cntxt.max_snd_wnd =
1973 cm_node->tcp_cntxt.rcv_wnd;
1974 cm_node->tcp_cntxt.snd_wnd =
1975 loopbackremotenode->tcp_cntxt.rcv_wnd;
1976 loopbackremotenode->tcp_cntxt.snd_wnd =
1977 cm_node->tcp_cntxt.rcv_wnd;
1978 cm_node->tcp_cntxt.snd_wscale =
1979 loopbackremotenode->tcp_cntxt.rcv_wscale;
1980 loopbackremotenode->tcp_cntxt.snd_wscale =
1981 cm_node->tcp_cntxt.rcv_wscale;
1983 create_event(loopbackremotenode, NES_CM_EVENT_MPA_REQ);
1988 /* set our node side to client (active) side */
1989 cm_node->tcp_cntxt.client = 1;
1990 /* init our MPA frame ptr */
1991 memcpy(mpa_frame->priv_data, private_data, private_data_len);
1993 cm_node->mpa_frame_size = mpa_frame_size;
1995 /* send a syn and goto syn sent state */
1996 cm_node->state = NES_CM_STATE_SYN_SENT;
1997 ret = send_syn(cm_node, 0, NULL);
2000 /* error in sending the syn free up the cm_node struct */
2001 nes_debug(NES_DBG_CM, "Api - connect() FAILED: dest "
2002 "addr=0x%08X, port=0x%04x, cm_node=%p, cm_id = %p.\n",
2003 cm_node->rem_addr, cm_node->rem_port, cm_node,
2005 rem_ref_cm_node(cm_node->cm_core, cm_node);
2010 nes_debug(NES_DBG_CM, "Api - connect(): dest addr=0x%08X,"
2011 "port=0x%04x, cm_node=%p, cm_id = %p.\n",
2012 cm_node->rem_addr, cm_node->rem_port, cm_node,
2020 * mini_cm_accept - accept a connection
2021 * This function is never called
2023 static int mini_cm_accept(struct nes_cm_core *cm_core,
2024 struct ietf_mpa_frame *mpa_frame, struct nes_cm_node *cm_node)
2031 * mini_cm_reject - reject and teardown a connection
2033 static int mini_cm_reject(struct nes_cm_core *cm_core,
2034 struct ietf_mpa_frame *mpa_frame, struct nes_cm_node *cm_node)
2039 nes_debug(NES_DBG_CM, "%s cm_node=%p type=%d state=%d\n",
2040 __func__, cm_node, cm_node->tcp_cntxt.client, cm_node->state);
2042 if (cm_node->tcp_cntxt.client)
2044 cleanup_retrans_entry(cm_node);
2046 passive_state = atomic_add_return(1, &cm_node->passive_state);
2047 cm_node->state = NES_CM_STATE_CLOSED;
2048 if (passive_state == NES_SEND_RESET_EVENT)
2049 rem_ref_cm_node(cm_core, cm_node);
2051 ret = send_reset(cm_node, NULL);
2059 static int mini_cm_close(struct nes_cm_core *cm_core, struct nes_cm_node *cm_node)
2063 if (!cm_core || !cm_node)
2066 switch (cm_node->state) {
2067 case NES_CM_STATE_SYN_RCVD:
2068 case NES_CM_STATE_SYN_SENT:
2069 case NES_CM_STATE_ONE_SIDE_ESTABLISHED:
2070 case NES_CM_STATE_ESTABLISHED:
2071 case NES_CM_STATE_ACCEPTING:
2072 case NES_CM_STATE_MPAREQ_SENT:
2073 case NES_CM_STATE_MPAREQ_RCVD:
2074 cleanup_retrans_entry(cm_node);
2075 send_reset(cm_node, NULL);
2077 case NES_CM_STATE_CLOSE_WAIT:
2078 cm_node->state = NES_CM_STATE_LAST_ACK;
2079 send_fin(cm_node, NULL);
2081 case NES_CM_STATE_FIN_WAIT1:
2082 case NES_CM_STATE_FIN_WAIT2:
2083 case NES_CM_STATE_LAST_ACK:
2084 case NES_CM_STATE_TIME_WAIT:
2085 case NES_CM_STATE_CLOSING:
2088 case NES_CM_STATE_LISTENING:
2089 case NES_CM_STATE_UNKNOWN:
2090 case NES_CM_STATE_INITED:
2091 case NES_CM_STATE_CLOSED:
2092 ret = rem_ref_cm_node(cm_core, cm_node);
2094 case NES_CM_STATE_TSA:
2095 if (cm_node->send_entry)
2096 printk(KERN_ERR "ERROR Close got called from STATE_TSA "
2097 "send_entry=%p\n", cm_node->send_entry);
2098 ret = rem_ref_cm_node(cm_core, cm_node);
2106 * recv_pkt - recv an ETHERNET packet, and process it through CM
2107 * node state machine
2109 static int mini_cm_recv_pkt(struct nes_cm_core *cm_core,
2110 struct nes_vnic *nesvnic, struct sk_buff *skb)
2112 struct nes_cm_node *cm_node = NULL;
2113 struct nes_cm_listener *listener = NULL;
2115 struct tcphdr *tcph;
2116 struct nes_cm_info nfo;
2117 int skb_handled = 1;
2121 if (skb->len < sizeof(struct iphdr) + sizeof(struct tcphdr)) {
2125 iph = (struct iphdr *)skb->data;
2126 tcph = (struct tcphdr *)(skb->data + sizeof(struct iphdr));
2128 nfo.loc_addr = ntohl(iph->daddr);
2129 nfo.loc_port = ntohs(tcph->dest);
2130 nfo.rem_addr = ntohl(iph->saddr);
2131 nfo.rem_port = ntohs(tcph->source);
2133 nes_debug(NES_DBG_CM, "Received packet: dest=" NIPQUAD_FMT
2134 ":0x%04X src=" NIPQUAD_FMT ":0x%04X\n",
2135 NIPQUAD(iph->daddr), tcph->dest,
2136 NIPQUAD(iph->saddr), tcph->source);
2139 cm_node = find_node(cm_core,
2140 nfo.rem_port, nfo.rem_addr,
2141 nfo.loc_port, nfo.loc_addr);
2144 /* Only type of packet accepted are for */
2145 /* the PASSIVE open (syn only) */
2146 if ((!tcph->syn) || (tcph->ack)) {
2150 listener = find_listener(cm_core, nfo.loc_addr,
2152 NES_CM_LISTENER_ACTIVE_STATE);
2156 nes_debug(NES_DBG_CM, "Unable to find listener for the pkt\n");
2160 nfo.cm_id = listener->cm_id;
2161 nfo.conn_type = listener->conn_type;
2162 cm_node = make_cm_node(cm_core, nesvnic, &nfo,
2165 nes_debug(NES_DBG_CM, "Unable to allocate "
2167 cm_packets_dropped++;
2168 atomic_dec(&listener->ref_count);
2169 dev_kfree_skb_any(skb);
2172 if (!tcph->rst && !tcph->fin) {
2173 cm_node->state = NES_CM_STATE_LISTENING;
2175 cm_packets_dropped++;
2176 rem_ref_cm_node(cm_core, cm_node);
2177 dev_kfree_skb_any(skb);
2180 add_ref_cm_node(cm_node);
2181 } else if (cm_node->state == NES_CM_STATE_TSA) {
2182 rem_ref_cm_node(cm_core, cm_node);
2183 atomic_inc(&cm_accel_dropped_pkts);
2184 dev_kfree_skb_any(skb);
2187 skb_reset_network_header(skb);
2188 skb_set_transport_header(skb, sizeof(*tcph));
2189 skb->len = ntohs(iph->tot_len);
2190 process_packet(cm_node, skb, cm_core);
2191 rem_ref_cm_node(cm_core, cm_node);
2198 * nes_cm_alloc_core - allocate a top level instance of a cm core
2200 static struct nes_cm_core *nes_cm_alloc_core(void)
2204 struct nes_cm_core *cm_core;
2205 struct sk_buff *skb = NULL;
2207 /* setup the CM core */
2208 /* alloc top level core control structure */
2209 cm_core = kzalloc(sizeof(*cm_core), GFP_KERNEL);
2213 INIT_LIST_HEAD(&cm_core->connected_nodes);
2214 init_timer(&cm_core->tcp_timer);
2215 cm_core->tcp_timer.function = nes_cm_timer_tick;
2217 cm_core->mtu = NES_CM_DEFAULT_MTU;
2218 cm_core->state = NES_CM_STATE_INITED;
2219 cm_core->free_tx_pkt_max = NES_CM_DEFAULT_FREE_PKTS;
2221 atomic_set(&cm_core->events_posted, 0);
2223 /* init the packet lists */
2224 skb_queue_head_init(&cm_core->tx_free_list);
2226 for (i = 0; i < NES_CM_DEFAULT_FRAME_CNT; i++) {
2227 skb = dev_alloc_skb(cm_core->mtu);
2232 /* add 'raw' skb to free frame list */
2233 skb_queue_head(&cm_core->tx_free_list, skb);
2236 cm_core->api = &nes_cm_api;
2238 spin_lock_init(&cm_core->ht_lock);
2239 spin_lock_init(&cm_core->listen_list_lock);
2241 INIT_LIST_HEAD(&cm_core->listen_list.list);
2243 nes_debug(NES_DBG_CM, "Init CM Core completed -- cm_core=%p\n", cm_core);
2245 nes_debug(NES_DBG_CM, "Enable QUEUE EVENTS\n");
2246 cm_core->event_wq = create_singlethread_workqueue("nesewq");
2247 cm_core->post_event = nes_cm_post_event;
2248 nes_debug(NES_DBG_CM, "Enable QUEUE DISCONNECTS\n");
2249 cm_core->disconn_wq = create_singlethread_workqueue("nesdwq");
2251 print_core(cm_core);
2257 * mini_cm_dealloc_core - deallocate a top level instance of a cm core
2259 static int mini_cm_dealloc_core(struct nes_cm_core *cm_core)
2261 nes_debug(NES_DBG_CM, "De-Alloc CM Core (%p)\n", cm_core);
2268 if (timer_pending(&cm_core->tcp_timer)) {
2269 del_timer(&cm_core->tcp_timer);
2272 destroy_workqueue(cm_core->event_wq);
2273 destroy_workqueue(cm_core->disconn_wq);
2274 nes_debug(NES_DBG_CM, "\n");
2284 static int mini_cm_get(struct nes_cm_core *cm_core)
2286 return cm_core->state;
2293 static int mini_cm_set(struct nes_cm_core *cm_core, u32 type, u32 value)
2298 case NES_CM_SET_PKT_SIZE:
2299 cm_core->mtu = value;
2301 case NES_CM_SET_FREE_PKT_Q_SIZE:
2302 cm_core->free_tx_pkt_max = value;
2305 /* unknown set option */
2314 * nes_cm_init_tsa_conn setup HW; MPA frames must be
2315 * successfully exchanged when this is called
2317 static int nes_cm_init_tsa_conn(struct nes_qp *nesqp, struct nes_cm_node *cm_node)
2324 nesqp->nesqp_context->misc |= cpu_to_le32(NES_QPCONTEXT_MISC_IPV4 |
2325 NES_QPCONTEXT_MISC_NO_NAGLE | NES_QPCONTEXT_MISC_DO_NOT_FRAG |
2326 NES_QPCONTEXT_MISC_DROS);
2328 if (cm_node->tcp_cntxt.snd_wscale || cm_node->tcp_cntxt.rcv_wscale)
2329 nesqp->nesqp_context->misc |= cpu_to_le32(NES_QPCONTEXT_MISC_WSCALE);
2331 nesqp->nesqp_context->misc2 |= cpu_to_le32(64 << NES_QPCONTEXT_MISC2_TTL_SHIFT);
2333 nesqp->nesqp_context->mss |= cpu_to_le32(((u32)cm_node->tcp_cntxt.mss) << 16);
2335 nesqp->nesqp_context->tcp_state_flow_label |= cpu_to_le32(
2336 (u32)NES_QPCONTEXT_TCPSTATE_EST << NES_QPCONTEXT_TCPFLOW_TCP_STATE_SHIFT);
2338 nesqp->nesqp_context->pd_index_wscale |= cpu_to_le32(
2339 (cm_node->tcp_cntxt.snd_wscale << NES_QPCONTEXT_PDWSCALE_SND_WSCALE_SHIFT) &
2340 NES_QPCONTEXT_PDWSCALE_SND_WSCALE_MASK);
2342 nesqp->nesqp_context->pd_index_wscale |= cpu_to_le32(
2343 (cm_node->tcp_cntxt.rcv_wscale << NES_QPCONTEXT_PDWSCALE_RCV_WSCALE_SHIFT) &
2344 NES_QPCONTEXT_PDWSCALE_RCV_WSCALE_MASK);
2346 nesqp->nesqp_context->keepalive = cpu_to_le32(0x80);
2347 nesqp->nesqp_context->ts_recent = 0;
2348 nesqp->nesqp_context->ts_age = 0;
2349 nesqp->nesqp_context->snd_nxt = cpu_to_le32(cm_node->tcp_cntxt.loc_seq_num);
2350 nesqp->nesqp_context->snd_wnd = cpu_to_le32(cm_node->tcp_cntxt.snd_wnd);
2351 nesqp->nesqp_context->rcv_nxt = cpu_to_le32(cm_node->tcp_cntxt.rcv_nxt);
2352 nesqp->nesqp_context->rcv_wnd = cpu_to_le32(cm_node->tcp_cntxt.rcv_wnd <<
2353 cm_node->tcp_cntxt.rcv_wscale);
2354 nesqp->nesqp_context->snd_max = cpu_to_le32(cm_node->tcp_cntxt.loc_seq_num);
2355 nesqp->nesqp_context->snd_una = cpu_to_le32(cm_node->tcp_cntxt.loc_seq_num);
2356 nesqp->nesqp_context->srtt = 0;
2357 nesqp->nesqp_context->rttvar = cpu_to_le32(0x6);
2358 nesqp->nesqp_context->ssthresh = cpu_to_le32(0x3FFFC000);
2359 nesqp->nesqp_context->cwnd = cpu_to_le32(2*cm_node->tcp_cntxt.mss);
2360 nesqp->nesqp_context->snd_wl1 = cpu_to_le32(cm_node->tcp_cntxt.rcv_nxt);
2361 nesqp->nesqp_context->snd_wl2 = cpu_to_le32(cm_node->tcp_cntxt.loc_seq_num);
2362 nesqp->nesqp_context->max_snd_wnd = cpu_to_le32(cm_node->tcp_cntxt.max_snd_wnd);
2364 nes_debug(NES_DBG_CM, "QP%u: rcv_nxt = 0x%08X, snd_nxt = 0x%08X,"
2365 " Setting MSS to %u, PDWscale = 0x%08X, rcv_wnd = %u, context misc = 0x%08X.\n",
2366 nesqp->hwqp.qp_id, le32_to_cpu(nesqp->nesqp_context->rcv_nxt),
2367 le32_to_cpu(nesqp->nesqp_context->snd_nxt),
2368 cm_node->tcp_cntxt.mss, le32_to_cpu(nesqp->nesqp_context->pd_index_wscale),
2369 le32_to_cpu(nesqp->nesqp_context->rcv_wnd),
2370 le32_to_cpu(nesqp->nesqp_context->misc));
2371 nes_debug(NES_DBG_CM, " snd_wnd = 0x%08X.\n", le32_to_cpu(nesqp->nesqp_context->snd_wnd));
2372 nes_debug(NES_DBG_CM, " snd_cwnd = 0x%08X.\n", le32_to_cpu(nesqp->nesqp_context->cwnd));
2373 nes_debug(NES_DBG_CM, " max_swnd = 0x%08X.\n", le32_to_cpu(nesqp->nesqp_context->max_snd_wnd));
2375 nes_debug(NES_DBG_CM, "Change cm_node state to TSA\n");
2376 cm_node->state = NES_CM_STATE_TSA;
2385 int nes_cm_disconn(struct nes_qp *nesqp)
2387 unsigned long flags;
2389 spin_lock_irqsave(&nesqp->lock, flags);
2390 if (nesqp->disconn_pending == 0) {
2391 nesqp->disconn_pending++;
2392 spin_unlock_irqrestore(&nesqp->lock, flags);
2393 /* init our disconnect work element, to */
2394 INIT_WORK(&nesqp->disconn_work, nes_disconnect_worker);
2396 queue_work(g_cm_core->disconn_wq, &nesqp->disconn_work);
2398 spin_unlock_irqrestore(&nesqp->lock, flags);
2405 * nes_disconnect_worker
2407 static void nes_disconnect_worker(struct work_struct *work)
2409 struct nes_qp *nesqp = container_of(work, struct nes_qp, disconn_work);
2411 nes_debug(NES_DBG_CM, "processing AEQE id 0x%04X for QP%u.\n",
2412 nesqp->last_aeq, nesqp->hwqp.qp_id);
2413 nes_cm_disconn_true(nesqp);
2418 * nes_cm_disconn_true
2420 static int nes_cm_disconn_true(struct nes_qp *nesqp)
2422 unsigned long flags;
2424 struct iw_cm_id *cm_id;
2425 struct iw_cm_event cm_event;
2426 struct nes_vnic *nesvnic;
2428 u8 original_hw_tcp_state;
2429 u8 original_ibqp_state;
2430 u8 issued_disconnect_reset = 0;
2433 nes_debug(NES_DBG_CM, "disconnect_worker nesqp is NULL\n");
2437 spin_lock_irqsave(&nesqp->lock, flags);
2438 cm_id = nesqp->cm_id;
2439 /* make sure we havent already closed this connection */
2441 nes_debug(NES_DBG_CM, "QP%u disconnect_worker cmid is NULL\n",
2443 spin_unlock_irqrestore(&nesqp->lock, flags);
2447 nesvnic = to_nesvnic(nesqp->ibqp.device);
2448 nes_debug(NES_DBG_CM, "Disconnecting QP%u\n", nesqp->hwqp.qp_id);
2450 original_hw_tcp_state = nesqp->hw_tcp_state;
2451 original_ibqp_state = nesqp->ibqp_state;
2452 last_ae = nesqp->last_aeq;
2455 nes_debug(NES_DBG_CM, "set ibqp_state=%u\n", nesqp->ibqp_state);
2457 if ((nesqp->cm_id) && (cm_id->event_handler)) {
2458 if ((original_hw_tcp_state == NES_AEQE_TCP_STATE_CLOSE_WAIT) ||
2459 ((original_ibqp_state == IB_QPS_RTS) &&
2460 (last_ae == NES_AEQE_AEID_LLP_CONNECTION_RESET))) {
2461 atomic_inc(&cm_disconnects);
2462 cm_event.event = IW_CM_EVENT_DISCONNECT;
2463 if (last_ae == NES_AEQE_AEID_LLP_CONNECTION_RESET) {
2464 cm_event.status = IW_CM_EVENT_STATUS_RESET;
2465 nes_debug(NES_DBG_CM, "Generating a CM "
2466 "Disconnect Event (status reset) for "
2467 "QP%u, cm_id = %p. \n",
2468 nesqp->hwqp.qp_id, cm_id);
2470 cm_event.status = IW_CM_EVENT_STATUS_OK;
2472 cm_event.local_addr = cm_id->local_addr;
2473 cm_event.remote_addr = cm_id->remote_addr;
2474 cm_event.private_data = NULL;
2475 cm_event.private_data_len = 0;
2477 nes_debug(NES_DBG_CM, "Generating a CM Disconnect Event"
2478 " for QP%u, SQ Head = %u, SQ Tail = %u. "
2479 "cm_id = %p, refcount = %u.\n",
2480 nesqp->hwqp.qp_id, nesqp->hwqp.sq_head,
2481 nesqp->hwqp.sq_tail, cm_id,
2482 atomic_read(&nesqp->refcount));
2484 spin_unlock_irqrestore(&nesqp->lock, flags);
2485 ret = cm_id->event_handler(cm_id, &cm_event);
2487 nes_debug(NES_DBG_CM, "OFA CM event_handler "
2488 "returned, ret=%d\n", ret);
2489 spin_lock_irqsave(&nesqp->lock, flags);
2492 nesqp->disconn_pending = 0;
2493 /* There might have been another AE while the lock was released */
2494 original_hw_tcp_state = nesqp->hw_tcp_state;
2495 original_ibqp_state = nesqp->ibqp_state;
2496 last_ae = nesqp->last_aeq;
2498 if ((issued_disconnect_reset == 0) && (nesqp->cm_id) &&
2499 ((original_hw_tcp_state == NES_AEQE_TCP_STATE_CLOSED) ||
2500 (original_hw_tcp_state == NES_AEQE_TCP_STATE_TIME_WAIT) ||
2501 (last_ae == NES_AEQE_AEID_RDMAP_ROE_BAD_LLP_CLOSE) ||
2502 (last_ae == NES_AEQE_AEID_LLP_CONNECTION_RESET))) {
2503 atomic_inc(&cm_closes);
2504 nesqp->cm_id = NULL;
2505 nesqp->in_disconnect = 0;
2506 spin_unlock_irqrestore(&nesqp->lock, flags);
2507 nes_disconnect(nesqp, 1);
2509 cm_id->provider_data = nesqp;
2510 /* Send up the close complete event */
2511 cm_event.event = IW_CM_EVENT_CLOSE;
2512 cm_event.status = IW_CM_EVENT_STATUS_OK;
2513 cm_event.provider_data = cm_id->provider_data;
2514 cm_event.local_addr = cm_id->local_addr;
2515 cm_event.remote_addr = cm_id->remote_addr;
2516 cm_event.private_data = NULL;
2517 cm_event.private_data_len = 0;
2519 ret = cm_id->event_handler(cm_id, &cm_event);
2521 nes_debug(NES_DBG_CM, "OFA CM event_handler returned, ret=%d\n", ret);
2524 cm_id->rem_ref(cm_id);
2526 spin_lock_irqsave(&nesqp->lock, flags);
2527 if (nesqp->flush_issued == 0) {
2528 nesqp->flush_issued = 1;
2529 spin_unlock_irqrestore(&nesqp->lock, flags);
2530 flush_wqes(nesvnic->nesdev, nesqp,
2531 NES_CQP_FLUSH_RQ, 1);
2533 spin_unlock_irqrestore(&nesqp->lock, flags);
2535 cm_id = nesqp->cm_id;
2536 spin_unlock_irqrestore(&nesqp->lock, flags);
2537 /* check to see if the inbound reset beat the outbound reset */
2538 if ((!cm_id) && (last_ae==NES_AEQE_AEID_RESET_SENT)) {
2539 nes_debug(NES_DBG_CM, "QP%u: Decing refcount "
2540 "due to inbound reset beating the "
2541 "outbound reset.\n", nesqp->hwqp.qp_id);
2545 nesqp->disconn_pending = 0;
2546 spin_unlock_irqrestore(&nesqp->lock, flags);
2556 static int nes_disconnect(struct nes_qp *nesqp, int abrupt)
2559 struct nes_vnic *nesvnic;
2560 struct nes_device *nesdev;
2562 nesvnic = to_nesvnic(nesqp->ibqp.device);
2566 nesdev = nesvnic->nesdev;
2568 nes_debug(NES_DBG_CM, "netdev refcnt = %u.\n",
2569 atomic_read(&nesvnic->netdev->refcnt));
2571 if (nesqp->active_conn) {
2573 /* indicate this connection is NOT active */
2574 nesqp->active_conn = 0;
2576 /* Need to free the Last Streaming Mode Message */
2577 if (nesqp->ietf_frame) {
2578 pci_free_consistent(nesdev->pcidev,
2579 nesqp->private_data_len+sizeof(struct ietf_mpa_frame),
2580 nesqp->ietf_frame, nesqp->ietf_frame_pbase);
2584 /* close the CM node down if it is still active */
2585 if (nesqp->cm_node) {
2586 nes_debug(NES_DBG_CM, "Call close API\n");
2588 g_cm_core->api->close(g_cm_core, nesqp->cm_node);
2598 int nes_accept(struct iw_cm_id *cm_id, struct iw_cm_conn_param *conn_param)
2602 struct nes_qp *nesqp;
2603 struct nes_vnic *nesvnic;
2604 struct nes_device *nesdev;
2605 struct nes_cm_node *cm_node;
2606 struct nes_adapter *adapter;
2607 struct ib_qp_attr attr;
2608 struct iw_cm_event cm_event;
2609 struct nes_hw_qp_wqe *wqe;
2610 struct nes_v4_quad nes_quad;
2615 ibqp = nes_get_qp(cm_id->device, conn_param->qpn);
2619 /* get all our handles */
2620 nesqp = to_nesqp(ibqp);
2621 nesvnic = to_nesvnic(nesqp->ibqp.device);
2622 nesdev = nesvnic->nesdev;
2623 adapter = nesdev->nesadapter;
2625 cm_node = (struct nes_cm_node *)cm_id->provider_data;
2626 nes_debug(NES_DBG_CM, "nes_accept: cm_node= %p nesvnic=%p, netdev=%p,"
2627 "%s\n", cm_node, nesvnic, nesvnic->netdev,
2628 nesvnic->netdev->name);
2630 /* associate the node with the QP */
2631 nesqp->cm_node = (void *)cm_node;
2632 cm_node->nesqp = nesqp;
2633 nes_add_ref(&nesqp->ibqp);
2635 nes_debug(NES_DBG_CM, "QP%u, cm_node=%p, jiffies = %lu listener = %p\n",
2636 nesqp->hwqp.qp_id, cm_node, jiffies, cm_node->listener);
2637 atomic_inc(&cm_accepts);
2639 nes_debug(NES_DBG_CM, "netdev refcnt = %u.\n",
2640 atomic_read(&nesvnic->netdev->refcnt));
2642 /* allocate the ietf frame and space for private data */
2643 nesqp->ietf_frame = pci_alloc_consistent(nesdev->pcidev,
2644 sizeof(struct ietf_mpa_frame) + conn_param->private_data_len,
2645 &nesqp->ietf_frame_pbase);
2647 if (!nesqp->ietf_frame) {
2648 nes_debug(NES_DBG_CM, "Unable to allocate memory for private "
2654 /* setup the MPA frame */
2655 nesqp->private_data_len = conn_param->private_data_len;
2656 memcpy(nesqp->ietf_frame->key, IEFT_MPA_KEY_REP, IETF_MPA_KEY_SIZE);
2658 memcpy(nesqp->ietf_frame->priv_data, conn_param->private_data,
2659 conn_param->private_data_len);
2661 nesqp->ietf_frame->priv_data_len =
2662 cpu_to_be16(conn_param->private_data_len);
2663 nesqp->ietf_frame->rev = mpa_version;
2664 nesqp->ietf_frame->flags = IETF_MPA_FLAGS_CRC;
2666 /* setup our first outgoing iWarp send WQE (the IETF frame response) */
2667 wqe = &nesqp->hwqp.sq_vbase[0];
2669 if (cm_id->remote_addr.sin_addr.s_addr !=
2670 cm_id->local_addr.sin_addr.s_addr) {
2671 u64temp = (unsigned long)nesqp;
2672 u64temp |= NES_SW_CONTEXT_ALIGN>>1;
2673 set_wqe_64bit_value(wqe->wqe_words,
2674 NES_IWARP_SQ_WQE_COMP_CTX_LOW_IDX,
2676 wqe->wqe_words[NES_IWARP_SQ_WQE_MISC_IDX] =
2677 cpu_to_le32(NES_IWARP_SQ_WQE_STREAMING |
2678 NES_IWARP_SQ_WQE_WRPDU);
2679 wqe->wqe_words[NES_IWARP_SQ_WQE_TOTAL_PAYLOAD_IDX] =
2680 cpu_to_le32(conn_param->private_data_len +
2681 sizeof(struct ietf_mpa_frame));
2682 wqe->wqe_words[NES_IWARP_SQ_WQE_FRAG0_LOW_IDX] =
2683 cpu_to_le32((u32)nesqp->ietf_frame_pbase);
2684 wqe->wqe_words[NES_IWARP_SQ_WQE_FRAG0_HIGH_IDX] =
2685 cpu_to_le32((u32)((u64)nesqp->ietf_frame_pbase >> 32));
2686 wqe->wqe_words[NES_IWARP_SQ_WQE_LENGTH0_IDX] =
2687 cpu_to_le32(conn_param->private_data_len +
2688 sizeof(struct ietf_mpa_frame));
2689 wqe->wqe_words[NES_IWARP_SQ_WQE_STAG0_IDX] = 0;
2691 nesqp->nesqp_context->ird_ord_sizes |=
2692 cpu_to_le32(NES_QPCONTEXT_ORDIRD_LSMM_PRESENT |
2693 NES_QPCONTEXT_ORDIRD_WRPDU);
2695 nesqp->nesqp_context->ird_ord_sizes |=
2696 cpu_to_le32((NES_QPCONTEXT_ORDIRD_LSMM_PRESENT |
2697 NES_QPCONTEXT_ORDIRD_WRPDU |
2698 NES_QPCONTEXT_ORDIRD_ALSMM));
2700 nesqp->skip_lsmm = 1;
2703 /* Cache the cm_id in the qp */
2704 nesqp->cm_id = cm_id;
2705 cm_node->cm_id = cm_id;
2707 /* nesqp->cm_node = (void *)cm_id->provider_data; */
2708 cm_id->provider_data = nesqp;
2709 nesqp->active_conn = 0;
2711 if (cm_node->state == NES_CM_STATE_TSA)
2712 nes_debug(NES_DBG_CM, "Already state = TSA for cm_node=%p\n",
2715 nes_cm_init_tsa_conn(nesqp, cm_node);
2717 nesqp->nesqp_context->tcpPorts[0] =
2718 cpu_to_le16(ntohs(cm_id->local_addr.sin_port));
2719 nesqp->nesqp_context->tcpPorts[1] =
2720 cpu_to_le16(ntohs(cm_id->remote_addr.sin_port));
2722 if (ipv4_is_loopback(cm_id->remote_addr.sin_addr.s_addr))
2723 nesqp->nesqp_context->ip0 =
2724 cpu_to_le32(ntohl(nesvnic->local_ipaddr));
2726 nesqp->nesqp_context->ip0 =
2727 cpu_to_le32(ntohl(cm_id->remote_addr.sin_addr.s_addr));
2729 nesqp->nesqp_context->misc2 |= cpu_to_le32(
2730 (u32)PCI_FUNC(nesdev->pcidev->devfn) <<
2731 NES_QPCONTEXT_MISC2_SRC_IP_SHIFT);
2733 nesqp->nesqp_context->arp_index_vlan |=
2734 cpu_to_le32(nes_arp_table(nesdev,
2735 le32_to_cpu(nesqp->nesqp_context->ip0), NULL,
2736 NES_ARP_RESOLVE) << 16);
2738 nesqp->nesqp_context->ts_val_delta = cpu_to_le32(
2739 jiffies - nes_read_indexed(nesdev, NES_IDX_TCP_NOW));
2741 nesqp->nesqp_context->ird_index = cpu_to_le32(nesqp->hwqp.qp_id);
2743 nesqp->nesqp_context->ird_ord_sizes |= cpu_to_le32(
2744 ((u32)1 << NES_QPCONTEXT_ORDIRD_IWARP_MODE_SHIFT));
2745 nesqp->nesqp_context->ird_ord_sizes |=
2746 cpu_to_le32((u32)conn_param->ord);
2748 memset(&nes_quad, 0, sizeof(nes_quad));
2749 nes_quad.DstIpAdrIndex =
2750 cpu_to_le32((u32)PCI_FUNC(nesdev->pcidev->devfn) << 24);
2751 if (ipv4_is_loopback(cm_id->remote_addr.sin_addr.s_addr))
2752 nes_quad.SrcIpadr = nesvnic->local_ipaddr;
2754 nes_quad.SrcIpadr = cm_id->remote_addr.sin_addr.s_addr;
2755 nes_quad.TcpPorts[0] = cm_id->remote_addr.sin_port;
2756 nes_quad.TcpPorts[1] = cm_id->local_addr.sin_port;
2758 /* Produce hash key */
2759 crc_value = get_crc_value(&nes_quad);
2760 nesqp->hte_index = cpu_to_be32(crc_value ^ 0xffffffff);
2761 nes_debug(NES_DBG_CM, "HTE Index = 0x%08X, CRC = 0x%08X\n",
2762 nesqp->hte_index, nesqp->hte_index & adapter->hte_index_mask);
2764 nesqp->hte_index &= adapter->hte_index_mask;
2765 nesqp->nesqp_context->hte_index = cpu_to_le32(nesqp->hte_index);
2767 cm_node->cm_core->api->accelerated(cm_node->cm_core, cm_node);
2769 nes_debug(NES_DBG_CM, "QP%u, Destination IP = 0x%08X:0x%04X, local = "
2770 "0x%08X:0x%04X, rcv_nxt=0x%08X, snd_nxt=0x%08X, mpa + "
2771 "private data length=%zu.\n", nesqp->hwqp.qp_id,
2772 ntohl(cm_id->remote_addr.sin_addr.s_addr),
2773 ntohs(cm_id->remote_addr.sin_port),
2774 ntohl(cm_id->local_addr.sin_addr.s_addr),
2775 ntohs(cm_id->local_addr.sin_port),
2776 le32_to_cpu(nesqp->nesqp_context->rcv_nxt),
2777 le32_to_cpu(nesqp->nesqp_context->snd_nxt),
2778 conn_param->private_data_len +
2779 sizeof(struct ietf_mpa_frame));
2782 /* notify OF layer that accept event was successfull */
2783 cm_id->add_ref(cm_id);
2785 cm_event.event = IW_CM_EVENT_ESTABLISHED;
2786 cm_event.status = IW_CM_EVENT_STATUS_ACCEPTED;
2787 cm_event.provider_data = (void *)nesqp;
2788 cm_event.local_addr = cm_id->local_addr;
2789 cm_event.remote_addr = cm_id->remote_addr;
2790 cm_event.private_data = NULL;
2791 cm_event.private_data_len = 0;
2792 ret = cm_id->event_handler(cm_id, &cm_event);
2793 attr.qp_state = IB_QPS_RTS;
2794 nes_modify_qp(&nesqp->ibqp, &attr, IB_QP_STATE, NULL);
2795 if (cm_node->loopbackpartner) {
2796 cm_node->loopbackpartner->mpa_frame_size =
2797 nesqp->private_data_len;
2798 /* copy entire MPA frame to our cm_node's frame */
2799 memcpy(cm_node->loopbackpartner->mpa_frame_buf,
2800 nesqp->ietf_frame->priv_data, nesqp->private_data_len);
2801 create_event(cm_node->loopbackpartner, NES_CM_EVENT_CONNECTED);
2804 printk(KERN_ERR "%s[%u] OFA CM event_handler returned, "
2805 "ret=%d\n", __func__, __LINE__, ret);
2807 passive_state = atomic_add_return(1, &cm_node->passive_state);
2808 if (passive_state == NES_SEND_RESET_EVENT)
2809 create_event(cm_node, NES_CM_EVENT_RESET);
2817 int nes_reject(struct iw_cm_id *cm_id, const void *pdata, u8 pdata_len)
2819 struct nes_cm_node *cm_node;
2820 struct nes_cm_core *cm_core;
2822 atomic_inc(&cm_rejects);
2823 cm_node = (struct nes_cm_node *) cm_id->provider_data;
2824 cm_core = cm_node->cm_core;
2825 cm_node->mpa_frame_size = sizeof(struct ietf_mpa_frame) + pdata_len;
2827 strcpy(&cm_node->mpa_frame.key[0], IEFT_MPA_KEY_REP);
2828 memcpy(&cm_node->mpa_frame.priv_data, pdata, pdata_len);
2830 cm_node->mpa_frame.priv_data_len = cpu_to_be16(pdata_len);
2831 cm_node->mpa_frame.rev = mpa_version;
2832 cm_node->mpa_frame.flags = IETF_MPA_FLAGS_CRC | IETF_MPA_FLAGS_REJECT;
2834 cm_core->api->reject(cm_core, &cm_node->mpa_frame, cm_node);
2842 * setup and launch cm connect node
2844 int nes_connect(struct iw_cm_id *cm_id, struct iw_cm_conn_param *conn_param)
2847 struct nes_qp *nesqp;
2848 struct nes_vnic *nesvnic;
2849 struct nes_device *nesdev;
2850 struct nes_cm_node *cm_node;
2851 struct nes_cm_info cm_info;
2853 ibqp = nes_get_qp(cm_id->device, conn_param->qpn);
2856 nesqp = to_nesqp(ibqp);
2859 nesvnic = to_nesvnic(nesqp->ibqp.device);
2862 nesdev = nesvnic->nesdev;
2866 nes_debug(NES_DBG_CM, "QP%u, current IP = 0x%08X, Destination IP = "
2867 "0x%08X:0x%04X, local = 0x%08X:0x%04X.\n", nesqp->hwqp.qp_id,
2868 ntohl(nesvnic->local_ipaddr),
2869 ntohl(cm_id->remote_addr.sin_addr.s_addr),
2870 ntohs(cm_id->remote_addr.sin_port),
2871 ntohl(cm_id->local_addr.sin_addr.s_addr),
2872 ntohs(cm_id->local_addr.sin_port));
2874 atomic_inc(&cm_connects);
2875 nesqp->active_conn = 1;
2877 /* cache the cm_id in the qp */
2878 nesqp->cm_id = cm_id;
2880 cm_id->provider_data = nesqp;
2882 nesqp->private_data_len = conn_param->private_data_len;
2883 nesqp->nesqp_context->ird_ord_sizes |= cpu_to_le32((u32)conn_param->ord);
2884 nes_debug(NES_DBG_CM, "requested ord = 0x%08X.\n", (u32)conn_param->ord);
2885 nes_debug(NES_DBG_CM, "mpa private data len =%u\n",
2886 conn_param->private_data_len);
2888 if (cm_id->local_addr.sin_addr.s_addr !=
2889 cm_id->remote_addr.sin_addr.s_addr)
2890 nes_manage_apbvt(nesvnic, ntohs(cm_id->local_addr.sin_port),
2891 PCI_FUNC(nesdev->pcidev->devfn), NES_MANAGE_APBVT_ADD);
2893 /* set up the connection params for the node */
2894 cm_info.loc_addr = htonl(cm_id->local_addr.sin_addr.s_addr);
2895 cm_info.loc_port = htons(cm_id->local_addr.sin_port);
2896 cm_info.rem_addr = htonl(cm_id->remote_addr.sin_addr.s_addr);
2897 cm_info.rem_port = htons(cm_id->remote_addr.sin_port);
2898 cm_info.cm_id = cm_id;
2899 cm_info.conn_type = NES_CM_IWARP_CONN_TYPE;
2901 cm_id->add_ref(cm_id);
2903 /* create a connect CM node connection */
2904 cm_node = g_cm_core->api->connect(g_cm_core, nesvnic,
2905 conn_param->private_data_len, (void *)conn_param->private_data,
2908 if (cm_id->local_addr.sin_addr.s_addr !=
2909 cm_id->remote_addr.sin_addr.s_addr)
2910 nes_manage_apbvt(nesvnic, ntohs(cm_id->local_addr.sin_port),
2911 PCI_FUNC(nesdev->pcidev->devfn),
2912 NES_MANAGE_APBVT_DEL);
2914 cm_id->rem_ref(cm_id);
2918 cm_node->apbvt_set = 1;
2919 nesqp->cm_node = cm_node;
2920 cm_node->nesqp = nesqp;
2921 nes_add_ref(&nesqp->ibqp);
2930 int nes_create_listen(struct iw_cm_id *cm_id, int backlog)
2932 struct nes_vnic *nesvnic;
2933 struct nes_cm_listener *cm_node;
2934 struct nes_cm_info cm_info;
2935 struct nes_adapter *adapter;
2939 nes_debug(NES_DBG_CM, "cm_id = %p, local port = 0x%04X.\n",
2940 cm_id, ntohs(cm_id->local_addr.sin_port));
2942 nesvnic = to_nesvnic(cm_id->device);
2945 adapter = nesvnic->nesdev->nesadapter;
2946 nes_debug(NES_DBG_CM, "nesvnic=%p, netdev=%p, %s\n",
2947 nesvnic, nesvnic->netdev, nesvnic->netdev->name);
2949 nes_debug(NES_DBG_CM, "nesvnic->local_ipaddr=0x%08x, sin_addr.s_addr=0x%08x\n",
2950 nesvnic->local_ipaddr, cm_id->local_addr.sin_addr.s_addr);
2952 /* setup listen params in our api call struct */
2953 cm_info.loc_addr = nesvnic->local_ipaddr;
2954 cm_info.loc_port = cm_id->local_addr.sin_port;
2955 cm_info.backlog = backlog;
2956 cm_info.cm_id = cm_id;
2958 cm_info.conn_type = NES_CM_IWARP_CONN_TYPE;
2961 cm_node = g_cm_core->api->listen(g_cm_core, nesvnic, &cm_info);
2963 printk(KERN_ERR "%s[%u] Error returned from listen API call\n",
2964 __func__, __LINE__);
2968 cm_id->provider_data = cm_node;
2970 if (!cm_node->reused_node) {
2971 err = nes_manage_apbvt(nesvnic,
2972 ntohs(cm_id->local_addr.sin_port),
2973 PCI_FUNC(nesvnic->nesdev->pcidev->devfn),
2974 NES_MANAGE_APBVT_ADD);
2976 printk(KERN_ERR "nes_manage_apbvt call returned %d.\n",
2978 g_cm_core->api->stop_listener(g_cm_core, (void *)cm_node);
2981 cm_listens_created++;
2984 cm_id->add_ref(cm_id);
2985 cm_id->provider_data = (void *)cm_node;
2993 * nes_destroy_listen
2995 int nes_destroy_listen(struct iw_cm_id *cm_id)
2997 if (cm_id->provider_data)
2998 g_cm_core->api->stop_listener(g_cm_core, cm_id->provider_data);
3000 nes_debug(NES_DBG_CM, "cm_id->provider_data was NULL\n");
3002 cm_id->rem_ref(cm_id);
3011 int nes_cm_recv(struct sk_buff *skb, struct net_device *netdevice)
3014 cm_packets_received++;
3015 if ((g_cm_core) && (g_cm_core->api)) {
3016 rc = g_cm_core->api->recv_pkt(g_cm_core, netdev_priv(netdevice), skb);
3018 nes_debug(NES_DBG_CM, "Unable to process packet for CM,"
3019 " cm is not setup properly.\n");
3028 * Start and init a cm core module
3030 int nes_cm_start(void)
3032 nes_debug(NES_DBG_CM, "\n");
3033 /* create the primary CM core, pass this handle to subsequent core inits */
3034 g_cm_core = nes_cm_alloc_core();
3045 * stop and dealloc all cm core instances
3047 int nes_cm_stop(void)
3049 g_cm_core->api->destroy_cm_core(g_cm_core);
3055 * cm_event_connected
3056 * handle a connected event, setup QPs and HW
3058 static void cm_event_connected(struct nes_cm_event *event)
3061 struct nes_qp *nesqp;
3062 struct nes_vnic *nesvnic;
3063 struct nes_device *nesdev;
3064 struct nes_cm_node *cm_node;
3065 struct nes_adapter *nesadapter;
3066 struct ib_qp_attr attr;
3067 struct iw_cm_id *cm_id;
3068 struct iw_cm_event cm_event;
3069 struct nes_hw_qp_wqe *wqe;
3070 struct nes_v4_quad nes_quad;
3074 /* get all our handles */
3075 cm_node = event->cm_node;
3076 cm_id = cm_node->cm_id;
3077 nes_debug(NES_DBG_CM, "cm_event_connected - %p - cm_id = %p\n", cm_node, cm_id);
3078 nesqp = (struct nes_qp *)cm_id->provider_data;
3079 nesvnic = to_nesvnic(nesqp->ibqp.device);
3080 nesdev = nesvnic->nesdev;
3081 nesadapter = nesdev->nesadapter;
3083 if (nesqp->destroyed) {
3086 atomic_inc(&cm_connecteds);
3087 nes_debug(NES_DBG_CM, "QP%u attempting to connect to 0x%08X:0x%04X on"
3088 " local port 0x%04X. jiffies = %lu.\n",
3090 ntohl(cm_id->remote_addr.sin_addr.s_addr),
3091 ntohs(cm_id->remote_addr.sin_port),
3092 ntohs(cm_id->local_addr.sin_port),
3095 nes_cm_init_tsa_conn(nesqp, cm_node);
3097 /* set the QP tsa context */
3098 nesqp->nesqp_context->tcpPorts[0] =
3099 cpu_to_le16(ntohs(cm_id->local_addr.sin_port));
3100 nesqp->nesqp_context->tcpPorts[1] =
3101 cpu_to_le16(ntohs(cm_id->remote_addr.sin_port));
3102 if (ipv4_is_loopback(cm_id->remote_addr.sin_addr.s_addr))
3103 nesqp->nesqp_context->ip0 =
3104 cpu_to_le32(ntohl(nesvnic->local_ipaddr));
3106 nesqp->nesqp_context->ip0 =
3107 cpu_to_le32(ntohl(cm_id->remote_addr.sin_addr.s_addr));
3109 nesqp->nesqp_context->misc2 |= cpu_to_le32(
3110 (u32)PCI_FUNC(nesdev->pcidev->devfn) <<
3111 NES_QPCONTEXT_MISC2_SRC_IP_SHIFT);
3112 nesqp->nesqp_context->arp_index_vlan |= cpu_to_le32(
3113 nes_arp_table(nesdev,
3114 le32_to_cpu(nesqp->nesqp_context->ip0),
3115 NULL, NES_ARP_RESOLVE) << 16);
3116 nesqp->nesqp_context->ts_val_delta = cpu_to_le32(
3117 jiffies - nes_read_indexed(nesdev, NES_IDX_TCP_NOW));
3118 nesqp->nesqp_context->ird_index = cpu_to_le32(nesqp->hwqp.qp_id);
3119 nesqp->nesqp_context->ird_ord_sizes |=
3120 cpu_to_le32((u32)1 <<
3121 NES_QPCONTEXT_ORDIRD_IWARP_MODE_SHIFT);
3123 /* Adjust tail for not having a LSMM */
3124 nesqp->hwqp.sq_tail = 1;
3126 #if defined(NES_SEND_FIRST_WRITE)
3127 if (cm_node->send_write0) {
3128 nes_debug(NES_DBG_CM, "Sending first write.\n");
3129 wqe = &nesqp->hwqp.sq_vbase[0];
3130 u64temp = (unsigned long)nesqp;
3131 u64temp |= NES_SW_CONTEXT_ALIGN>>1;
3132 set_wqe_64bit_value(wqe->wqe_words,
3133 NES_IWARP_SQ_WQE_COMP_CTX_LOW_IDX, u64temp);
3134 wqe->wqe_words[NES_IWARP_SQ_WQE_MISC_IDX] =
3135 cpu_to_le32(NES_IWARP_SQ_OP_RDMAW);
3136 wqe->wqe_words[NES_IWARP_SQ_WQE_TOTAL_PAYLOAD_IDX] = 0;
3137 wqe->wqe_words[NES_IWARP_SQ_WQE_FRAG0_LOW_IDX] = 0;
3138 wqe->wqe_words[NES_IWARP_SQ_WQE_FRAG0_HIGH_IDX] = 0;
3139 wqe->wqe_words[NES_IWARP_SQ_WQE_LENGTH0_IDX] = 0;
3140 wqe->wqe_words[NES_IWARP_SQ_WQE_STAG0_IDX] = 0;
3142 /* use the reserved spot on the WQ for the extra first WQE */
3143 nesqp->nesqp_context->ird_ord_sizes &=
3144 cpu_to_le32(~(NES_QPCONTEXT_ORDIRD_LSMM_PRESENT |
3145 NES_QPCONTEXT_ORDIRD_WRPDU |
3146 NES_QPCONTEXT_ORDIRD_ALSMM));
3147 nesqp->skip_lsmm = 1;
3148 nesqp->hwqp.sq_tail = 0;
3149 nes_write32(nesdev->regs + NES_WQE_ALLOC,
3150 (1 << 24) | 0x00800000 | nesqp->hwqp.qp_id);
3154 memset(&nes_quad, 0, sizeof(nes_quad));
3156 nes_quad.DstIpAdrIndex =
3157 cpu_to_le32((u32)PCI_FUNC(nesdev->pcidev->devfn) << 24);
3158 if (ipv4_is_loopback(cm_id->remote_addr.sin_addr.s_addr))
3159 nes_quad.SrcIpadr = nesvnic->local_ipaddr;
3161 nes_quad.SrcIpadr = cm_id->remote_addr.sin_addr.s_addr;
3162 nes_quad.TcpPorts[0] = cm_id->remote_addr.sin_port;
3163 nes_quad.TcpPorts[1] = cm_id->local_addr.sin_port;
3165 /* Produce hash key */
3166 crc_value = get_crc_value(&nes_quad);
3167 nesqp->hte_index = cpu_to_be32(crc_value ^ 0xffffffff);
3168 nes_debug(NES_DBG_CM, "HTE Index = 0x%08X, After CRC = 0x%08X\n",
3169 nesqp->hte_index, nesqp->hte_index & nesadapter->hte_index_mask);
3171 nesqp->hte_index &= nesadapter->hte_index_mask;
3172 nesqp->nesqp_context->hte_index = cpu_to_le32(nesqp->hte_index);
3174 nesqp->ietf_frame = &cm_node->mpa_frame;
3175 nesqp->private_data_len = (u8) cm_node->mpa_frame_size;
3176 cm_node->cm_core->api->accelerated(cm_node->cm_core, cm_node);
3178 /* notify OF layer we successfully created the requested connection */
3179 cm_event.event = IW_CM_EVENT_CONNECT_REPLY;
3180 cm_event.status = IW_CM_EVENT_STATUS_ACCEPTED;
3181 cm_event.provider_data = cm_id->provider_data;
3182 cm_event.local_addr.sin_family = AF_INET;
3183 cm_event.local_addr.sin_port = cm_id->local_addr.sin_port;
3184 cm_event.remote_addr = cm_id->remote_addr;
3186 cm_event.private_data = (void *)event->cm_node->mpa_frame_buf;
3187 cm_event.private_data_len = (u8) event->cm_node->mpa_frame_size;
3189 cm_event.local_addr.sin_addr.s_addr = event->cm_info.rem_addr;
3190 ret = cm_id->event_handler(cm_id, &cm_event);
3191 nes_debug(NES_DBG_CM, "OFA CM event_handler returned, ret=%d\n", ret);
3194 printk(KERN_ERR "%s[%u] OFA CM event_handler returned, "
3195 "ret=%d\n", __func__, __LINE__, ret);
3196 attr.qp_state = IB_QPS_RTS;
3197 nes_modify_qp(&nesqp->ibqp, &attr, IB_QP_STATE, NULL);
3199 nes_debug(NES_DBG_CM, "Exiting connect thread for QP%u. jiffies = "
3200 "%lu\n", nesqp->hwqp.qp_id, jiffies);
3207 * cm_event_connect_error
3209 static void cm_event_connect_error(struct nes_cm_event *event)
3211 struct nes_qp *nesqp;
3212 struct iw_cm_id *cm_id;
3213 struct iw_cm_event cm_event;
3214 /* struct nes_cm_info cm_info; */
3217 if (!event->cm_node)
3220 cm_id = event->cm_node->cm_id;
3225 nes_debug(NES_DBG_CM, "cm_node=%p, cm_id=%p\n", event->cm_node, cm_id);
3226 nesqp = cm_id->provider_data;
3232 /* notify OF layer about this connection error event */
3233 /* cm_id->rem_ref(cm_id); */
3234 nesqp->cm_id = NULL;
3235 cm_id->provider_data = NULL;
3236 cm_event.event = IW_CM_EVENT_CONNECT_REPLY;
3237 cm_event.status = IW_CM_EVENT_STATUS_REJECTED;
3238 cm_event.provider_data = cm_id->provider_data;
3239 cm_event.local_addr = cm_id->local_addr;
3240 cm_event.remote_addr = cm_id->remote_addr;
3241 cm_event.private_data = NULL;
3242 cm_event.private_data_len = 0;
3244 nes_debug(NES_DBG_CM, "call CM_EVENT REJECTED, local_addr=%08x, "
3245 "remove_addr=%08x\n", cm_event.local_addr.sin_addr.s_addr,
3246 cm_event.remote_addr.sin_addr.s_addr);
3248 ret = cm_id->event_handler(cm_id, &cm_event);
3249 nes_debug(NES_DBG_CM, "OFA CM event_handler returned, ret=%d\n", ret);
3251 printk(KERN_ERR "%s[%u] OFA CM event_handler returned, "
3252 "ret=%d\n", __func__, __LINE__, ret);
3253 cm_id->rem_ref(cm_id);
3255 rem_ref_cm_node(event->cm_node->cm_core, event->cm_node);
3263 static void cm_event_reset(struct nes_cm_event *event)
3265 struct nes_qp *nesqp;
3266 struct iw_cm_id *cm_id;
3267 struct iw_cm_event cm_event;
3268 /* struct nes_cm_info cm_info; */
3271 if (!event->cm_node)
3274 if (!event->cm_node->cm_id)
3277 cm_id = event->cm_node->cm_id;
3279 nes_debug(NES_DBG_CM, "%p - cm_id = %p\n", event->cm_node, cm_id);
3280 nesqp = cm_id->provider_data;
3282 nesqp->cm_id = NULL;
3283 /* cm_id->provider_data = NULL; */
3284 cm_event.event = IW_CM_EVENT_DISCONNECT;
3285 cm_event.status = IW_CM_EVENT_STATUS_RESET;
3286 cm_event.provider_data = cm_id->provider_data;
3287 cm_event.local_addr = cm_id->local_addr;
3288 cm_event.remote_addr = cm_id->remote_addr;
3289 cm_event.private_data = NULL;
3290 cm_event.private_data_len = 0;
3292 ret = cm_id->event_handler(cm_id, &cm_event);
3293 cm_id->add_ref(cm_id);
3294 atomic_inc(&cm_closes);
3295 cm_event.event = IW_CM_EVENT_CLOSE;
3296 cm_event.status = IW_CM_EVENT_STATUS_OK;
3297 cm_event.provider_data = cm_id->provider_data;
3298 cm_event.local_addr = cm_id->local_addr;
3299 cm_event.remote_addr = cm_id->remote_addr;
3300 cm_event.private_data = NULL;
3301 cm_event.private_data_len = 0;
3302 nes_debug(NES_DBG_CM, "NODE %p Generating CLOSE\n", event->cm_node);
3303 ret = cm_id->event_handler(cm_id, &cm_event);
3305 nes_debug(NES_DBG_CM, "OFA CM event_handler returned, ret=%d\n", ret);
3308 /* notify OF layer about this connection error event */
3309 cm_id->rem_ref(cm_id);
3318 static void cm_event_mpa_req(struct nes_cm_event *event)
3320 struct iw_cm_id *cm_id;
3321 struct iw_cm_event cm_event;
3323 struct nes_cm_node *cm_node;
3325 cm_node = event->cm_node;
3328 cm_id = cm_node->cm_id;
3330 atomic_inc(&cm_connect_reqs);
3331 nes_debug(NES_DBG_CM, "cm_node = %p - cm_id = %p, jiffies = %lu\n",
3332 cm_node, cm_id, jiffies);
3334 cm_event.event = IW_CM_EVENT_CONNECT_REQUEST;
3335 cm_event.status = IW_CM_EVENT_STATUS_OK;
3336 cm_event.provider_data = (void *)cm_node;
3338 cm_event.local_addr.sin_family = AF_INET;
3339 cm_event.local_addr.sin_port = htons(event->cm_info.loc_port);
3340 cm_event.local_addr.sin_addr.s_addr = htonl(event->cm_info.loc_addr);
3342 cm_event.remote_addr.sin_family = AF_INET;
3343 cm_event.remote_addr.sin_port = htons(event->cm_info.rem_port);
3344 cm_event.remote_addr.sin_addr.s_addr = htonl(event->cm_info.rem_addr);
3346 cm_event.private_data = cm_node->mpa_frame_buf;
3347 cm_event.private_data_len = (u8) cm_node->mpa_frame_size;
3349 ret = cm_id->event_handler(cm_id, &cm_event);
3351 printk("%s[%u] OFA CM event_handler returned, ret=%d\n",
3352 __func__, __LINE__, ret);
3358 static void nes_cm_event_handler(struct work_struct *);
3362 * post an event to the cm event handler
3364 static int nes_cm_post_event(struct nes_cm_event *event)
3366 atomic_inc(&event->cm_node->cm_core->events_posted);
3367 add_ref_cm_node(event->cm_node);
3368 event->cm_info.cm_id->add_ref(event->cm_info.cm_id);
3369 INIT_WORK(&event->event_work, nes_cm_event_handler);
3370 nes_debug(NES_DBG_CM, "cm_node=%p queue_work, event=%p\n",
3371 event->cm_node, event);
3373 queue_work(event->cm_node->cm_core->event_wq, &event->event_work);
3375 nes_debug(NES_DBG_CM, "Exit\n");
3381 * nes_cm_event_handler
3382 * worker function to handle cm events
3383 * will free instance of nes_cm_event
3385 static void nes_cm_event_handler(struct work_struct *work)
3387 struct nes_cm_event *event = container_of(work, struct nes_cm_event,
3389 struct nes_cm_core *cm_core;
3391 if ((!event) || (!event->cm_node) || (!event->cm_node->cm_core))
3394 cm_core = event->cm_node->cm_core;
3395 nes_debug(NES_DBG_CM, "event=%p, event->type=%u, events posted=%u\n",
3396 event, event->type, atomic_read(&cm_core->events_posted));
3398 switch (event->type) {
3399 case NES_CM_EVENT_MPA_REQ:
3400 cm_event_mpa_req(event);
3401 nes_debug(NES_DBG_CM, "cm_node=%p CM Event: MPA REQUEST\n",
3404 case NES_CM_EVENT_RESET:
3405 nes_debug(NES_DBG_CM, "cm_node = %p CM Event: RESET\n",
3407 cm_event_reset(event);
3409 case NES_CM_EVENT_CONNECTED:
3410 if ((!event->cm_node->cm_id) ||
3411 (event->cm_node->state != NES_CM_STATE_TSA))
3413 cm_event_connected(event);
3414 nes_debug(NES_DBG_CM, "CM Event: CONNECTED\n");
3416 case NES_CM_EVENT_ABORTED:
3417 if ((!event->cm_node->cm_id) ||
3418 (event->cm_node->state == NES_CM_STATE_TSA))
3420 cm_event_connect_error(event);
3421 nes_debug(NES_DBG_CM, "CM Event: ABORTED\n");
3423 case NES_CM_EVENT_DROPPED_PKT:
3424 nes_debug(NES_DBG_CM, "CM Event: DROPPED PKT\n");
3427 nes_debug(NES_DBG_CM, "CM Event: UNKNOWN EVENT TYPE\n");
3431 atomic_dec(&cm_core->events_posted);
3432 event->cm_info.cm_id->rem_ref(event->cm_info.cm_id);
3433 rem_ref_cm_node(cm_core, event->cm_node);