2 * ipmacsec.c "ip macsec".
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
9 * Authors: Sabrina Dubroca <sd@queasysnail.net>
16 #include <linux/genetlink.h>
17 #include <linux/if_ether.h>
18 #include <linux/if_macsec.h>
22 #include "ip_common.h"
26 static const char *values_on_off
[] = { "off", "on" };
28 static const char *VALIDATE_STR
[] = {
29 [MACSEC_VALIDATE_DISABLED
] = "disabled",
30 [MACSEC_VALIDATE_CHECK
] = "check",
31 [MACSEC_VALIDATE_STRICT
] = "strict",
43 __u8 key_id
[MACSEC_KEYID_LEN
];
45 __u8 key
[MACSEC_MAX_KEY_LEN
];
58 struct cipher_args cipher
;
60 enum macsec_validation_type validate
;
70 #define MACSEC_BUFLEN 1024
74 static struct rtnl_handle genl_rth
;
75 static int genl_family
= -1;
77 #define MACSEC_GENL_REQ(_req, _bufsiz, _cmd, _flags) \
78 GENL_REQUEST(_req, _bufsiz, genl_family, 0, MACSEC_GENL_VERSION, \
82 static void ipmacsec_usage(void)
84 fprintf(stderr
, "Usage: ip macsec add DEV tx sa { 0..3 } [ OPTS ] key ID KEY\n");
85 fprintf(stderr
, " ip macsec set DEV tx sa { 0..3 } [ OPTS ]\n");
86 fprintf(stderr
, " ip macsec del DEV tx sa { 0..3 }\n");
87 fprintf(stderr
, " ip macsec add DEV rx SCI [ on | off ]\n");
88 fprintf(stderr
, " ip macsec set DEV rx SCI [ on | off ]\n");
89 fprintf(stderr
, " ip macsec del DEV rx SCI\n");
90 fprintf(stderr
, " ip macsec add DEV rx SCI sa { 0..3 } [ OPTS ] key ID KEY\n");
91 fprintf(stderr
, " ip macsec set DEV rx SCI sa { 0..3 } [ OPTS ]\n");
92 fprintf(stderr
, " ip macsec del DEV rx SCI sa { 0..3 }\n");
93 fprintf(stderr
, " ip macsec show\n");
94 fprintf(stderr
, " ip macsec show DEV\n");
95 fprintf(stderr
, "where OPTS := [ pn <u32> ] [ on | off ]\n");
96 fprintf(stderr
, " ID := 128-bit hex string\n");
97 fprintf(stderr
, " KEY := 128-bit hex string\n");
98 fprintf(stderr
, " SCI := { sci <u64> | port { 1..2^16-1 } address <lladdr> }\n");
103 static int one_of(const char *msg
, const char *realval
, const char **list
,
104 size_t len
, int *index
)
108 for (i
= 0; i
< len
; i
++) {
109 if (matches(realval
, list
[i
]) == 0) {
115 fprintf(stderr
, "Error: argument of \"%s\" must be one of ", msg
);
116 for (i
= 0; i
< len
; i
++)
117 fprintf(stderr
, "\"%s\", ", list
[i
]);
118 fprintf(stderr
, "not \"%s\"\n", realval
);
122 static int get_an(__u8
*val
, const char *arg
)
124 int ret
= get_u8(val
, arg
, 0);
135 static int get_sci(__u64
*sci
, const char *arg
)
137 return get_be64(sci
, arg
, 16);
140 static int get_port(__be16
*port
, const char *arg
)
142 return get_be16(port
, arg
, 0);
146 #define STR(a) _STR(a)
148 static void get_icvlen(__u8
*icvlen
, char *arg
)
150 int ret
= get_u8(icvlen
, arg
, 10);
153 invarg("expected ICV length", arg
);
155 if (*icvlen
< MACSEC_MIN_ICV_LEN
|| *icvlen
> MACSEC_STD_ICV_LEN
)
156 invarg("ICV length must be in the range {"
157 STR(MACSEC_MIN_ICV_LEN
) ".." STR(MACSEC_STD_ICV_LEN
)
161 static bool get_sa(int *argcp
, char ***argvp
, __u8
*an
)
164 char **argv
= *argvp
;
167 if (argc
<= 0 || strcmp(*argv
, "sa") != 0)
171 ret
= get_an(an
, *argv
);
173 invarg("expected an { 0..3 }", *argv
);
181 static int parse_sa_args(int *argcp
, char ***argvp
, struct sa_desc
*sa
)
184 char **argv
= *argvp
;
186 bool active_set
= false;
189 if (strcmp(*argv
, "pn") == 0) {
193 ret
= get_u32(&sa
->pn
, *argv
, 0);
195 invarg("expected pn", *argv
);
197 invarg("expected pn != 0", *argv
);
198 } else if (strcmp(*argv
, "key") == 0) {
202 if (!hexstring_a2n(*argv
, sa
->key_id
, MACSEC_KEYID_LEN
,
204 invarg("expected key id", *argv
);
206 if (!hexstring_a2n(*argv
, sa
->key
, MACSEC_MAX_KEY_LEN
,
208 invarg("expected key", *argv
);
209 } else if (strcmp(*argv
, "on") == 0) {
211 duparg2("on/off", "on");
214 } else if (strcmp(*argv
, "off") == 0) {
216 duparg2("on/off", "off");
220 fprintf(stderr
, "macsec: unknown command \"%s\"?\n",
233 static __u64
make_sci(char *addr
, __be16 port
)
237 memcpy(&sci
, addr
, ETH_ALEN
);
238 memcpy(((char *)&sci
) + ETH_ALEN
, &port
, sizeof(port
));
243 static bool sci_complete(bool sci
, bool port
, bool addr
, bool port_only
)
245 return sci
|| (port
&& (addr
|| port_only
));
248 static int get_sci_portaddr(struct sci
*sci
, int *argcp
, char ***argvp
,
249 bool port_only
, bool optional
)
252 char **argv
= *argvp
;
254 bool p
= false, a
= false, s
= false;
257 if (strcmp(*argv
, "sci") == 0) {
259 invarg("expected address", *argv
);
261 invarg("expected port", *argv
);
263 ret
= get_sci(&sci
->sci
, *argv
);
265 invarg("expected sci", *argv
);
267 } else if (strcmp(*argv
, "port") == 0) {
269 ret
= get_port(&sci
->port
, *argv
);
271 invarg("expected port", *argv
);
273 invarg("expected port != 0", *argv
);
275 } else if (strcmp(*argv
, "address") == 0) {
277 ret
= ll_addr_a2n(sci
->abuf
, sizeof(sci
->abuf
), *argv
);
279 invarg("expected lladdr", *argv
);
281 } else if (optional
) {
284 invarg("expected sci, port, or address", *argv
);
289 if (sci_complete(s
, p
, a
, port_only
))
293 if (!optional
&& !sci_complete(s
, p
, a
, port_only
))
297 sci
->sci
= make_sci(sci
->abuf
, sci
->port
);
305 static bool parse_rxsci(int *argcp
, char ***argvp
, struct rxsc_desc
*rxsc
,
306 struct sa_desc
*rxsa
)
308 struct sci sci
= { 0 };
311 get_sci_portaddr(&sci
, argcp
, argvp
, false, false) < 0) {
312 fprintf(stderr
, "expected sci\n");
318 return get_sa(argcp
, argvp
, &rxsa
->an
);
321 static int parse_rxsci_args(int *argcp
, char ***argvp
, struct rxsc_desc
*rxsc
)
324 char **argv
= *argvp
;
325 bool active_set
= false;
328 if (strcmp(*argv
, "on") == 0) {
330 duparg2("on/off", "on");
333 } else if (strcmp(*argv
, "off") == 0) {
335 duparg2("on/off", "off");
336 rxsc
->active
= false;
339 fprintf(stderr
, "macsec: unknown command \"%s\"?\n",
359 static const enum macsec_nl_commands macsec_commands
[__CMD_MAX
][2][2] = {
361 [0] = {-1, MACSEC_CMD_ADD_RXSC
},
362 [1] = {MACSEC_CMD_ADD_TXSA
, MACSEC_CMD_ADD_RXSA
},
365 [0] = {-1, MACSEC_CMD_UPD_RXSC
},
366 [1] = {MACSEC_CMD_UPD_TXSA
, MACSEC_CMD_UPD_RXSA
},
369 [0] = {-1, MACSEC_CMD_DEL_RXSC
},
370 [1] = {MACSEC_CMD_DEL_TXSA
, MACSEC_CMD_DEL_RXSA
},
374 static int do_modify_nl(enum cmd c
, enum macsec_nl_commands cmd
, int ifindex
,
375 struct rxsc_desc
*rxsc
, struct sa_desc
*sa
)
377 struct rtattr
*attr_sa
;
379 MACSEC_GENL_REQ(req
, MACSEC_BUFLEN
, cmd
, NLM_F_REQUEST
);
381 addattr32(&req
.n
, MACSEC_BUFLEN
, MACSEC_ATTR_IFINDEX
, ifindex
);
383 struct rtattr
*attr_rxsc
;
385 attr_rxsc
= addattr_nest(&req
.n
, MACSEC_BUFLEN
,
386 MACSEC_ATTR_RXSC_CONFIG
);
387 addattr64(&req
.n
, MACSEC_BUFLEN
,
388 MACSEC_RXSC_ATTR_SCI
, rxsc
->sci
);
389 if (c
!= CMD_DEL
&& rxsc
->active
!= 0xff)
390 addattr8(&req
.n
, MACSEC_BUFLEN
,
391 MACSEC_RXSC_ATTR_ACTIVE
, rxsc
->active
);
393 addattr_nest_end(&req
.n
, attr_rxsc
);
399 attr_sa
= addattr_nest(&req
.n
, MACSEC_BUFLEN
, MACSEC_ATTR_SA_CONFIG
);
401 addattr8(&req
.n
, MACSEC_BUFLEN
, MACSEC_SA_ATTR_AN
, sa
->an
);
405 addattr32(&req
.n
, MACSEC_BUFLEN
, MACSEC_SA_ATTR_PN
,
409 addattr_l(&req
.n
, MACSEC_BUFLEN
, MACSEC_SA_ATTR_KEYID
,
410 sa
->key_id
, MACSEC_KEYID_LEN
);
411 addattr_l(&req
.n
, MACSEC_BUFLEN
, MACSEC_SA_ATTR_KEY
,
412 sa
->key
, sa
->key_len
);
415 if (sa
->active
!= 0xff) {
416 addattr8(&req
.n
, MACSEC_BUFLEN
,
417 MACSEC_SA_ATTR_ACTIVE
, sa
->active
);
421 addattr_nest_end(&req
.n
, attr_sa
);
424 if (rtnl_talk(&genl_rth
, &req
.n
, NULL
, 0) < 0)
430 static bool check_sa_args(enum cmd c
, struct sa_desc
*sa
)
434 fprintf(stderr
, "cannot create SA without key\n");
439 fprintf(stderr
, "must specify a packet number != 0\n");
442 } else if (c
== CMD_UPD
) {
444 fprintf(stderr
, "cannot change key on SA\n");
452 static int do_modify_txsa(enum cmd c
, int argc
, char **argv
, int ifindex
)
454 struct sa_desc txsa
= {0};
455 enum macsec_nl_commands cmd
;
460 if (argc
== 0 || !get_sa(&argc
, &argv
, &txsa
.an
))
466 if (parse_sa_args(&argc
, &argv
, &txsa
))
469 if (check_sa_args(c
, &txsa
))
473 cmd
= macsec_commands
[c
][1][0];
474 return do_modify_nl(c
, cmd
, ifindex
, NULL
, &txsa
);
477 static int do_modify_rxsci(enum cmd c
, int argc
, char **argv
, int ifindex
)
479 struct rxsc_desc rxsc
= {0};
480 struct sa_desc rxsa
= {0};
482 enum macsec_nl_commands cmd
;
484 rxsc
.ifindex
= ifindex
;
489 sa_set
= parse_rxsci(&argc
, &argv
, &rxsc
, &rxsa
);
494 if (sa_set
&& (parse_sa_args(&argc
, &argv
, &rxsa
) ||
495 check_sa_args(c
, &rxsa
)))
497 if (!sa_set
&& parse_rxsci_args(&argc
, &argv
, &rxsc
))
501 cmd
= macsec_commands
[c
][sa_set
][1];
502 return do_modify_nl(c
, cmd
, rxsc
.ifindex
, &rxsc
, &rxsa
);
505 static int do_modify(enum cmd c
, int argc
, char **argv
)
512 ifindex
= ll_name_to_index(*argv
);
514 fprintf(stderr
, "Device \"%s\" does not exist.\n", *argv
);
522 if (strcmp(*argv
, "tx") == 0)
523 return do_modify_txsa(c
, argc
-1, argv
+1, ifindex
);
524 if (strcmp(*argv
, "rx") == 0)
525 return do_modify_rxsci(c
, argc
-1, argv
+1, ifindex
);
537 static int validate_dump(struct rtattr
**attrs
)
539 return attrs
[MACSEC_ATTR_IFINDEX
] && attrs
[MACSEC_ATTR_SECY
] &&
540 attrs
[MACSEC_ATTR_TXSA_LIST
] && attrs
[MACSEC_ATTR_RXSC_LIST
] &&
541 attrs
[MACSEC_ATTR_TXSC_STATS
] && attrs
[MACSEC_ATTR_SECY_STATS
];
545 static int validate_secy_dump(struct rtattr
**attrs
)
547 return attrs
[MACSEC_SECY_ATTR_SCI
] &&
548 attrs
[MACSEC_SECY_ATTR_ENCODING_SA
] &&
549 attrs
[MACSEC_SECY_ATTR_CIPHER_SUITE
] &&
550 attrs
[MACSEC_SECY_ATTR_ICV_LEN
] &&
551 attrs
[MACSEC_SECY_ATTR_PROTECT
] &&
552 attrs
[MACSEC_SECY_ATTR_REPLAY
] &&
553 attrs
[MACSEC_SECY_ATTR_OPER
] &&
554 attrs
[MACSEC_SECY_ATTR_VALIDATE
] &&
555 attrs
[MACSEC_SECY_ATTR_ENCRYPT
] &&
556 attrs
[MACSEC_SECY_ATTR_INC_SCI
] &&
557 attrs
[MACSEC_SECY_ATTR_ES
] &&
558 attrs
[MACSEC_SECY_ATTR_SCB
];
561 static void print_flag(FILE *f
, struct rtattr
*attrs
[], const char *desc
,
565 fprintf(f
, "%s %s ", desc
,
566 values_on_off
[!!rta_getattr_u8(attrs
[field
])]);
569 #define DEFAULT_CIPHER_NAME "GCM-AES-128"
571 static const char *cs_id_to_name(__u64 cid
)
574 case MACSEC_DEFAULT_CIPHER_ID
:
575 case MACSEC_DEFAULT_CIPHER_ALT
:
576 return DEFAULT_CIPHER_NAME
;
582 static void print_cipher_suite(const char *prefix
, __u64 cid
, __u8 icv_len
)
584 printf("%scipher suite: %s, using ICV length %d\n", prefix
,
585 cs_id_to_name(cid
), icv_len
);
588 static void print_attrs(const char *prefix
, struct rtattr
*attrs
[])
590 print_flag(stdout
, attrs
, "protect", MACSEC_SECY_ATTR_PROTECT
);
592 if (attrs
[MACSEC_SECY_ATTR_VALIDATE
]) {
593 __u8 val
= rta_getattr_u8(attrs
[MACSEC_SECY_ATTR_VALIDATE
]);
595 printf("validate %s ", VALIDATE_STR
[val
]);
598 print_flag(stdout
, attrs
, "sc", MACSEC_RXSC_ATTR_ACTIVE
);
599 print_flag(stdout
, attrs
, "sa", MACSEC_SA_ATTR_ACTIVE
);
600 print_flag(stdout
, attrs
, "encrypt", MACSEC_SECY_ATTR_ENCRYPT
);
601 print_flag(stdout
, attrs
, "send_sci", MACSEC_SECY_ATTR_INC_SCI
);
602 print_flag(stdout
, attrs
, "end_station", MACSEC_SECY_ATTR_ES
);
603 print_flag(stdout
, attrs
, "scb", MACSEC_SECY_ATTR_SCB
);
605 print_flag(stdout
, attrs
, "replay", MACSEC_SECY_ATTR_REPLAY
);
606 if (attrs
[MACSEC_SECY_ATTR_WINDOW
]) {
608 rta_getattr_u32(attrs
[MACSEC_SECY_ATTR_WINDOW
]));
611 if (attrs
[MACSEC_SECY_ATTR_CIPHER_SUITE
] &&
612 attrs
[MACSEC_SECY_ATTR_ICV_LEN
]) {
614 print_cipher_suite(prefix
,
615 rta_getattr_u64(attrs
[MACSEC_SECY_ATTR_CIPHER_SUITE
]),
616 rta_getattr_u8(attrs
[MACSEC_SECY_ATTR_ICV_LEN
]));
621 static void print_one_stat(const char **names
, struct rtattr
**attr
, int idx
,
624 int pad
= strlen(names
[idx
]) + 1;
628 printf("%*llu", pad
, rta_getattr_u64(attr
[idx
]));
630 printf("%*u", pad
, rta_getattr_u32(attr
[idx
]));
632 printf("%*c", pad
, '-');
636 static const char *txsc_stats_names
[NUM_MACSEC_TXSC_STATS_ATTR
] = {
637 [MACSEC_TXSC_STATS_ATTR_OUT_PKTS_PROTECTED
] = "OutOctetsProtected",
638 [MACSEC_TXSC_STATS_ATTR_OUT_PKTS_ENCRYPTED
] = "OutOctetsEncrypted",
639 [MACSEC_TXSC_STATS_ATTR_OUT_OCTETS_PROTECTED
] = "OutPktsProtected",
640 [MACSEC_TXSC_STATS_ATTR_OUT_OCTETS_ENCRYPTED
] = "OutPktsEncrypted",
643 static void print_txsc_stats(const char *prefix
, struct rtattr
*attr
)
645 struct rtattr
*stats
[MACSEC_TXSC_STATS_ATTR_MAX
+ 1];
648 if (!attr
|| show_stats
== 0)
651 parse_rtattr_nested(stats
, MACSEC_TXSC_STATS_ATTR_MAX
+ 1, attr
);
652 printf("%sstats:", prefix
);
654 for (i
= 1; i
< NUM_MACSEC_TXSC_STATS_ATTR
; i
++) {
655 if (!txsc_stats_names
[i
])
657 printf(" %s", txsc_stats_names
[i
]);
660 printf("\n%s ", prefix
);
662 for (i
= 1; i
< NUM_MACSEC_TXSC_STATS_ATTR
; i
++) {
663 if (!txsc_stats_names
[i
])
665 print_one_stat(txsc_stats_names
, stats
, i
, true);
671 static const char *secy_stats_names
[NUM_MACSEC_SECY_STATS_ATTR
] = {
672 [MACSEC_SECY_STATS_ATTR_OUT_PKTS_UNTAGGED
] = "OutPktsUntagged",
673 [MACSEC_SECY_STATS_ATTR_IN_PKTS_UNTAGGED
] = "InPktsUntagged",
674 [MACSEC_SECY_STATS_ATTR_OUT_PKTS_TOO_LONG
] = "OutPktsTooLong",
675 [MACSEC_SECY_STATS_ATTR_IN_PKTS_NO_TAG
] = "InPktsNoTag",
676 [MACSEC_SECY_STATS_ATTR_IN_PKTS_BAD_TAG
] = "InPktsBadTag",
677 [MACSEC_SECY_STATS_ATTR_IN_PKTS_UNKNOWN_SCI
] = "InPktsUnknownSCI",
678 [MACSEC_SECY_STATS_ATTR_IN_PKTS_NO_SCI
] = "InPktsNoSCI",
679 [MACSEC_SECY_STATS_ATTR_IN_PKTS_OVERRUN
] = "InPktsOverrun",
682 static void print_secy_stats(const char *prefix
, struct rtattr
*attr
)
684 struct rtattr
*stats
[MACSEC_SECY_STATS_ATTR_MAX
+ 1];
687 if (!attr
|| show_stats
== 0)
690 parse_rtattr_nested(stats
, MACSEC_SECY_STATS_ATTR_MAX
+ 1, attr
);
691 printf("%sstats:", prefix
);
693 for (i
= 1; i
< NUM_MACSEC_SECY_STATS_ATTR
; i
++) {
694 if (!secy_stats_names
[i
])
696 printf(" %s", secy_stats_names
[i
]);
699 printf("\n%s ", prefix
);
701 for (i
= 1; i
< NUM_MACSEC_SECY_STATS_ATTR
; i
++) {
702 if (!secy_stats_names
[i
])
704 print_one_stat(secy_stats_names
, stats
, i
, true);
710 static const char *rxsa_stats_names
[NUM_MACSEC_SA_STATS_ATTR
] = {
711 [MACSEC_SA_STATS_ATTR_IN_PKTS_OK
] = "InPktsOK",
712 [MACSEC_SA_STATS_ATTR_IN_PKTS_INVALID
] = "InPktsInvalid",
713 [MACSEC_SA_STATS_ATTR_IN_PKTS_NOT_VALID
] = "InPktsNotValid",
714 [MACSEC_SA_STATS_ATTR_IN_PKTS_NOT_USING_SA
] = "InPktsNotUsingSA",
715 [MACSEC_SA_STATS_ATTR_IN_PKTS_UNUSED_SA
] = "InPktsUnusedSA",
718 static void print_rxsa_stats(const char *prefix
, struct rtattr
*attr
)
720 struct rtattr
*stats
[MACSEC_SA_STATS_ATTR_MAX
+ 1];
723 if (!attr
|| show_stats
== 0)
726 parse_rtattr_nested(stats
, MACSEC_SA_STATS_ATTR_MAX
+ 1, attr
);
727 printf("%s%s ", prefix
, prefix
);
729 for (i
= 1; i
< NUM_MACSEC_SA_STATS_ATTR
; i
++) {
730 if (!rxsa_stats_names
[i
])
732 printf(" %s", rxsa_stats_names
[i
]);
735 printf("\n%s%s ", prefix
, prefix
);
737 for (i
= 1; i
< NUM_MACSEC_SA_STATS_ATTR
; i
++) {
738 if (!rxsa_stats_names
[i
])
740 print_one_stat(rxsa_stats_names
, stats
, i
, false);
746 static const char *txsa_stats_names
[NUM_MACSEC_SA_STATS_ATTR
] = {
747 [MACSEC_SA_STATS_ATTR_OUT_PKTS_PROTECTED
] = "OutPktsProtected",
748 [MACSEC_SA_STATS_ATTR_OUT_PKTS_ENCRYPTED
] = "OutPktsEncrypted",
751 static void print_txsa_stats(const char *prefix
, struct rtattr
*attr
)
753 struct rtattr
*stats
[MACSEC_SA_STATS_ATTR_MAX
+ 1];
755 if (!attr
|| show_stats
== 0)
758 parse_rtattr_nested(stats
, MACSEC_SA_STATS_ATTR_MAX
+ 1, attr
);
759 printf("%s%s %s %s\n", prefix
, prefix
,
760 txsa_stats_names
[MACSEC_SA_STATS_ATTR_OUT_PKTS_PROTECTED
],
761 txsa_stats_names
[MACSEC_SA_STATS_ATTR_OUT_PKTS_ENCRYPTED
]);
762 printf("%s%s ", prefix
, prefix
);
764 print_one_stat(txsa_stats_names
, stats
,
765 MACSEC_SA_STATS_ATTR_OUT_PKTS_PROTECTED
, false);
766 print_one_stat(txsa_stats_names
, stats
,
767 MACSEC_SA_STATS_ATTR_OUT_PKTS_ENCRYPTED
, false);
771 static void print_tx_sc(const char *prefix
, __u64 sci
, __u8 encoding_sa
,
772 struct rtattr
*txsc_stats
, struct rtattr
*secy_stats
,
775 struct rtattr
*sa_attr
[MACSEC_SA_ATTR_MAX
+ 1];
779 printf("%sTXSC: %016llx on SA %d\n", prefix
, ntohll(sci
), encoding_sa
);
780 print_secy_stats(prefix
, secy_stats
);
781 print_txsc_stats(prefix
, txsc_stats
);
783 rem
= RTA_PAYLOAD(sa
);
784 for (a
= RTA_DATA(sa
); RTA_OK(a
, rem
); a
= RTA_NEXT(a
, rem
)) {
788 parse_rtattr_nested(sa_attr
, MACSEC_SA_ATTR_MAX
+ 1, a
);
789 state
= rta_getattr_u8(sa_attr
[MACSEC_SA_ATTR_ACTIVE
]);
790 printf("%s%s%d: PN %u, state %s, key %s\n", prefix
, prefix
,
791 rta_getattr_u8(sa_attr
[MACSEC_SA_ATTR_AN
]),
792 rta_getattr_u32(sa_attr
[MACSEC_SA_ATTR_PN
]),
793 values_on_off
[state
],
794 hexstring_n2a(RTA_DATA(sa_attr
[MACSEC_SA_ATTR_KEYID
]),
795 RTA_PAYLOAD(sa_attr
[MACSEC_SA_ATTR_KEYID
]),
796 keyid
, sizeof(keyid
)));
797 print_txsa_stats(prefix
, sa_attr
[MACSEC_SA_ATTR_STATS
]);
801 static const char *rxsc_stats_names
[NUM_MACSEC_RXSC_STATS_ATTR
] = {
802 [MACSEC_RXSC_STATS_ATTR_IN_OCTETS_VALIDATED
] = "InOctetsValidated",
803 [MACSEC_RXSC_STATS_ATTR_IN_OCTETS_DECRYPTED
] = "InOctetsDecrypted",
804 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_UNCHECKED
] = "InPktsUnchecked",
805 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_DELAYED
] = "InPktsDelayed",
806 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_OK
] = "InPktsOK",
807 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_INVALID
] = "InPktsInvalid",
808 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_LATE
] = "InPktsLate",
809 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_NOT_VALID
] = "InPktsNotValid",
810 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_NOT_USING_SA
] = "InPktsNotUsingSA",
811 [MACSEC_RXSC_STATS_ATTR_IN_PKTS_UNUSED_SA
] = "InPktsUnusedSA",
814 static void print_rxsc_stats(const char *prefix
, struct rtattr
*attr
)
816 struct rtattr
*stats
[MACSEC_RXSC_STATS_ATTR_MAX
+ 1];
819 if (!attr
|| show_stats
== 0)
822 parse_rtattr_nested(stats
, MACSEC_RXSC_STATS_ATTR_MAX
+ 1, attr
);
823 printf("%sstats:", prefix
);
824 for (i
= 1; i
< NUM_MACSEC_RXSC_STATS_ATTR
; i
++) {
825 if (!rxsc_stats_names
[i
])
827 printf(" %s", rxsc_stats_names
[i
]);
830 printf("\n%s ", prefix
);
832 for (i
= 1; i
< NUM_MACSEC_RXSC_STATS_ATTR
; i
++) {
833 if (!rxsc_stats_names
[i
])
835 print_one_stat(rxsc_stats_names
, stats
, i
, true);
841 static void print_rx_sc(const char *prefix
, __u64 sci
, __u8 active
,
842 struct rtattr
*rxsc_stats
, struct rtattr
*sa
)
844 struct rtattr
*sa_attr
[MACSEC_SA_ATTR_MAX
+ 1];
848 printf("%sRXSC: %016llx, state %s\n", prefix
, ntohll(sci
),
849 values_on_off
[!!active
]);
850 print_rxsc_stats(prefix
, rxsc_stats
);
852 rem
= RTA_PAYLOAD(sa
);
853 for (a
= RTA_DATA(sa
); RTA_OK(a
, rem
); a
= RTA_NEXT(a
, rem
)) {
857 parse_rtattr_nested(sa_attr
, MACSEC_SA_ATTR_MAX
+ 1, a
);
858 state
= rta_getattr_u8(sa_attr
[MACSEC_SA_ATTR_ACTIVE
]);
859 printf("%s%s%d: PN %u, state %s, key %s\n", prefix
, prefix
,
860 rta_getattr_u8(sa_attr
[MACSEC_SA_ATTR_AN
]),
861 rta_getattr_u32(sa_attr
[MACSEC_SA_ATTR_PN
]),
862 values_on_off
[state
],
863 hexstring_n2a(RTA_DATA(sa_attr
[MACSEC_SA_ATTR_KEYID
]),
864 RTA_PAYLOAD(sa_attr
[MACSEC_SA_ATTR_KEYID
]),
865 keyid
, sizeof(keyid
)));
866 print_rxsa_stats(prefix
, sa_attr
[MACSEC_SA_ATTR_STATS
]);
870 static int process(const struct sockaddr_nl
*who
, struct nlmsghdr
*n
,
873 struct genlmsghdr
*ghdr
;
874 struct rtattr
*attrs
[MACSEC_ATTR_MAX
+ 1], *sc
, *c
;
875 struct rtattr
*attrs_secy
[MACSEC_SECY_ATTR_MAX
+ 1];
876 int len
= n
->nlmsg_len
;
882 if (n
->nlmsg_type
!= genl_family
)
885 len
-= NLMSG_LENGTH(GENL_HDRLEN
);
889 ghdr
= NLMSG_DATA(n
);
890 if (ghdr
->cmd
!= MACSEC_CMD_GET_TXSC
)
893 parse_rtattr(attrs
, MACSEC_ATTR_MAX
, (void *) ghdr
+ GENL_HDRLEN
, len
);
894 if (!validate_dump(attrs
)) {
895 printf("incomplete dump message\n");
899 ifindex
= rta_getattr_u32(attrs
[MACSEC_ATTR_IFINDEX
]);
900 parse_rtattr_nested(attrs_secy
, MACSEC_SECY_ATTR_MAX
+ 1,
901 attrs
[MACSEC_ATTR_SECY
]);
903 if (!validate_secy_dump(attrs_secy
)) {
904 printf("incomplete dump message\n");
908 sci
= rta_getattr_u64(attrs_secy
[MACSEC_SECY_ATTR_SCI
]);
909 encoding_sa
= rta_getattr_u8(attrs_secy
[MACSEC_SECY_ATTR_ENCODING_SA
]);
911 if (filter
.ifindex
&& ifindex
!= filter
.ifindex
)
914 if (filter
.sci
&& sci
!= filter
.sci
)
917 printf("%d: %s: ", ifindex
, ll_index_to_name(ifindex
));
918 print_attrs(" ", attrs_secy
);
920 print_tx_sc(" ", sci
, encoding_sa
,
921 attrs
[MACSEC_ATTR_TXSC_STATS
],
922 attrs
[MACSEC_ATTR_SECY_STATS
],
923 attrs
[MACSEC_ATTR_TXSA_LIST
]);
925 if (!attrs
[MACSEC_ATTR_RXSC_LIST
])
928 sc
= attrs
[MACSEC_ATTR_RXSC_LIST
];
929 rem
= RTA_PAYLOAD(sc
);
930 for (c
= RTA_DATA(sc
); RTA_OK(c
, rem
); c
= RTA_NEXT(c
, rem
)) {
931 struct rtattr
*sc_attr
[MACSEC_RXSC_ATTR_MAX
+ 1];
933 parse_rtattr_nested(sc_attr
, MACSEC_RXSC_ATTR_MAX
+ 1, c
);
935 rta_getattr_u64(sc_attr
[MACSEC_RXSC_ATTR_SCI
]),
936 rta_getattr_u32(sc_attr
[MACSEC_RXSC_ATTR_ACTIVE
]),
937 sc_attr
[MACSEC_RXSC_ATTR_STATS
],
938 sc_attr
[MACSEC_RXSC_ATTR_SA_LIST
]);
944 static int do_dump(int ifindex
)
946 MACSEC_GENL_REQ(req
, MACSEC_BUFLEN
, MACSEC_CMD_GET_TXSC
,
947 NLM_F_REQUEST
| NLM_F_DUMP
);
949 memset(&filter
, 0, sizeof(filter
));
950 filter
.ifindex
= ifindex
;
952 req
.n
.nlmsg_seq
= genl_rth
.dump
= ++genl_rth
.seq
;
953 if (rtnl_send(&genl_rth
, &req
, req
.n
.nlmsg_len
) < 0) {
954 perror("Failed to send dump request");
958 if (rtnl_dump_filter(&genl_rth
, process
, stdout
) < 0) {
959 fprintf(stderr
, "Dump terminated\n");
966 static int do_show(int argc
, char **argv
)
973 ifindex
= ll_name_to_index(*argv
);
975 fprintf(stderr
, "Device \"%s\" does not exist.\n", *argv
);
981 return do_dump(ifindex
);
987 int do_ipmacsec(int argc
, char **argv
)
992 if (matches(*argv
, "help") == 0)
995 if (genl_init_handle(&genl_rth
, MACSEC_GENL_NAME
, &genl_family
))
998 if (matches(*argv
, "show") == 0)
999 return do_show(argc
-1, argv
+1);
1001 if (matches(*argv
, "add") == 0)
1002 return do_modify(CMD_ADD
, argc
-1, argv
+1);
1003 if (matches(*argv
, "set") == 0)
1004 return do_modify(CMD_UPD
, argc
-1, argv
+1);
1005 if (matches(*argv
, "delete") == 0)
1006 return do_modify(CMD_DEL
, argc
-1, argv
+1);
1008 fprintf(stderr
, "Command \"%s\" is unknown, try \"ip macsec help\".\n",
1013 /* device creation */
1014 static void macsec_print_opt(struct link_util
*lu
, FILE *f
, struct rtattr
*tb
[])
1019 if (tb
[IFLA_MACSEC_SCI
]) {
1020 fprintf(f
, "sci %016llx ",
1021 ntohll(rta_getattr_u64(tb
[IFLA_MACSEC_SCI
])));
1024 print_flag(f
, tb
, "protect", IFLA_MACSEC_PROTECT
);
1026 if (tb
[IFLA_MACSEC_CIPHER_SUITE
]) {
1027 __u64 csid
= rta_getattr_u64(tb
[IFLA_MACSEC_CIPHER_SUITE
]);
1029 fprintf(f
, "cipher %s ", cs_id_to_name(csid
));
1032 if (tb
[IFLA_MACSEC_ICV_LEN
]) {
1033 fprintf(f
, "icvlen %hhu ",
1034 rta_getattr_u8(tb
[IFLA_MACSEC_ICV_LEN
]));
1037 if (tb
[IFLA_MACSEC_ENCODING_SA
]) {
1038 fprintf(f
, "encodingsa %hhu ",
1039 rta_getattr_u8(tb
[IFLA_MACSEC_ENCODING_SA
]));
1042 if (tb
[IFLA_MACSEC_VALIDATION
]) {
1043 __u8 val
= rta_getattr_u8(tb
[IFLA_MACSEC_VALIDATION
]);
1045 fprintf(f
, "validate %s ", VALIDATE_STR
[val
]);
1048 print_flag(f
, tb
, "encrypt", IFLA_MACSEC_ENCRYPT
);
1049 print_flag(f
, tb
, "send_sci", IFLA_MACSEC_INC_SCI
);
1050 print_flag(f
, tb
, "end_station", IFLA_MACSEC_ES
);
1051 print_flag(f
, tb
, "scb", IFLA_MACSEC_SCB
);
1053 print_flag(f
, tb
, "replay", IFLA_MACSEC_REPLAY_PROTECT
);
1054 if (tb
[IFLA_MACSEC_WINDOW
]) {
1055 fprintf(f
, "window %d ",
1056 rta_getattr_u32(tb
[IFLA_MACSEC_WINDOW
]));
1060 static bool check_txsc_flags(bool es
, bool scb
, bool sci
)
1062 if (sci
&& (es
|| scb
))
1069 static void usage(FILE *f
)
1072 "Usage: ... macsec [ [ address <lladdr> ] port { 1..2^16-1 } | sci <u64> ]\n"
1073 " [ cipher { default | gcm-aes-128 } ]\n"
1074 " [ icvlen { 8..16 } ]\n"
1075 " [ encrypt { on | off } ]\n"
1076 " [ send_sci { on | off } ]\n"
1077 " [ end_station { on | off } ]\n"
1078 " [ scb { on | off } ]\n"
1079 " [ protect { on | off } ]\n"
1080 " [ replay { on | off} window { 0..2^32-1 } ]\n"
1081 " [ validate { strict | check | disabled } ]\n"
1082 " [ encodingsa { 0..3 } ]\n"
1086 static int macsec_parse_opt(struct link_util
*lu
, int argc
, char **argv
,
1087 struct nlmsghdr
*hdr
)
1090 __u8 encoding_sa
= 0xff;
1092 struct cipher_args cipher
= {0};
1093 enum macsec_validation_type validate
;
1094 bool es
= false, scb
= false, send_sci
= false;
1095 int replay_protect
= -1;
1096 struct sci sci
= { 0 };
1098 ret
= get_sci_portaddr(&sci
, &argc
, &argv
, true, true);
1100 fprintf(stderr
, "expected sci\n");
1106 addattr_l(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_SCI
,
1107 &sci
.sci
, sizeof(sci
.sci
));
1109 addattr_l(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_PORT
,
1110 &sci
.port
, sizeof(sci
.port
));
1114 if (strcmp(*argv
, "cipher") == 0) {
1117 duparg("cipher", *argv
);
1118 if (strcmp(*argv
, "default") == 0 ||
1119 strcmp(*argv
, "gcm-aes-128") == 0 ||
1120 strcmp(*argv
, "GCM-AES-128") == 0)
1121 cipher
.id
= MACSEC_DEFAULT_CIPHER_ID
;
1123 invarg("expected: default or gcm-aes-128",
1125 } else if (strcmp(*argv
, "icvlen") == 0) {
1128 duparg("icvlen", *argv
);
1129 get_icvlen(&cipher
.icv_len
, *argv
);
1130 } else if (strcmp(*argv
, "encrypt") == 0) {
1134 ret
= one_of("encrypt", *argv
, values_on_off
,
1135 ARRAY_SIZE(values_on_off
), &i
);
1138 addattr8(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_ENCRYPT
, i
);
1139 } else if (strcmp(*argv
, "send_sci") == 0) {
1143 ret
= one_of("send_sci", *argv
, values_on_off
,
1144 ARRAY_SIZE(values_on_off
), &i
);
1148 addattr8(hdr
, MACSEC_BUFLEN
,
1149 IFLA_MACSEC_INC_SCI
, send_sci
);
1150 } else if (strcmp(*argv
, "end_station") == 0) {
1154 ret
= one_of("end_station", *argv
, values_on_off
,
1155 ARRAY_SIZE(values_on_off
), &i
);
1159 addattr8(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_ES
, es
);
1160 } else if (strcmp(*argv
, "scb") == 0) {
1164 ret
= one_of("scb", *argv
, values_on_off
,
1165 ARRAY_SIZE(values_on_off
), &i
);
1169 addattr8(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_SCB
, scb
);
1170 } else if (strcmp(*argv
, "protect") == 0) {
1174 ret
= one_of("protect", *argv
, values_on_off
,
1175 ARRAY_SIZE(values_on_off
), &i
);
1178 addattr8(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_PROTECT
, i
);
1179 } else if (strcmp(*argv
, "replay") == 0) {
1183 ret
= one_of("replay", *argv
, values_on_off
,
1184 ARRAY_SIZE(values_on_off
), &i
);
1187 replay_protect
= !!i
;
1188 } else if (strcmp(*argv
, "window") == 0) {
1190 ret
= get_u32(&window
, *argv
, 0);
1192 invarg("expected replay window size", *argv
);
1193 } else if (strcmp(*argv
, "validate") == 0) {
1195 ret
= one_of("validate", *argv
,
1196 VALIDATE_STR
, ARRAY_SIZE(VALIDATE_STR
),
1200 addattr8(hdr
, MACSEC_BUFLEN
,
1201 IFLA_MACSEC_VALIDATION
, validate
);
1202 } else if (strcmp(*argv
, "encodingsa") == 0) {
1203 if (encoding_sa
!= 0xff)
1204 duparg2("encodingsa", "encodingsa");
1206 ret
= get_an(&encoding_sa
, *argv
);
1208 invarg("expected an { 0..3 }", *argv
);
1210 fprintf(stderr
, "macsec: unknown command \"%s\"?\n",
1219 if (!check_txsc_flags(es
, scb
, send_sci
)) {
1220 fprintf(stderr
, "invalid combination of send_sci/end_station/scb\n");
1224 if (window
!= -1 && replay_protect
== -1) {
1226 "replay window set, but replay protection not enabled. did you mean 'replay on window %u'?\n",
1229 } else if (window
== -1 && replay_protect
== 1) {
1231 "replay protection enabled, but no window set. did you mean 'replay on window VALUE'?\n");
1236 addattr_l(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_CIPHER_SUITE
,
1237 &cipher
.id
, sizeof(cipher
.id
));
1239 addattr_l(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_ICV_LEN
,
1240 &cipher
.icv_len
, sizeof(cipher
.icv_len
));
1242 if (replay_protect
!= -1) {
1243 addattr32(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_WINDOW
, window
);
1244 addattr8(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_REPLAY_PROTECT
,
1248 if (encoding_sa
!= 0xff) {
1249 addattr_l(hdr
, MACSEC_BUFLEN
, IFLA_MACSEC_ENCODING_SA
,
1250 &encoding_sa
, sizeof(encoding_sa
));
1256 static void macsec_print_help(struct link_util
*lu
, int argc
, char **argv
,
1262 struct link_util macsec_link_util
= {
1264 .maxattr
= IFLA_MACSEC_MAX
,
1265 .parse_opt
= macsec_parse_opt
,
1266 .print_help
= macsec_print_help
,
1267 .print_opt
= macsec_print_opt
,