Imported Upstream version 17.05

[deb_dpdk.git] / drivers / net / sfc / sfc_filter.c

diff --git a/drivers/net/sfc/sfc_filter.c b/drivers/net/sfc/sfc_filter.c
new file mode 100644 (file)
index 0000000..58b74de
--- /dev/null
+++ b/drivers/net/sfc/sfc_filter.c
@@ -0,0 +1,137 @@
+/*-
+ *   BSD LICENSE
+ *
+ * Copyright (c) 2017 Solarflare Communications Inc.
+ * All rights reserved.
+ *
+ * This software was jointly developed between OKTET Labs (under contract
+ * for Solarflare) and Solarflare Communications, Inc.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice,
+ *    this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright notice,
+ *    this list of conditions and the following disclaimer in the documentation
+ *    and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
+ * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
+ * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
+ * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
+ * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
+ * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
+ * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
+ * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <rte_common.h>
+
+#include "efx.h"
+
+#include "sfc.h"
+#include "sfc_log.h"
+
+boolean_t
+sfc_filter_is_match_supported(struct sfc_adapter *sa, uint32_t match)
+{
+       struct sfc_filter *filter = &sa->filter;
+       size_t i;
+
+       for (i = 0; i < filter->supported_match_num; ++i) {
+               if (match == filter->supported_match[i])
+                       return B_TRUE;
+       }
+
+       return B_FALSE;
+}
+
+static int
+sfc_filter_cache_match_supported(struct sfc_adapter *sa)
+{
+       struct sfc_filter *filter = &sa->filter;
+       size_t num = filter->supported_match_num;
+       uint32_t *buf = filter->supported_match;
+       unsigned int retry;
+       int rc;
+
+       /* Just a guess of possibly sufficient entries */
+       if (num == 0)
+               num = 16;
+
+       for (retry = 0; retry < 2; ++retry) {
+               if (num != filter->supported_match_num) {
+                       rc = ENOMEM;
+                       buf = rte_realloc(buf, num * sizeof(*buf), 0);
+                       if (buf == NULL)
+                               goto fail_realloc;
+               }
+
+               rc = efx_filter_supported_filters(sa->nic, buf, num, &num);
+               if (rc == 0) {
+                       filter->supported_match_num = num;
+                       filter->supported_match = buf;
+
+                       return 0;
+               } else if (rc != ENOSPC) {
+                       goto fail_efx_filter_supported_filters;
+               }
+       }
+
+       SFC_ASSERT(rc == ENOSPC);
+
+fail_efx_filter_supported_filters:
+fail_realloc:
+       /* Original pointer is not freed by rte_realloc() on failure */
+       rte_free(buf);
+       filter->supported_match = NULL;
+       filter->supported_match_num = 0;
+       return rc;
+}
+
+int
+sfc_filter_attach(struct sfc_adapter *sa)
+{
+       int rc;
+
+       sfc_log_init(sa, "entry");
+
+       rc = efx_filter_init(sa->nic);
+       if (rc != 0)
+               goto fail_filter_init;
+
+       rc = sfc_filter_cache_match_supported(sa);
+       if (rc != 0)
+               goto fail_cache_match_supported;
+
+       efx_filter_fini(sa->nic);
+
+       sfc_log_init(sa, "done");
+
+       return 0;
+
+fail_cache_match_supported:
+       efx_filter_fini(sa->nic);
+
+fail_filter_init:
+       sfc_log_init(sa, "failed %d", rc);
+       return rc;
+}
+
+void
+sfc_filter_detach(struct sfc_adapter *sa)
+{
+       struct sfc_filter *filter = &sa->filter;
+
+       sfc_log_init(sa, "entry");
+
+       rte_free(filter->supported_match);
+       filter->supported_match = NULL;
+       filter->supported_match_num = 0;
+
+       sfc_log_init(sa, "done");
+}