blob: 39e1a4dadbfe27c3d35441a9af87f2bd8f86d32c [file] [log] [blame]
Bharath M Kumar0d87e912013-08-12 18:32:57 +05301/*
Murat Sezgin84ca6512014-04-14 13:57:24 -07002 **************************************************************************
3 * Copyright (c) 2014, The Linux Foundation. All rights reserved.
Bharath M Kumar0d87e912013-08-12 18:32:57 +05304 * Permission to use, copy, modify, and/or distribute this software for
5 * any purpose with or without fee is hereby granted, provided that the
Murat Sezgin84ca6512014-04-14 13:57:24 -07006 * above copyright notice and this permission notice appear in all copies.
Bharath M Kumar0d87e912013-08-12 18:32:57 +05307 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
8 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
9 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
10 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
11 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
12 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
13 * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
Murat Sezgin84ca6512014-04-14 13:57:24 -070014 **************************************************************************
Bharath M Kumar0d87e912013-08-12 18:32:57 +053015 */
16
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053017#include "nss_tx_rx_common.h"
Bharath M Kumar0d87e912013-08-12 18:32:57 +053018
Bharath M Kumar0d87e912013-08-12 18:32:57 +053019/*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053020 * nss_tun6rd_handler()
21 * Handle NSS -> HLOS messages for 6rd tunnel
Bharath M Kumar0d87e912013-08-12 18:32:57 +053022 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053023static void nss_tun6rd_handler(struct nss_ctx_instance *nss_ctx, struct nss_cmn_msg *ncm, __attribute__((unused))void *app_data)
Bharath M Kumar0d87e912013-08-12 18:32:57 +053024{
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053025 struct nss_tun6rd_msg *ntm = (struct nss_tun6rd_msg *)ncm;
26 void *ctx;
27 nss_tun6rd_msg_callback_t cb;
Bharath M Kumar0d87e912013-08-12 18:32:57 +053028
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053029 BUG_ON(ncm->interface != NSS_TUN6RD_INTERFACE);
Bharath M Kumar0d87e912013-08-12 18:32:57 +053030 /*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053031 * Is this a valid request/response packet?
Bharath M Kumar0d87e912013-08-12 18:32:57 +053032 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053033 if (ncm->type >= NSS_TUN6RD_MAX) {
34 nss_warning("%p: received invalid message %d for Tun6RD interface", nss_ctx, ncm->type);
Bharath M Kumar0d87e912013-08-12 18:32:57 +053035 return;
36 }
37
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053038 if (ncm->len > sizeof(struct nss_tun6rd_msg)) {
39 nss_warning("%p: tx request for another interface: %d", nss_ctx, ncm->interface);
Bharath M Kumar0d87e912013-08-12 18:32:57 +053040 return;
41 }
42
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053043 /*
44 * Update the callback and app_data for NOTIFY messages, tun6rd sends all notify messages
45 * to the same callback/app_data.
46 */
47 if (ncm->response == NSS_CMM_RESPONSE_NOTIFY) {
48 ncm->cb = (uint32_t)nss_ctx->nss_top->tun6rd_msg_callback;
49 }
Bharath M Kumar0d87e912013-08-12 18:32:57 +053050
51 /*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053052 * Log failures
Bharath M Kumar0d87e912013-08-12 18:32:57 +053053 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053054 nss_core_log_msg_failures(nss_ctx, ncm);
Bharath M Kumar0d87e912013-08-12 18:32:57 +053055
56 /*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053057 * Do we have a call back
Bharath M Kumar0d87e912013-08-12 18:32:57 +053058 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053059 if (!ncm->cb) {
Bharath M Kumar0d87e912013-08-12 18:32:57 +053060 return;
61 }
62
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053063 /*
64 * callback
65 */
66 cb = (nss_tun6rd_msg_callback_t)ncm->cb;
67 ctx = nss_ctx->nss_top->if_ctx[ncm->interface];
Bharath M Kumar0d87e912013-08-12 18:32:57 +053068
69 /*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053070 * call 6rd tunnel callback
Bharath M Kumar0d87e912013-08-12 18:32:57 +053071 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053072 if (!ctx) {
73 nss_warning("%p: Event received for 6rd tunnel interface %d before registration", nss_ctx, ncm->interface);
Bharath M Kumar0d87e912013-08-12 18:32:57 +053074 return;
Bharath M Kumar0d87e912013-08-12 18:32:57 +053075 }
76
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053077 cb(ctx, ntm);
78}
79
80
81/*
82 * nss_tun6rd_tx()
83 * Transmit a tun6rd message to NSSFW
84 */
85nss_tx_status_t nss_tun6rd_tx(struct nss_ctx_instance *nss_ctx, struct nss_tun6rd_msg *msg)
86{
87 struct nss_tun6rd_msg *nm;
88 struct nss_cmn_msg *ncm = &msg->cm;
89 struct sk_buff *nbuf;
90 int32_t status;
91
92 NSS_VERIFY_CTX_MAGIC(nss_ctx);
93 if (unlikely(nss_ctx->state != NSS_CORE_STATE_INITIALIZED)) {
94 nss_warning("%p: tun6rd msg dropped as core not ready", nss_ctx);
95 return NSS_TX_FAILURE_NOT_READY;
96 }
Bharath M Kumar0d87e912013-08-12 18:32:57 +053097
98 /*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +053099 * Sanity check the message
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530100 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530101 if (ncm->interface != NSS_TUN6RD_INTERFACE) {
102 nss_warning("%p: tx request for another interface: %d", nss_ctx, ncm->interface);
103 return NSS_TX_FAILURE;
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530104 }
105
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530106 if (ncm->type > NSS_TUN6RD_MAX) {
107 nss_warning("%p: message type out of range: %d", nss_ctx, ncm->type);
108 return NSS_TX_FAILURE;
109 }
110
111 if (ncm->len > sizeof(struct nss_tun6rd_msg)) {
112 nss_warning("%p: message length is invalid: %d", nss_ctx, ncm->len);
113 return NSS_TX_FAILURE;
114 }
115
Pamidipati, Vijayce98bbe2014-08-19 11:21:00 +0530116 nbuf = nss_skb_alloc(NSS_NBUF_PAYLOAD_SIZE);
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530117 if (unlikely(!nbuf)) {
118 spin_lock_bh(&nss_ctx->nss_top->stats_lock);
119 nss_ctx->nss_top->stats_drv[NSS_STATS_DRV_NBUF_ALLOC_FAILS]++;
120 spin_unlock_bh(&nss_ctx->nss_top->stats_lock);
121 nss_warning("%p: msg dropped as command allocation failed", nss_ctx);
122 return NSS_TX_FAILURE;
123 }
124
125 /*
126 * Copy the message to our skb
127 */
128 nm = (struct nss_tun6rd_msg *)skb_put(nbuf, sizeof(struct nss_tun6rd_msg));
129 memcpy(nm, msg, sizeof(struct nss_tun6rd_msg));
130
131 status = nss_core_send_buffer(nss_ctx, 0, nbuf, NSS_IF_CMD_QUEUE, H2N_BUFFER_CTRL, 0);
132 if (status != NSS_CORE_STATUS_SUCCESS) {
Pamidipati, Vijayce98bbe2014-08-19 11:21:00 +0530133 nss_skb_free(nbuf);
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530134 nss_warning("%p: Unable to enqueue 'tun6rd message' \n", nss_ctx);
135 return NSS_TX_FAILURE;
136 }
137
138 nss_hal_send_interrupt(nss_ctx->nmap, nss_ctx->h2n_desc_rings[NSS_IF_CMD_QUEUE].desc_ring.int_bit,
139 NSS_REGS_H2N_INTR_STATUS_DATA_COMMAND_QUEUE);
140
141 NSS_PKT_STATS_INCREMENT(nss_ctx, &nss_ctx->nss_top->stats_drv[NSS_STATS_DRV_TX_CMD_REQ]);
142 return NSS_TX_SUCCESS;
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530143}
144
145/*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530146 ***********************************
147 * Register/Unregister/Miscellaneous APIs
148 ***********************************
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530149 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530150
151/*
152 * nss_register_tun6rd_if()
153 */
154struct nss_ctx_instance *nss_register_tun6rd_if(uint32_t if_num,
155 nss_tun6rd_callback_t tun6rd_callback,
156 nss_tun6rd_msg_callback_t event_callback, struct net_device *netdev)
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530157{
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530158 nss_assert((if_num >= NSS_MAX_VIRTUAL_INTERFACES) && (if_num < NSS_MAX_NET_INTERFACES));
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530159
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530160 nss_top_main.if_ctx[if_num] = netdev;
161 nss_top_main.if_rx_callback[if_num] = tun6rd_callback;
162 nss_top_main.tun6rd_msg_callback = event_callback;
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530163
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530164 return (struct nss_ctx_instance *)&nss_top_main.nss[nss_top_main.tun6rd_handler_id];
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530165}
166
167/*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530168 * nss_unregister_tun6rd_if()
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530169 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530170void nss_unregister_tun6rd_if(uint32_t if_num)
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530171{
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530172 nss_assert((if_num >= NSS_MAX_VIRTUAL_INTERFACES) && (if_num < NSS_MAX_NET_INTERFACES));
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530173
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530174 nss_top_main.if_rx_callback[if_num] = NULL;
175 nss_top_main.if_ctx[if_num] = NULL;
176 nss_top_main.tun6rd_msg_callback = NULL;
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530177}
178
179/*
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530180 * nss_tun6rd_register_handler()
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530181 */
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530182void nss_tun6rd_register_handler()
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530183{
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530184 nss_core_register_handler(NSS_TUN6RD_INTERFACE, nss_tun6rd_handler, NULL);
Bharath M Kumar0d87e912013-08-12 18:32:57 +0530185}
186
Radhakrishna Jiguru5ad493d2013-11-25 20:17:54 +0530187
Radha krishna Simha Jiguru62a29e62014-04-04 17:28:53 +0530188EXPORT_SYMBOL(nss_tun6rd_tx);
189EXPORT_SYMBOL(nss_register_tun6rd_if);
190EXPORT_SYMBOL(nss_unregister_tun6rd_if);