forked from mirrors/linux
1a629afd59
Commit 02b34d03a2 ("netdevsim: add dummy macsec offload") pads u64
number to 8 characters using "%08llx" format specifier.
Changing format specifier to "%016llx" ensures that no matter the value
the representation of number in log is always the same length.
Before this patch, entry in log for value '1' would say:
removing SecY with SCI 00000001 at index 2
After this patch is applied, entry in log will say:
removing SecY with SCI 0000000000000001 at index 2
Signed-off-by: Ales Nezbeda <anezbeda@redhat.com>
Reviewed-by: Simon Horman <horms@kernel.org>
Reviewed-by: Sabrina Dubroca <sd@queasysnail.net>
Link: https://patch.msgid.link/20241017131933.136971-1-anezbeda@redhat.com
Signed-off-by: Paolo Abeni <pabeni@redhat.com>
351 lines
9.1 KiB
C
351 lines
9.1 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
|
|
#include <net/macsec.h>
|
|
#include "netdevsim.h"
|
|
|
|
static int nsim_macsec_find_secy(struct netdevsim *ns, sci_t sci)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < NSIM_MACSEC_MAX_SECY_COUNT; i++) {
|
|
if (ns->macsec.nsim_secy[i].sci == sci)
|
|
return i;
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
static int nsim_macsec_find_rxsc(struct nsim_secy *ns_secy, sci_t sci)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < NSIM_MACSEC_MAX_RXSC_COUNT; i++) {
|
|
if (ns_secy->nsim_rxsc[i].sci == sci)
|
|
return i;
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
static int nsim_macsec_add_secy(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
if (ns->macsec.nsim_secy_count == NSIM_MACSEC_MAX_SECY_COUNT)
|
|
return -ENOSPC;
|
|
|
|
for (idx = 0; idx < NSIM_MACSEC_MAX_SECY_COUNT; idx++) {
|
|
if (!ns->macsec.nsim_secy[idx].used)
|
|
break;
|
|
}
|
|
|
|
if (idx == NSIM_MACSEC_MAX_SECY_COUNT) {
|
|
netdev_err(ctx->netdev, "%s: nsim_secy_count not full but all SecYs used\n",
|
|
__func__);
|
|
return -ENOSPC;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: adding new secy with sci %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), idx);
|
|
ns->macsec.nsim_secy[idx].used = true;
|
|
ns->macsec.nsim_secy[idx].nsim_rxsc_count = 0;
|
|
ns->macsec.nsim_secy[idx].sci = ctx->secy->sci;
|
|
ns->macsec.nsim_secy_count++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_upd_secy(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: updating secy with sci %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), idx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_del_secy(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: removing SecY with SCI %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), idx);
|
|
|
|
ns->macsec.nsim_secy[idx].used = false;
|
|
memset(&ns->macsec.nsim_secy[idx], 0, sizeof(ns->macsec.nsim_secy[idx]));
|
|
ns->macsec.nsim_secy_count--;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_add_rxsc(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
if (secy->nsim_rxsc_count == NSIM_MACSEC_MAX_RXSC_COUNT)
|
|
return -ENOSPC;
|
|
|
|
for (idx = 0; idx < NSIM_MACSEC_MAX_RXSC_COUNT; idx++) {
|
|
if (!secy->nsim_rxsc[idx].used)
|
|
break;
|
|
}
|
|
|
|
if (idx == NSIM_MACSEC_MAX_RXSC_COUNT)
|
|
netdev_err(ctx->netdev, "%s: nsim_rxsc_count not full but all RXSCs used\n",
|
|
__func__);
|
|
|
|
netdev_dbg(ctx->netdev, "%s: adding new rxsc with sci %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->rx_sc->sci), idx);
|
|
secy->nsim_rxsc[idx].used = true;
|
|
secy->nsim_rxsc[idx].sci = ctx->rx_sc->sci;
|
|
secy->nsim_rxsc_count++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_upd_rxsc(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
idx = nsim_macsec_find_rxsc(secy, ctx->rx_sc->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in RXSC table\n",
|
|
__func__, sci_to_cpu(ctx->rx_sc->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: updating RXSC with sci %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->rx_sc->sci), idx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_del_rxsc(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
idx = nsim_macsec_find_rxsc(secy, ctx->rx_sc->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in RXSC table\n",
|
|
__func__, sci_to_cpu(ctx->rx_sc->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: removing RXSC with sci %016llx at index %d\n",
|
|
__func__, sci_to_cpu(ctx->rx_sc->sci), idx);
|
|
|
|
secy->nsim_rxsc[idx].used = false;
|
|
memset(&secy->nsim_rxsc[idx], 0, sizeof(secy->nsim_rxsc[idx]));
|
|
secy->nsim_rxsc_count--;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_add_rxsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
idx = nsim_macsec_find_rxsc(secy, ctx->sa.rx_sa->sc->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in RXSC table\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: RXSC with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_upd_rxsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
idx = nsim_macsec_find_rxsc(secy, ctx->sa.rx_sa->sc->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in RXSC table\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: RXSC with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_del_rxsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
struct nsim_secy *secy;
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
secy = &ns->macsec.nsim_secy[idx];
|
|
|
|
idx = nsim_macsec_find_rxsc(secy, ctx->sa.rx_sa->sc->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in RXSC table\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: RXSC with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_add_txsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: SECY with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_upd_txsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: SECY with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nsim_macsec_del_txsa(struct macsec_context *ctx)
|
|
{
|
|
struct netdevsim *ns = netdev_priv(ctx->netdev);
|
|
int idx;
|
|
|
|
idx = nsim_macsec_find_secy(ns, ctx->secy->sci);
|
|
if (idx < 0) {
|
|
netdev_err(ctx->netdev, "%s: sci %016llx not found in secy table\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci));
|
|
return -ENOENT;
|
|
}
|
|
|
|
netdev_dbg(ctx->netdev, "%s: SECY with sci %016llx, AN %u\n",
|
|
__func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct macsec_ops nsim_macsec_ops = {
|
|
.mdo_add_secy = nsim_macsec_add_secy,
|
|
.mdo_upd_secy = nsim_macsec_upd_secy,
|
|
.mdo_del_secy = nsim_macsec_del_secy,
|
|
.mdo_add_rxsc = nsim_macsec_add_rxsc,
|
|
.mdo_upd_rxsc = nsim_macsec_upd_rxsc,
|
|
.mdo_del_rxsc = nsim_macsec_del_rxsc,
|
|
.mdo_add_rxsa = nsim_macsec_add_rxsa,
|
|
.mdo_upd_rxsa = nsim_macsec_upd_rxsa,
|
|
.mdo_del_rxsa = nsim_macsec_del_rxsa,
|
|
.mdo_add_txsa = nsim_macsec_add_txsa,
|
|
.mdo_upd_txsa = nsim_macsec_upd_txsa,
|
|
.mdo_del_txsa = nsim_macsec_del_txsa,
|
|
};
|
|
|
|
void nsim_macsec_init(struct netdevsim *ns)
|
|
{
|
|
ns->netdev->macsec_ops = &nsim_macsec_ops;
|
|
ns->netdev->features |= NETIF_F_HW_MACSEC;
|
|
memset(&ns->macsec, 0, sizeof(ns->macsec));
|
|
}
|
|
|
|
void nsim_macsec_teardown(struct netdevsim *ns)
|
|
{
|
|
}
|