162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci#include <linux/netlink.h>
362306a36Sopenharmony_ci#include <linux/nospec.h>
462306a36Sopenharmony_ci#include <linux/rtnetlink.h>
562306a36Sopenharmony_ci#include <linux/types.h>
662306a36Sopenharmony_ci#include <net/ip.h>
762306a36Sopenharmony_ci#include <net/net_namespace.h>
862306a36Sopenharmony_ci#include <net/tcp.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_cistatic int ip_metrics_convert(struct net *net, struct nlattr *fc_mx,
1162306a36Sopenharmony_ci			      int fc_mx_len, u32 *metrics,
1262306a36Sopenharmony_ci			      struct netlink_ext_ack *extack)
1362306a36Sopenharmony_ci{
1462306a36Sopenharmony_ci	bool ecn_ca = false;
1562306a36Sopenharmony_ci	struct nlattr *nla;
1662306a36Sopenharmony_ci	int remaining;
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci	nla_for_each_attr(nla, fc_mx, fc_mx_len, remaining) {
1962306a36Sopenharmony_ci		int type = nla_type(nla);
2062306a36Sopenharmony_ci		u32 val;
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci		if (!type)
2362306a36Sopenharmony_ci			continue;
2462306a36Sopenharmony_ci		if (type > RTAX_MAX) {
2562306a36Sopenharmony_ci			NL_SET_ERR_MSG(extack, "Invalid metric type");
2662306a36Sopenharmony_ci			return -EINVAL;
2762306a36Sopenharmony_ci		}
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci		type = array_index_nospec(type, RTAX_MAX + 1);
3062306a36Sopenharmony_ci		if (type == RTAX_CC_ALGO) {
3162306a36Sopenharmony_ci			char tmp[TCP_CA_NAME_MAX];
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ci			nla_strscpy(tmp, nla, sizeof(tmp));
3462306a36Sopenharmony_ci			val = tcp_ca_get_key_by_name(net, tmp, &ecn_ca);
3562306a36Sopenharmony_ci			if (val == TCP_CA_UNSPEC) {
3662306a36Sopenharmony_ci				NL_SET_ERR_MSG(extack, "Unknown tcp congestion algorithm");
3762306a36Sopenharmony_ci				return -EINVAL;
3862306a36Sopenharmony_ci			}
3962306a36Sopenharmony_ci		} else {
4062306a36Sopenharmony_ci			if (nla_len(nla) != sizeof(u32)) {
4162306a36Sopenharmony_ci				NL_SET_ERR_MSG_ATTR(extack, nla,
4262306a36Sopenharmony_ci						    "Invalid attribute in metrics");
4362306a36Sopenharmony_ci				return -EINVAL;
4462306a36Sopenharmony_ci			}
4562306a36Sopenharmony_ci			val = nla_get_u32(nla);
4662306a36Sopenharmony_ci		}
4762306a36Sopenharmony_ci		if (type == RTAX_ADVMSS && val > 65535 - 40)
4862306a36Sopenharmony_ci			val = 65535 - 40;
4962306a36Sopenharmony_ci		if (type == RTAX_MTU && val > 65535 - 15)
5062306a36Sopenharmony_ci			val = 65535 - 15;
5162306a36Sopenharmony_ci		if (type == RTAX_HOPLIMIT && val > 255)
5262306a36Sopenharmony_ci			val = 255;
5362306a36Sopenharmony_ci		if (type == RTAX_FEATURES && (val & ~RTAX_FEATURE_MASK)) {
5462306a36Sopenharmony_ci			NL_SET_ERR_MSG(extack, "Unknown flag set in feature mask in metrics attribute");
5562306a36Sopenharmony_ci			return -EINVAL;
5662306a36Sopenharmony_ci		}
5762306a36Sopenharmony_ci		metrics[type - 1] = val;
5862306a36Sopenharmony_ci	}
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	if (ecn_ca)
6162306a36Sopenharmony_ci		metrics[RTAX_FEATURES - 1] |= DST_FEATURE_ECN_CA;
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci	return 0;
6462306a36Sopenharmony_ci}
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_cistruct dst_metrics *ip_fib_metrics_init(struct net *net, struct nlattr *fc_mx,
6762306a36Sopenharmony_ci					int fc_mx_len,
6862306a36Sopenharmony_ci					struct netlink_ext_ack *extack)
6962306a36Sopenharmony_ci{
7062306a36Sopenharmony_ci	struct dst_metrics *fib_metrics;
7162306a36Sopenharmony_ci	int err;
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci	if (!fc_mx)
7462306a36Sopenharmony_ci		return (struct dst_metrics *)&dst_default_metrics;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	fib_metrics = kzalloc(sizeof(*fib_metrics), GFP_KERNEL);
7762306a36Sopenharmony_ci	if (unlikely(!fib_metrics))
7862306a36Sopenharmony_ci		return ERR_PTR(-ENOMEM);
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	err = ip_metrics_convert(net, fc_mx, fc_mx_len, fib_metrics->metrics,
8162306a36Sopenharmony_ci				 extack);
8262306a36Sopenharmony_ci	if (!err) {
8362306a36Sopenharmony_ci		refcount_set(&fib_metrics->refcnt, 1);
8462306a36Sopenharmony_ci	} else {
8562306a36Sopenharmony_ci		kfree(fib_metrics);
8662306a36Sopenharmony_ci		fib_metrics = ERR_PTR(err);
8762306a36Sopenharmony_ci	}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	return fib_metrics;
9062306a36Sopenharmony_ci}
9162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(ip_fib_metrics_init);
92