xref: /openbmc/linux/drivers/net/ethernet/mellanox/mlxsw/spectrum_ipip.c (revision 5f8b7d4b2e9604d03ae06f1a2dd5a1f34c33e533)
19948a064SJiri Pirko // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
29948a064SJiri Pirko /* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */
338ebc0f4SPetr Machata 
4ee954d1aSPetr Machata #include <net/ip_tunnels.h>
58897207cSPetr Machata #include <net/ip6_tunnel.h>
64a44ee67SAmit Cohen #include <net/inet_ecn.h>
7ee954d1aSPetr Machata 
838ebc0f4SPetr Machata #include "spectrum_ipip.h"
94a44ee67SAmit Cohen #include "reg.h"
1038ebc0f4SPetr Machata 
119fb7bd77SPetr Machata struct ip_tunnel_parm
mlxsw_sp_ipip_netdev_parms4(const struct net_device * ol_dev)12e437f3b6SPetr Machata mlxsw_sp_ipip_netdev_parms4(const struct net_device *ol_dev)
13ee954d1aSPetr Machata {
14ee954d1aSPetr Machata 	struct ip_tunnel *tun = netdev_priv(ol_dev);
15ee954d1aSPetr Machata 
169fb7bd77SPetr Machata 	return tun->parms;
17ee954d1aSPetr Machata }
18ee954d1aSPetr Machata 
198897207cSPetr Machata struct __ip6_tnl_parm
mlxsw_sp_ipip_netdev_parms6(const struct net_device * ol_dev)208897207cSPetr Machata mlxsw_sp_ipip_netdev_parms6(const struct net_device *ol_dev)
218897207cSPetr Machata {
228897207cSPetr Machata 	struct ip6_tnl *tun = netdev_priv(ol_dev);
238897207cSPetr Machata 
248897207cSPetr Machata 	return tun->parms;
258897207cSPetr Machata }
268897207cSPetr Machata 
mlxsw_sp_ipip_parms4_has_ikey(const struct ip_tunnel_parm * parms)27aa6fd8f1SAmit Cohen static bool mlxsw_sp_ipip_parms4_has_ikey(const struct ip_tunnel_parm *parms)
28ee954d1aSPetr Machata {
29aa6fd8f1SAmit Cohen 	return !!(parms->i_flags & TUNNEL_KEY);
309fb7bd77SPetr Machata }
31ee954d1aSPetr Machata 
mlxsw_sp_ipip_parms6_has_ikey(const struct __ip6_tnl_parm * parms)32ba1c7132SAmit Cohen static bool mlxsw_sp_ipip_parms6_has_ikey(const struct __ip6_tnl_parm *parms)
33ba1c7132SAmit Cohen {
34ba1c7132SAmit Cohen 	return !!(parms->i_flags & TUNNEL_KEY);
35ba1c7132SAmit Cohen }
36ba1c7132SAmit Cohen 
mlxsw_sp_ipip_parms4_has_okey(const struct ip_tunnel_parm * parms)37aa6fd8f1SAmit Cohen static bool mlxsw_sp_ipip_parms4_has_okey(const struct ip_tunnel_parm *parms)
389fb7bd77SPetr Machata {
39aa6fd8f1SAmit Cohen 	return !!(parms->o_flags & TUNNEL_KEY);
409fb7bd77SPetr Machata }
419fb7bd77SPetr Machata 
mlxsw_sp_ipip_parms6_has_okey(const struct __ip6_tnl_parm * parms)42ba1c7132SAmit Cohen static bool mlxsw_sp_ipip_parms6_has_okey(const struct __ip6_tnl_parm *parms)
43ba1c7132SAmit Cohen {
44ba1c7132SAmit Cohen 	return !!(parms->o_flags & TUNNEL_KEY);
45ba1c7132SAmit Cohen }
46ba1c7132SAmit Cohen 
mlxsw_sp_ipip_parms4_ikey(const struct ip_tunnel_parm * parms)47aa6fd8f1SAmit Cohen static u32 mlxsw_sp_ipip_parms4_ikey(const struct ip_tunnel_parm *parms)
489fb7bd77SPetr Machata {
49e437f3b6SPetr Machata 	return mlxsw_sp_ipip_parms4_has_ikey(parms) ?
50aa6fd8f1SAmit Cohen 		be32_to_cpu(parms->i_key) : 0;
519fb7bd77SPetr Machata }
529fb7bd77SPetr Machata 
mlxsw_sp_ipip_parms6_ikey(const struct __ip6_tnl_parm * parms)53ba1c7132SAmit Cohen static u32 mlxsw_sp_ipip_parms6_ikey(const struct __ip6_tnl_parm *parms)
54ba1c7132SAmit Cohen {
55ba1c7132SAmit Cohen 	return mlxsw_sp_ipip_parms6_has_ikey(parms) ?
56ba1c7132SAmit Cohen 		be32_to_cpu(parms->i_key) : 0;
57ba1c7132SAmit Cohen }
58ba1c7132SAmit Cohen 
mlxsw_sp_ipip_parms4_okey(const struct ip_tunnel_parm * parms)59aa6fd8f1SAmit Cohen static u32 mlxsw_sp_ipip_parms4_okey(const struct ip_tunnel_parm *parms)
609fb7bd77SPetr Machata {
61e437f3b6SPetr Machata 	return mlxsw_sp_ipip_parms4_has_okey(parms) ?
62aa6fd8f1SAmit Cohen 		be32_to_cpu(parms->o_key) : 0;
639fb7bd77SPetr Machata }
649fb7bd77SPetr Machata 
mlxsw_sp_ipip_parms6_okey(const struct __ip6_tnl_parm * parms)65ba1c7132SAmit Cohen static u32 mlxsw_sp_ipip_parms6_okey(const struct __ip6_tnl_parm *parms)
66ba1c7132SAmit Cohen {
67ba1c7132SAmit Cohen 	return mlxsw_sp_ipip_parms6_has_okey(parms) ?
68ba1c7132SAmit Cohen 		be32_to_cpu(parms->o_key) : 0;
69ba1c7132SAmit Cohen }
70ba1c7132SAmit Cohen 
71e437f3b6SPetr Machata static union mlxsw_sp_l3addr
mlxsw_sp_ipip_parms4_saddr(const struct ip_tunnel_parm * parms)72aa6fd8f1SAmit Cohen mlxsw_sp_ipip_parms4_saddr(const struct ip_tunnel_parm *parms)
739fb7bd77SPetr Machata {
74aa6fd8f1SAmit Cohen 	return (union mlxsw_sp_l3addr) { .addr4 = parms->iph.saddr };
759fb7bd77SPetr Machata }
769fb7bd77SPetr Machata 
779fb7bd77SPetr Machata static union mlxsw_sp_l3addr
mlxsw_sp_ipip_parms6_saddr(const struct __ip6_tnl_parm * parms)78aa6fd8f1SAmit Cohen mlxsw_sp_ipip_parms6_saddr(const struct __ip6_tnl_parm *parms)
798897207cSPetr Machata {
80aa6fd8f1SAmit Cohen 	return (union mlxsw_sp_l3addr) { .addr6 = parms->laddr };
818897207cSPetr Machata }
828897207cSPetr Machata 
838897207cSPetr Machata static union mlxsw_sp_l3addr
mlxsw_sp_ipip_parms4_daddr(const struct ip_tunnel_parm * parms)84aa6fd8f1SAmit Cohen mlxsw_sp_ipip_parms4_daddr(const struct ip_tunnel_parm *parms)
859fb7bd77SPetr Machata {
86aa6fd8f1SAmit Cohen 	return (union mlxsw_sp_l3addr) { .addr4 = parms->iph.daddr };
87474f0ff6SPetr Machata }
88474f0ff6SPetr Machata 
898897207cSPetr Machata static union mlxsw_sp_l3addr
mlxsw_sp_ipip_parms6_daddr(const struct __ip6_tnl_parm * parms)90aa6fd8f1SAmit Cohen mlxsw_sp_ipip_parms6_daddr(const struct __ip6_tnl_parm *parms)
918897207cSPetr Machata {
92aa6fd8f1SAmit Cohen 	return (union mlxsw_sp_l3addr) { .addr6 = parms->raddr };
938897207cSPetr Machata }
948897207cSPetr Machata 
95474f0ff6SPetr Machata union mlxsw_sp_l3addr
mlxsw_sp_ipip_netdev_saddr(enum mlxsw_sp_l3proto proto,const struct net_device * ol_dev)96474f0ff6SPetr Machata mlxsw_sp_ipip_netdev_saddr(enum mlxsw_sp_l3proto proto,
97474f0ff6SPetr Machata 			   const struct net_device *ol_dev)
98474f0ff6SPetr Machata {
99e437f3b6SPetr Machata 	struct ip_tunnel_parm parms4;
1008897207cSPetr Machata 	struct __ip6_tnl_parm parms6;
101e437f3b6SPetr Machata 
102e437f3b6SPetr Machata 	switch (proto) {
103e437f3b6SPetr Machata 	case MLXSW_SP_L3_PROTO_IPV4:
104e437f3b6SPetr Machata 		parms4 = mlxsw_sp_ipip_netdev_parms4(ol_dev);
105aa6fd8f1SAmit Cohen 		return mlxsw_sp_ipip_parms4_saddr(&parms4);
106e437f3b6SPetr Machata 	case MLXSW_SP_L3_PROTO_IPV6:
1078897207cSPetr Machata 		parms6 = mlxsw_sp_ipip_netdev_parms6(ol_dev);
108aa6fd8f1SAmit Cohen 		return mlxsw_sp_ipip_parms6_saddr(&parms6);
109e437f3b6SPetr Machata 	}
110e437f3b6SPetr Machata 
111e437f3b6SPetr Machata 	WARN_ON(1);
112e437f3b6SPetr Machata 	return (union mlxsw_sp_l3addr) {0};
113474f0ff6SPetr Machata }
114474f0ff6SPetr Machata 
mlxsw_sp_ipip_netdev_daddr4(const struct net_device * ol_dev)115474f0ff6SPetr Machata static __be32 mlxsw_sp_ipip_netdev_daddr4(const struct net_device *ol_dev)
116474f0ff6SPetr Machata {
117e437f3b6SPetr Machata 
118e437f3b6SPetr Machata 	struct ip_tunnel_parm parms4 = mlxsw_sp_ipip_netdev_parms4(ol_dev);
119e437f3b6SPetr Machata 
120aa6fd8f1SAmit Cohen 	return mlxsw_sp_ipip_parms4_daddr(&parms4).addr4;
121474f0ff6SPetr Machata }
122474f0ff6SPetr Machata 
123474f0ff6SPetr Machata static union mlxsw_sp_l3addr
mlxsw_sp_ipip_netdev_daddr(enum mlxsw_sp_l3proto proto,const struct net_device * ol_dev)124474f0ff6SPetr Machata mlxsw_sp_ipip_netdev_daddr(enum mlxsw_sp_l3proto proto,
125474f0ff6SPetr Machata 			   const struct net_device *ol_dev)
126474f0ff6SPetr Machata {
127e437f3b6SPetr Machata 	struct ip_tunnel_parm parms4;
1288897207cSPetr Machata 	struct __ip6_tnl_parm parms6;
129e437f3b6SPetr Machata 
130e437f3b6SPetr Machata 	switch (proto) {
131e437f3b6SPetr Machata 	case MLXSW_SP_L3_PROTO_IPV4:
132e437f3b6SPetr Machata 		parms4 = mlxsw_sp_ipip_netdev_parms4(ol_dev);
133aa6fd8f1SAmit Cohen 		return mlxsw_sp_ipip_parms4_daddr(&parms4);
134e437f3b6SPetr Machata 	case MLXSW_SP_L3_PROTO_IPV6:
1358897207cSPetr Machata 		parms6 = mlxsw_sp_ipip_netdev_parms6(ol_dev);
136aa6fd8f1SAmit Cohen 		return mlxsw_sp_ipip_parms6_daddr(&parms6);
137e437f3b6SPetr Machata 	}
138e437f3b6SPetr Machata 
139e437f3b6SPetr Machata 	WARN_ON(1);
140e437f3b6SPetr Machata 	return (union mlxsw_sp_l3addr) {0};
141474f0ff6SPetr Machata }
142474f0ff6SPetr Machata 
mlxsw_sp_l3addr_is_zero(union mlxsw_sp_l3addr addr)1437e58a6c6SPetr Machata bool mlxsw_sp_l3addr_is_zero(union mlxsw_sp_l3addr addr)
1447e58a6c6SPetr Machata {
1457e58a6c6SPetr Machata 	union mlxsw_sp_l3addr naddr = {0};
1467e58a6c6SPetr Machata 
1477e58a6c6SPetr Machata 	return !memcmp(&addr, &naddr, sizeof(naddr));
1487e58a6c6SPetr Machata }
1497e58a6c6SPetr Machata 
15080ef2abcSAmit Cohen static struct mlxsw_sp_ipip_parms
mlxsw_sp_ipip_netdev_parms_init_gre4(const struct net_device * ol_dev)15180ef2abcSAmit Cohen mlxsw_sp_ipip_netdev_parms_init_gre4(const struct net_device *ol_dev)
15280ef2abcSAmit Cohen {
15380ef2abcSAmit Cohen 	struct ip_tunnel_parm parms = mlxsw_sp_ipip_netdev_parms4(ol_dev);
15480ef2abcSAmit Cohen 
15580ef2abcSAmit Cohen 	return (struct mlxsw_sp_ipip_parms) {
15680ef2abcSAmit Cohen 		.proto = MLXSW_SP_L3_PROTO_IPV4,
15780ef2abcSAmit Cohen 		.saddr = mlxsw_sp_ipip_parms4_saddr(&parms),
15880ef2abcSAmit Cohen 		.daddr = mlxsw_sp_ipip_parms4_daddr(&parms),
15980ef2abcSAmit Cohen 		.link = parms.link,
16080ef2abcSAmit Cohen 		.ikey = mlxsw_sp_ipip_parms4_ikey(&parms),
16180ef2abcSAmit Cohen 		.okey = mlxsw_sp_ipip_parms4_okey(&parms),
16280ef2abcSAmit Cohen 	};
16380ef2abcSAmit Cohen }
16480ef2abcSAmit Cohen 
165ee954d1aSPetr Machata static int
mlxsw_sp_ipip_nexthop_update_gre4(struct mlxsw_sp * mlxsw_sp,u32 adj_index,struct mlxsw_sp_ipip_entry * ipip_entry,bool force,char * ratr_pl)166ee954d1aSPetr Machata mlxsw_sp_ipip_nexthop_update_gre4(struct mlxsw_sp *mlxsw_sp, u32 adj_index,
16762b67ff3SIdo Schimmel 				  struct mlxsw_sp_ipip_entry *ipip_entry,
168197fdfd1SIdo Schimmel 				  bool force, char *ratr_pl)
169ee954d1aSPetr Machata {
170ee954d1aSPetr Machata 	u16 rif_index = mlxsw_sp_ipip_lb_rif_index(ipip_entry->ol_lb);
171ee954d1aSPetr Machata 	__be32 daddr4 = mlxsw_sp_ipip_netdev_daddr4(ipip_entry->ol_dev);
17262b67ff3SIdo Schimmel 	enum mlxsw_reg_ratr_op op;
173ee954d1aSPetr Machata 
17462b67ff3SIdo Schimmel 	op = force ? MLXSW_REG_RATR_OP_WRITE_WRITE_ENTRY :
17562b67ff3SIdo Schimmel 		     MLXSW_REG_RATR_OP_WRITE_WRITE_ENTRY_ON_ACTIVITY;
17662b67ff3SIdo Schimmel 	mlxsw_reg_ratr_pack(ratr_pl, op, true, MLXSW_REG_RATR_TYPE_IPIP,
177ee954d1aSPetr Machata 			    adj_index, rif_index);
178ee954d1aSPetr Machata 	mlxsw_reg_ratr_ipip4_entry_pack(ratr_pl, be32_to_cpu(daddr4));
179ee954d1aSPetr Machata 
180ee954d1aSPetr Machata 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ratr), ratr_pl);
181ee954d1aSPetr Machata }
182ee954d1aSPetr Machata 
183ee954d1aSPetr Machata static int
mlxsw_sp_ipip_decap_config_gre4(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry,u32 tunnel_index)184acde33bfSJiri Pirko mlxsw_sp_ipip_decap_config_gre4(struct mlxsw_sp *mlxsw_sp,
185acde33bfSJiri Pirko 				struct mlxsw_sp_ipip_entry *ipip_entry,
186acde33bfSJiri Pirko 				u32 tunnel_index)
187ee954d1aSPetr Machata {
188ee954d1aSPetr Machata 	u16 rif_index = mlxsw_sp_ipip_lb_rif_index(ipip_entry->ol_lb);
189311596f5SNir Dotan 	u16 ul_rif_id = mlxsw_sp_ipip_lb_ul_rif_id(ipip_entry->ol_lb);
190ee954d1aSPetr Machata 	char rtdp_pl[MLXSW_REG_RTDP_LEN];
191e437f3b6SPetr Machata 	struct ip_tunnel_parm parms;
192ee954d1aSPetr Machata 	unsigned int type_check;
193e437f3b6SPetr Machata 	bool has_ikey;
194ee954d1aSPetr Machata 	u32 daddr4;
195e437f3b6SPetr Machata 	u32 ikey;
196e437f3b6SPetr Machata 
197e437f3b6SPetr Machata 	parms = mlxsw_sp_ipip_netdev_parms4(ipip_entry->ol_dev);
198aa6fd8f1SAmit Cohen 	has_ikey = mlxsw_sp_ipip_parms4_has_ikey(&parms);
199aa6fd8f1SAmit Cohen 	ikey = mlxsw_sp_ipip_parms4_ikey(&parms);
200ee954d1aSPetr Machata 
201ee954d1aSPetr Machata 	mlxsw_reg_rtdp_pack(rtdp_pl, MLXSW_REG_RTDP_TYPE_IPIP, tunnel_index);
202311596f5SNir Dotan 	mlxsw_reg_rtdp_egress_router_interface_set(rtdp_pl, ul_rif_id);
203ee954d1aSPetr Machata 
204ee954d1aSPetr Machata 	type_check = has_ikey ?
205ee954d1aSPetr Machata 		MLXSW_REG_RTDP_IPIP_TYPE_CHECK_ALLOW_GRE_KEY :
206ee954d1aSPetr Machata 		MLXSW_REG_RTDP_IPIP_TYPE_CHECK_ALLOW_GRE;
207ee954d1aSPetr Machata 
208ee954d1aSPetr Machata 	/* Linux demuxes tunnels based on packet SIP (which must match tunnel
209ee954d1aSPetr Machata 	 * remote IP). Thus configure decap so that it filters out packets that
210ee954d1aSPetr Machata 	 * are not IPv4 or have the wrong SIP. IPIP_DECAP_ERROR trap is
211ee954d1aSPetr Machata 	 * generated for packets that fail this criterion. Linux then handles
212ee954d1aSPetr Machata 	 * such packets in slow path and generates ICMP destination unreachable.
213ee954d1aSPetr Machata 	 */
214ee954d1aSPetr Machata 	daddr4 = be32_to_cpu(mlxsw_sp_ipip_netdev_daddr4(ipip_entry->ol_dev));
215ee954d1aSPetr Machata 	mlxsw_reg_rtdp_ipip4_pack(rtdp_pl, rif_index,
216ee954d1aSPetr Machata 				  MLXSW_REG_RTDP_IPIP_SIP_CHECK_FILTER_IPV4,
217ee954d1aSPetr Machata 				  type_check, has_ikey, daddr4, ikey);
218ee954d1aSPetr Machata 
219ee954d1aSPetr Machata 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rtdp), rtdp_pl);
220ee954d1aSPetr Machata }
221ee954d1aSPetr Machata 
mlxsw_sp_ipip_tunnel_complete(enum mlxsw_sp_l3proto proto,const struct net_device * ol_dev)222ee954d1aSPetr Machata static bool mlxsw_sp_ipip_tunnel_complete(enum mlxsw_sp_l3proto proto,
223ee954d1aSPetr Machata 					  const struct net_device *ol_dev)
224ee954d1aSPetr Machata {
225ee954d1aSPetr Machata 	union mlxsw_sp_l3addr saddr = mlxsw_sp_ipip_netdev_saddr(proto, ol_dev);
226ee954d1aSPetr Machata 	union mlxsw_sp_l3addr daddr = mlxsw_sp_ipip_netdev_daddr(proto, ol_dev);
227ee954d1aSPetr Machata 
228ee954d1aSPetr Machata 	/* Tunnels with unset local or remote address are valid in Linux and
229ee954d1aSPetr Machata 	 * used for lightweight tunnels (LWT) and Non-Broadcast Multi-Access
230ee954d1aSPetr Machata 	 * (NBMA) tunnels. In principle these can be offloaded, but the driver
231ee954d1aSPetr Machata 	 * currently doesn't support this. So punt.
232ee954d1aSPetr Machata 	 */
2337e58a6c6SPetr Machata 	return !mlxsw_sp_l3addr_is_zero(saddr) &&
2347e58a6c6SPetr Machata 	       !mlxsw_sp_l3addr_is_zero(daddr);
235ee954d1aSPetr Machata }
236ee954d1aSPetr Machata 
mlxsw_sp_ipip_can_offload_gre4(const struct mlxsw_sp * mlxsw_sp,const struct net_device * ol_dev)237ee954d1aSPetr Machata static bool mlxsw_sp_ipip_can_offload_gre4(const struct mlxsw_sp *mlxsw_sp,
2387ba7bc55SIdo Schimmel 					   const struct net_device *ol_dev)
239ee954d1aSPetr Machata {
240ee954d1aSPetr Machata 	struct ip_tunnel *tunnel = netdev_priv(ol_dev);
241ee954d1aSPetr Machata 	__be16 okflags = TUNNEL_KEY; /* We can't offload any other features. */
242ee954d1aSPetr Machata 	bool inherit_ttl = tunnel->parms.iph.ttl == 0;
243ee954d1aSPetr Machata 	bool inherit_tos = tunnel->parms.iph.tos & 0x1;
244ee954d1aSPetr Machata 
245ee954d1aSPetr Machata 	return (tunnel->parms.i_flags & ~okflags) == 0 &&
246ee954d1aSPetr Machata 	       (tunnel->parms.o_flags & ~okflags) == 0 &&
247ee954d1aSPetr Machata 	       inherit_ttl && inherit_tos &&
248ee954d1aSPetr Machata 	       mlxsw_sp_ipip_tunnel_complete(MLXSW_SP_L3_PROTO_IPV4, ol_dev);
249ee954d1aSPetr Machata }
250ee954d1aSPetr Machata 
251ee954d1aSPetr Machata static struct mlxsw_sp_rif_ipip_lb_config
mlxsw_sp_ipip_ol_loopback_config_gre4(struct mlxsw_sp * mlxsw_sp,const struct net_device * ol_dev)252ee954d1aSPetr Machata mlxsw_sp_ipip_ol_loopback_config_gre4(struct mlxsw_sp *mlxsw_sp,
253ee954d1aSPetr Machata 				      const struct net_device *ol_dev)
254ee954d1aSPetr Machata {
255e437f3b6SPetr Machata 	struct ip_tunnel_parm parms = mlxsw_sp_ipip_netdev_parms4(ol_dev);
256ee954d1aSPetr Machata 	enum mlxsw_reg_ritr_loopback_ipip_type lb_ipipt;
257ee954d1aSPetr Machata 
258aa6fd8f1SAmit Cohen 	lb_ipipt = mlxsw_sp_ipip_parms4_has_okey(&parms) ?
259ee954d1aSPetr Machata 		MLXSW_REG_RITR_LOOPBACK_IPIP_TYPE_IP_IN_GRE_KEY_IN_IP :
260ee954d1aSPetr Machata 		MLXSW_REG_RITR_LOOPBACK_IPIP_TYPE_IP_IN_GRE_IN_IP;
261ee954d1aSPetr Machata 	return (struct mlxsw_sp_rif_ipip_lb_config){
262ee954d1aSPetr Machata 		.lb_ipipt = lb_ipipt,
263aa6fd8f1SAmit Cohen 		.okey = mlxsw_sp_ipip_parms4_okey(&parms),
264ee954d1aSPetr Machata 		.ul_protocol = MLXSW_SP_L3_PROTO_IPV4,
265ee954d1aSPetr Machata 		.saddr = mlxsw_sp_ipip_netdev_saddr(MLXSW_SP_L3_PROTO_IPV4,
266ee954d1aSPetr Machata 						    ol_dev),
267ee954d1aSPetr Machata 	};
268ee954d1aSPetr Machata }
269ee954d1aSPetr Machata 
2704cf04f3fSPetr Machata static int
mlxsw_sp_ipip_ol_netdev_change_gre(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry,const struct mlxsw_sp_ipip_parms * new_parms,struct netlink_ext_ack * extack)27180ef2abcSAmit Cohen mlxsw_sp_ipip_ol_netdev_change_gre(struct mlxsw_sp *mlxsw_sp,
2724cf04f3fSPetr Machata 				   struct mlxsw_sp_ipip_entry *ipip_entry,
27380ef2abcSAmit Cohen 				   const struct mlxsw_sp_ipip_parms *new_parms,
2744cf04f3fSPetr Machata 				   struct netlink_ext_ack *extack)
2754cf04f3fSPetr Machata {
27680ef2abcSAmit Cohen 	const struct mlxsw_sp_ipip_parms *old_parms = &ipip_entry->parms;
2774cf04f3fSPetr Machata 	bool update_tunnel = false;
2784cf04f3fSPetr Machata 	bool update_decap = false;
2794cf04f3fSPetr Machata 	bool update_nhs = false;
2804cf04f3fSPetr Machata 	int err = 0;
2814cf04f3fSPetr Machata 
28280ef2abcSAmit Cohen 	if (!mlxsw_sp_l3addr_eq(&new_parms->saddr, &old_parms->saddr)) {
2834cf04f3fSPetr Machata 		u16 ul_tb_id = mlxsw_sp_ipip_dev_ul_tb_id(ipip_entry->ol_dev);
2844cf04f3fSPetr Machata 
2854cf04f3fSPetr Machata 		/* Since the local address has changed, if there is another
2864cf04f3fSPetr Machata 		 * tunnel with a matching saddr, both need to be demoted.
2874cf04f3fSPetr Machata 		 */
2884cf04f3fSPetr Machata 		if (mlxsw_sp_ipip_demote_tunnel_by_saddr(mlxsw_sp,
28980ef2abcSAmit Cohen 							 new_parms->proto,
29080ef2abcSAmit Cohen 							 new_parms->saddr,
29180ef2abcSAmit Cohen 							 ul_tb_id,
2924cf04f3fSPetr Machata 							 ipip_entry)) {
2934cf04f3fSPetr Machata 			mlxsw_sp_ipip_entry_demote_tunnel(mlxsw_sp, ipip_entry);
2944cf04f3fSPetr Machata 			return 0;
2954cf04f3fSPetr Machata 		}
2964cf04f3fSPetr Machata 
2974cf04f3fSPetr Machata 		update_tunnel = true;
29880ef2abcSAmit Cohen 	} else if (old_parms->okey != new_parms->okey ||
29980ef2abcSAmit Cohen 		   old_parms->link != new_parms->link) {
3004cf04f3fSPetr Machata 		update_tunnel = true;
30180ef2abcSAmit Cohen 	} else if (!mlxsw_sp_l3addr_eq(&new_parms->daddr, &old_parms->daddr)) {
3024cf04f3fSPetr Machata 		update_nhs = true;
30380ef2abcSAmit Cohen 	} else if (old_parms->ikey != new_parms->ikey) {
3044cf04f3fSPetr Machata 		update_decap = true;
3054cf04f3fSPetr Machata 	}
3064cf04f3fSPetr Machata 
3074cf04f3fSPetr Machata 	if (update_tunnel)
3084cf04f3fSPetr Machata 		err = __mlxsw_sp_ipip_entry_update_tunnel(mlxsw_sp, ipip_entry,
3094cf04f3fSPetr Machata 							  true, true, true,
3104cf04f3fSPetr Machata 							  extack);
3114cf04f3fSPetr Machata 	else if (update_nhs)
3124cf04f3fSPetr Machata 		err = __mlxsw_sp_ipip_entry_update_tunnel(mlxsw_sp, ipip_entry,
3134cf04f3fSPetr Machata 							  false, false, true,
3144cf04f3fSPetr Machata 							  extack);
3154cf04f3fSPetr Machata 	else if (update_decap)
3164cf04f3fSPetr Machata 		err = __mlxsw_sp_ipip_entry_update_tunnel(mlxsw_sp, ipip_entry,
3174cf04f3fSPetr Machata 							  false, false, false,
3184cf04f3fSPetr Machata 							  extack);
31980ef2abcSAmit Cohen 	if (err)
3204cf04f3fSPetr Machata 		return err;
32180ef2abcSAmit Cohen 
32280ef2abcSAmit Cohen 	ipip_entry->parms = *new_parms;
32380ef2abcSAmit Cohen 	return 0;
32480ef2abcSAmit Cohen }
32580ef2abcSAmit Cohen 
32680ef2abcSAmit Cohen static int
mlxsw_sp_ipip_ol_netdev_change_gre4(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry,struct netlink_ext_ack * extack)32780ef2abcSAmit Cohen mlxsw_sp_ipip_ol_netdev_change_gre4(struct mlxsw_sp *mlxsw_sp,
32880ef2abcSAmit Cohen 				    struct mlxsw_sp_ipip_entry *ipip_entry,
32980ef2abcSAmit Cohen 				    struct netlink_ext_ack *extack)
33080ef2abcSAmit Cohen {
33180ef2abcSAmit Cohen 	struct mlxsw_sp_ipip_parms new_parms;
33280ef2abcSAmit Cohen 
33380ef2abcSAmit Cohen 	new_parms = mlxsw_sp_ipip_netdev_parms_init_gre4(ipip_entry->ol_dev);
33480ef2abcSAmit Cohen 	return mlxsw_sp_ipip_ol_netdev_change_gre(mlxsw_sp, ipip_entry,
33580ef2abcSAmit Cohen 						  &new_parms, extack);
3364cf04f3fSPetr Machata }
3374cf04f3fSPetr Machata 
338ba1c7132SAmit Cohen static int
mlxsw_sp_ipip_rem_addr_set_gre4(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry)339ba1c7132SAmit Cohen mlxsw_sp_ipip_rem_addr_set_gre4(struct mlxsw_sp *mlxsw_sp,
340ba1c7132SAmit Cohen 				struct mlxsw_sp_ipip_entry *ipip_entry)
341ba1c7132SAmit Cohen {
342ba1c7132SAmit Cohen 	return 0;
343ba1c7132SAmit Cohen }
344ba1c7132SAmit Cohen 
345ba1c7132SAmit Cohen static void
mlxsw_sp_ipip_rem_addr_unset_gre4(struct mlxsw_sp * mlxsw_sp,const struct mlxsw_sp_ipip_entry * ipip_entry)346ba1c7132SAmit Cohen mlxsw_sp_ipip_rem_addr_unset_gre4(struct mlxsw_sp *mlxsw_sp,
347ba1c7132SAmit Cohen 				  const struct mlxsw_sp_ipip_entry *ipip_entry)
348ba1c7132SAmit Cohen {
349ba1c7132SAmit Cohen }
350ba1c7132SAmit Cohen 
351ee954d1aSPetr Machata static const struct mlxsw_sp_ipip_ops mlxsw_sp_ipip_gre4_ops = {
352ee954d1aSPetr Machata 	.dev_type = ARPHRD_IPGRE,
353ee954d1aSPetr Machata 	.ul_proto = MLXSW_SP_L3_PROTO_IPV4,
3548d4f1046SAmit Cohen 	.inc_parsing_depth = false,
35580ef2abcSAmit Cohen 	.parms_init = mlxsw_sp_ipip_netdev_parms_init_gre4,
356ee954d1aSPetr Machata 	.nexthop_update = mlxsw_sp_ipip_nexthop_update_gre4,
357acde33bfSJiri Pirko 	.decap_config = mlxsw_sp_ipip_decap_config_gre4,
358ee954d1aSPetr Machata 	.can_offload = mlxsw_sp_ipip_can_offload_gre4,
359ee954d1aSPetr Machata 	.ol_loopback_config = mlxsw_sp_ipip_ol_loopback_config_gre4,
3604cf04f3fSPetr Machata 	.ol_netdev_change = mlxsw_sp_ipip_ol_netdev_change_gre4,
361ba1c7132SAmit Cohen 	.rem_ip_addr_set = mlxsw_sp_ipip_rem_addr_set_gre4,
362ba1c7132SAmit Cohen 	.rem_ip_addr_unset = mlxsw_sp_ipip_rem_addr_unset_gre4,
363ee954d1aSPetr Machata };
364ee954d1aSPetr Machata 
365713e8502SAmit Cohen static struct mlxsw_sp_ipip_parms
mlxsw_sp_ipip_netdev_parms_init_gre6(const struct net_device * ol_dev)366ab30e4d4SIdo Schimmel mlxsw_sp_ipip_netdev_parms_init_gre6(const struct net_device *ol_dev)
367ba1c7132SAmit Cohen {
368ba1c7132SAmit Cohen 	struct __ip6_tnl_parm parms = mlxsw_sp_ipip_netdev_parms6(ol_dev);
369ba1c7132SAmit Cohen 
370ba1c7132SAmit Cohen 	return (struct mlxsw_sp_ipip_parms) {
371ba1c7132SAmit Cohen 		.proto = MLXSW_SP_L3_PROTO_IPV6,
372ba1c7132SAmit Cohen 		.saddr = mlxsw_sp_ipip_parms6_saddr(&parms),
373ba1c7132SAmit Cohen 		.daddr = mlxsw_sp_ipip_parms6_daddr(&parms),
374ba1c7132SAmit Cohen 		.link = parms.link,
375ba1c7132SAmit Cohen 		.ikey = mlxsw_sp_ipip_parms6_ikey(&parms),
376ba1c7132SAmit Cohen 		.okey = mlxsw_sp_ipip_parms6_okey(&parms),
377ba1c7132SAmit Cohen 	};
378ba1c7132SAmit Cohen }
379ba1c7132SAmit Cohen 
380ba1c7132SAmit Cohen static int
mlxsw_sp_ipip_nexthop_update_gre6(struct mlxsw_sp * mlxsw_sp,u32 adj_index,struct mlxsw_sp_ipip_entry * ipip_entry,bool force,char * ratr_pl)381ab30e4d4SIdo Schimmel mlxsw_sp_ipip_nexthop_update_gre6(struct mlxsw_sp *mlxsw_sp, u32 adj_index,
382ba1c7132SAmit Cohen 				  struct mlxsw_sp_ipip_entry *ipip_entry,
383ba1c7132SAmit Cohen 				  bool force, char *ratr_pl)
384ba1c7132SAmit Cohen {
385ba1c7132SAmit Cohen 	u16 rif_index = mlxsw_sp_ipip_lb_rif_index(ipip_entry->ol_lb);
386ba1c7132SAmit Cohen 	enum mlxsw_reg_ratr_op op;
387ba1c7132SAmit Cohen 
388ba1c7132SAmit Cohen 	op = force ? MLXSW_REG_RATR_OP_WRITE_WRITE_ENTRY :
389ba1c7132SAmit Cohen 		     MLXSW_REG_RATR_OP_WRITE_WRITE_ENTRY_ON_ACTIVITY;
390ba1c7132SAmit Cohen 	mlxsw_reg_ratr_pack(ratr_pl, op, true, MLXSW_REG_RATR_TYPE_IPIP,
391ba1c7132SAmit Cohen 			    adj_index, rif_index);
392ba1c7132SAmit Cohen 	mlxsw_reg_ratr_ipip6_entry_pack(ratr_pl,
393ba1c7132SAmit Cohen 					ipip_entry->dip_kvdl_index);
394ba1c7132SAmit Cohen 
395ba1c7132SAmit Cohen 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(ratr), ratr_pl);
396ba1c7132SAmit Cohen }
397ba1c7132SAmit Cohen 
398ba1c7132SAmit Cohen static int
mlxsw_sp_ipip_decap_config_gre6(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry,u32 tunnel_index)399ab30e4d4SIdo Schimmel mlxsw_sp_ipip_decap_config_gre6(struct mlxsw_sp *mlxsw_sp,
400ba1c7132SAmit Cohen 				struct mlxsw_sp_ipip_entry *ipip_entry,
401ba1c7132SAmit Cohen 				u32 tunnel_index)
402ba1c7132SAmit Cohen {
403ba1c7132SAmit Cohen 	u16 rif_index = mlxsw_sp_ipip_lb_rif_index(ipip_entry->ol_lb);
404ba1c7132SAmit Cohen 	u16 ul_rif_id = mlxsw_sp_ipip_lb_ul_rif_id(ipip_entry->ol_lb);
405ba1c7132SAmit Cohen 	char rtdp_pl[MLXSW_REG_RTDP_LEN];
406ba1c7132SAmit Cohen 	struct __ip6_tnl_parm parms;
407ba1c7132SAmit Cohen 	unsigned int type_check;
408ba1c7132SAmit Cohen 	bool has_ikey;
409ba1c7132SAmit Cohen 	u32 ikey;
410ba1c7132SAmit Cohen 
411ba1c7132SAmit Cohen 	parms = mlxsw_sp_ipip_netdev_parms6(ipip_entry->ol_dev);
412ba1c7132SAmit Cohen 	has_ikey = mlxsw_sp_ipip_parms6_has_ikey(&parms);
413ba1c7132SAmit Cohen 	ikey = mlxsw_sp_ipip_parms6_ikey(&parms);
414ba1c7132SAmit Cohen 
415ba1c7132SAmit Cohen 	mlxsw_reg_rtdp_pack(rtdp_pl, MLXSW_REG_RTDP_TYPE_IPIP, tunnel_index);
416ba1c7132SAmit Cohen 	mlxsw_reg_rtdp_egress_router_interface_set(rtdp_pl, ul_rif_id);
417ba1c7132SAmit Cohen 
418ba1c7132SAmit Cohen 	type_check = has_ikey ?
419ba1c7132SAmit Cohen 		MLXSW_REG_RTDP_IPIP_TYPE_CHECK_ALLOW_GRE_KEY :
420ba1c7132SAmit Cohen 		MLXSW_REG_RTDP_IPIP_TYPE_CHECK_ALLOW_GRE;
421ba1c7132SAmit Cohen 
422ba1c7132SAmit Cohen 	/* Linux demuxes tunnels based on packet SIP (which must match tunnel
423ba1c7132SAmit Cohen 	 * remote IP). Thus configure decap so that it filters out packets that
424ba1c7132SAmit Cohen 	 * are not IPv6 or have the wrong SIP. IPIP_DECAP_ERROR trap is
425ba1c7132SAmit Cohen 	 * generated for packets that fail this criterion. Linux then handles
426ba1c7132SAmit Cohen 	 * such packets in slow path and generates ICMP destination unreachable.
427ba1c7132SAmit Cohen 	 */
428ba1c7132SAmit Cohen 	mlxsw_reg_rtdp_ipip6_pack(rtdp_pl, rif_index,
429ba1c7132SAmit Cohen 				  MLXSW_REG_RTDP_IPIP_SIP_CHECK_FILTER_IPV6,
430ba1c7132SAmit Cohen 				  type_check, has_ikey,
431ba1c7132SAmit Cohen 				  ipip_entry->dip_kvdl_index, ikey);
432ba1c7132SAmit Cohen 
433ba1c7132SAmit Cohen 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rtdp), rtdp_pl);
434ba1c7132SAmit Cohen }
435ba1c7132SAmit Cohen 
mlxsw_sp_ipip_can_offload_gre6(const struct mlxsw_sp * mlxsw_sp,const struct net_device * ol_dev)436ab30e4d4SIdo Schimmel static bool mlxsw_sp_ipip_can_offload_gre6(const struct mlxsw_sp *mlxsw_sp,
437ba1c7132SAmit Cohen 					   const struct net_device *ol_dev)
438ba1c7132SAmit Cohen {
439ba1c7132SAmit Cohen 	struct __ip6_tnl_parm tparm = mlxsw_sp_ipip_netdev_parms6(ol_dev);
440ba1c7132SAmit Cohen 	bool inherit_tos = tparm.flags & IP6_TNL_F_USE_ORIG_TCLASS;
441ba1c7132SAmit Cohen 	bool inherit_ttl = tparm.hop_limit == 0;
442ba1c7132SAmit Cohen 	__be16 okflags = TUNNEL_KEY; /* We can't offload any other features. */
443ba1c7132SAmit Cohen 
444ba1c7132SAmit Cohen 	return (tparm.i_flags & ~okflags) == 0 &&
445ba1c7132SAmit Cohen 	       (tparm.o_flags & ~okflags) == 0 &&
446ba1c7132SAmit Cohen 	       inherit_ttl && inherit_tos &&
447ba1c7132SAmit Cohen 	       mlxsw_sp_ipip_tunnel_complete(MLXSW_SP_L3_PROTO_IPV6, ol_dev);
448ba1c7132SAmit Cohen }
449ba1c7132SAmit Cohen 
450ba1c7132SAmit Cohen static struct mlxsw_sp_rif_ipip_lb_config
mlxsw_sp_ipip_ol_loopback_config_gre6(struct mlxsw_sp * mlxsw_sp,const struct net_device * ol_dev)451ab30e4d4SIdo Schimmel mlxsw_sp_ipip_ol_loopback_config_gre6(struct mlxsw_sp *mlxsw_sp,
452ba1c7132SAmit Cohen 				      const struct net_device *ol_dev)
453ba1c7132SAmit Cohen {
454ba1c7132SAmit Cohen 	struct __ip6_tnl_parm parms = mlxsw_sp_ipip_netdev_parms6(ol_dev);
455ba1c7132SAmit Cohen 	enum mlxsw_reg_ritr_loopback_ipip_type lb_ipipt;
456ba1c7132SAmit Cohen 
457ba1c7132SAmit Cohen 	lb_ipipt = mlxsw_sp_ipip_parms6_has_okey(&parms) ?
458ba1c7132SAmit Cohen 		MLXSW_REG_RITR_LOOPBACK_IPIP_TYPE_IP_IN_GRE_KEY_IN_IP :
459ba1c7132SAmit Cohen 		MLXSW_REG_RITR_LOOPBACK_IPIP_TYPE_IP_IN_GRE_IN_IP;
460ba1c7132SAmit Cohen 	return (struct mlxsw_sp_rif_ipip_lb_config){
461ba1c7132SAmit Cohen 		.lb_ipipt = lb_ipipt,
462ba1c7132SAmit Cohen 		.okey = mlxsw_sp_ipip_parms6_okey(&parms),
463ba1c7132SAmit Cohen 		.ul_protocol = MLXSW_SP_L3_PROTO_IPV6,
464ba1c7132SAmit Cohen 		.saddr = mlxsw_sp_ipip_netdev_saddr(MLXSW_SP_L3_PROTO_IPV6,
465ba1c7132SAmit Cohen 						    ol_dev),
466ba1c7132SAmit Cohen 	};
467ba1c7132SAmit Cohen }
468ba1c7132SAmit Cohen 
469ba1c7132SAmit Cohen static int
mlxsw_sp_ipip_ol_netdev_change_gre6(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry,struct netlink_ext_ack * extack)470ab30e4d4SIdo Schimmel mlxsw_sp_ipip_ol_netdev_change_gre6(struct mlxsw_sp *mlxsw_sp,
471ba1c7132SAmit Cohen 				    struct mlxsw_sp_ipip_entry *ipip_entry,
472ba1c7132SAmit Cohen 				    struct netlink_ext_ack *extack)
473ba1c7132SAmit Cohen {
474*31384aa2SIdo Schimmel 	u32 new_kvdl_index, old_kvdl_index = ipip_entry->dip_kvdl_index;
475*31384aa2SIdo Schimmel 	struct in6_addr old_addr6 = ipip_entry->parms.daddr.addr6;
476ba1c7132SAmit Cohen 	struct mlxsw_sp_ipip_parms new_parms;
477*31384aa2SIdo Schimmel 	int err;
478ba1c7132SAmit Cohen 
479ab30e4d4SIdo Schimmel 	new_parms = mlxsw_sp_ipip_netdev_parms_init_gre6(ipip_entry->ol_dev);
480*31384aa2SIdo Schimmel 
481*31384aa2SIdo Schimmel 	err = mlxsw_sp_ipv6_addr_kvdl_index_get(mlxsw_sp,
482*31384aa2SIdo Schimmel 						&new_parms.daddr.addr6,
483*31384aa2SIdo Schimmel 						&new_kvdl_index);
484*31384aa2SIdo Schimmel 	if (err)
485*31384aa2SIdo Schimmel 		return err;
486*31384aa2SIdo Schimmel 	ipip_entry->dip_kvdl_index = new_kvdl_index;
487*31384aa2SIdo Schimmel 
488*31384aa2SIdo Schimmel 	err = mlxsw_sp_ipip_ol_netdev_change_gre(mlxsw_sp, ipip_entry,
489ba1c7132SAmit Cohen 						 &new_parms, extack);
490*31384aa2SIdo Schimmel 	if (err)
491*31384aa2SIdo Schimmel 		goto err_change_gre;
492*31384aa2SIdo Schimmel 
493*31384aa2SIdo Schimmel 	mlxsw_sp_ipv6_addr_put(mlxsw_sp, &old_addr6);
494*31384aa2SIdo Schimmel 
495*31384aa2SIdo Schimmel 	return 0;
496*31384aa2SIdo Schimmel 
497*31384aa2SIdo Schimmel err_change_gre:
498*31384aa2SIdo Schimmel 	ipip_entry->dip_kvdl_index = old_kvdl_index;
499*31384aa2SIdo Schimmel 	mlxsw_sp_ipv6_addr_put(mlxsw_sp, &new_parms.daddr.addr6);
500*31384aa2SIdo Schimmel 	return err;
501ba1c7132SAmit Cohen }
502ba1c7132SAmit Cohen 
503ba1c7132SAmit Cohen static int
mlxsw_sp_ipip_rem_addr_set_gre6(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_ipip_entry * ipip_entry)504ab30e4d4SIdo Schimmel mlxsw_sp_ipip_rem_addr_set_gre6(struct mlxsw_sp *mlxsw_sp,
505ba1c7132SAmit Cohen 				struct mlxsw_sp_ipip_entry *ipip_entry)
506ba1c7132SAmit Cohen {
507810c2f0aSAmit Cohen 	return mlxsw_sp_ipv6_addr_kvdl_index_get(mlxsw_sp,
508810c2f0aSAmit Cohen 						 &ipip_entry->parms.daddr.addr6,
509cf429115SAmit Cohen 						 &ipip_entry->dip_kvdl_index);
510ba1c7132SAmit Cohen }
511ba1c7132SAmit Cohen 
512ba1c7132SAmit Cohen static void
mlxsw_sp_ipip_rem_addr_unset_gre6(struct mlxsw_sp * mlxsw_sp,const struct mlxsw_sp_ipip_entry * ipip_entry)513ab30e4d4SIdo Schimmel mlxsw_sp_ipip_rem_addr_unset_gre6(struct mlxsw_sp *mlxsw_sp,
514ba1c7132SAmit Cohen 				  const struct mlxsw_sp_ipip_entry *ipip_entry)
515ba1c7132SAmit Cohen {
516810c2f0aSAmit Cohen 	mlxsw_sp_ipv6_addr_put(mlxsw_sp, &ipip_entry->parms.daddr.addr6);
517ba1c7132SAmit Cohen }
518ba1c7132SAmit Cohen 
519ab30e4d4SIdo Schimmel static const struct mlxsw_sp_ipip_ops mlxsw_sp1_ipip_gre6_ops = {
520ab30e4d4SIdo Schimmel 	.dev_type = ARPHRD_IP6GRE,
521ab30e4d4SIdo Schimmel 	.ul_proto = MLXSW_SP_L3_PROTO_IPV6,
522ab30e4d4SIdo Schimmel 	.inc_parsing_depth = true,
523ab30e4d4SIdo Schimmel 	.double_rif_entry = true,
5247ec53643SIdo Schimmel 	.parms_init = mlxsw_sp_ipip_netdev_parms_init_gre6,
5257ec53643SIdo Schimmel 	.nexthop_update = mlxsw_sp_ipip_nexthop_update_gre6,
5267ec53643SIdo Schimmel 	.decap_config = mlxsw_sp_ipip_decap_config_gre6,
5277ec53643SIdo Schimmel 	.can_offload = mlxsw_sp_ipip_can_offload_gre6,
5287ec53643SIdo Schimmel 	.ol_loopback_config = mlxsw_sp_ipip_ol_loopback_config_gre6,
5297ec53643SIdo Schimmel 	.ol_netdev_change = mlxsw_sp_ipip_ol_netdev_change_gre6,
5307ec53643SIdo Schimmel 	.rem_ip_addr_set = mlxsw_sp_ipip_rem_addr_set_gre6,
5317ec53643SIdo Schimmel 	.rem_ip_addr_unset = mlxsw_sp_ipip_rem_addr_unset_gre6,
532ab30e4d4SIdo Schimmel };
533ab30e4d4SIdo Schimmel 
534ab30e4d4SIdo Schimmel const struct mlxsw_sp_ipip_ops *mlxsw_sp1_ipip_ops_arr[] = {
535ab30e4d4SIdo Schimmel 	[MLXSW_SP_IPIP_TYPE_GRE4] = &mlxsw_sp_ipip_gre4_ops,
536ab30e4d4SIdo Schimmel 	[MLXSW_SP_IPIP_TYPE_GRE6] = &mlxsw_sp1_ipip_gre6_ops,
537ab30e4d4SIdo Schimmel };
538ab30e4d4SIdo Schimmel 
539ba1c7132SAmit Cohen static const struct mlxsw_sp_ipip_ops mlxsw_sp2_ipip_gre6_ops = {
540ba1c7132SAmit Cohen 	.dev_type = ARPHRD_IP6GRE,
541ba1c7132SAmit Cohen 	.ul_proto = MLXSW_SP_L3_PROTO_IPV6,
542ba1c7132SAmit Cohen 	.inc_parsing_depth = true,
543ab30e4d4SIdo Schimmel 	.parms_init = mlxsw_sp_ipip_netdev_parms_init_gre6,
544ab30e4d4SIdo Schimmel 	.nexthop_update = mlxsw_sp_ipip_nexthop_update_gre6,
545ab30e4d4SIdo Schimmel 	.decap_config = mlxsw_sp_ipip_decap_config_gre6,
546ab30e4d4SIdo Schimmel 	.can_offload = mlxsw_sp_ipip_can_offload_gre6,
547ab30e4d4SIdo Schimmel 	.ol_loopback_config = mlxsw_sp_ipip_ol_loopback_config_gre6,
548ab30e4d4SIdo Schimmel 	.ol_netdev_change = mlxsw_sp_ipip_ol_netdev_change_gre6,
549ab30e4d4SIdo Schimmel 	.rem_ip_addr_set = mlxsw_sp_ipip_rem_addr_set_gre6,
550ab30e4d4SIdo Schimmel 	.rem_ip_addr_unset = mlxsw_sp_ipip_rem_addr_unset_gre6,
551ba1c7132SAmit Cohen };
552ba1c7132SAmit Cohen 
553a82feba6SAmit Cohen const struct mlxsw_sp_ipip_ops *mlxsw_sp2_ipip_ops_arr[] = {
554ee954d1aSPetr Machata 	[MLXSW_SP_IPIP_TYPE_GRE4] = &mlxsw_sp_ipip_gre4_ops,
555ba1c7132SAmit Cohen 	[MLXSW_SP_IPIP_TYPE_GRE6] = &mlxsw_sp2_ipip_gre6_ops,
55638ebc0f4SPetr Machata };
5574a44ee67SAmit Cohen 
mlxsw_sp_ipip_ecn_encap_init_one(struct mlxsw_sp * mlxsw_sp,u8 inner_ecn,u8 outer_ecn)5584a44ee67SAmit Cohen static int mlxsw_sp_ipip_ecn_encap_init_one(struct mlxsw_sp *mlxsw_sp,
5594a44ee67SAmit Cohen 					    u8 inner_ecn, u8 outer_ecn)
5604a44ee67SAmit Cohen {
5614a44ee67SAmit Cohen 	char tieem_pl[MLXSW_REG_TIEEM_LEN];
5624a44ee67SAmit Cohen 
5634a44ee67SAmit Cohen 	mlxsw_reg_tieem_pack(tieem_pl, inner_ecn, outer_ecn);
5644a44ee67SAmit Cohen 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(tieem), tieem_pl);
5654a44ee67SAmit Cohen }
5664a44ee67SAmit Cohen 
mlxsw_sp_ipip_ecn_encap_init(struct mlxsw_sp * mlxsw_sp)5674a44ee67SAmit Cohen int mlxsw_sp_ipip_ecn_encap_init(struct mlxsw_sp *mlxsw_sp)
5684a44ee67SAmit Cohen {
5694a44ee67SAmit Cohen 	int i;
5704a44ee67SAmit Cohen 
5714a44ee67SAmit Cohen 	/* Iterate over inner ECN values */
5724a44ee67SAmit Cohen 	for (i = INET_ECN_NOT_ECT; i <= INET_ECN_CE; i++) {
5734a44ee67SAmit Cohen 		u8 outer_ecn = INET_ECN_encapsulate(0, i);
5744a44ee67SAmit Cohen 		int err;
5754a44ee67SAmit Cohen 
5764a44ee67SAmit Cohen 		err = mlxsw_sp_ipip_ecn_encap_init_one(mlxsw_sp, i, outer_ecn);
5774a44ee67SAmit Cohen 		if (err)
5784a44ee67SAmit Cohen 			return err;
5794a44ee67SAmit Cohen 	}
5804a44ee67SAmit Cohen 
5814a44ee67SAmit Cohen 	return 0;
5824a44ee67SAmit Cohen }
5834a44ee67SAmit Cohen 
mlxsw_sp_ipip_ecn_decap_init_one(struct mlxsw_sp * mlxsw_sp,u8 inner_ecn,u8 outer_ecn)5844a44ee67SAmit Cohen static int mlxsw_sp_ipip_ecn_decap_init_one(struct mlxsw_sp *mlxsw_sp,
5854a44ee67SAmit Cohen 					    u8 inner_ecn, u8 outer_ecn)
5864a44ee67SAmit Cohen {
5874a44ee67SAmit Cohen 	char tidem_pl[MLXSW_REG_TIDEM_LEN];
5884a44ee67SAmit Cohen 	u8 new_inner_ecn;
58966167c31SIdo Schimmel 	bool trap_en;
5904a44ee67SAmit Cohen 
59166167c31SIdo Schimmel 	new_inner_ecn = mlxsw_sp_tunnel_ecn_decap(outer_ecn, inner_ecn,
59266167c31SIdo Schimmel 						  &trap_en);
5934a44ee67SAmit Cohen 	mlxsw_reg_tidem_pack(tidem_pl, outer_ecn, inner_ecn, new_inner_ecn,
5944a44ee67SAmit Cohen 			     trap_en, trap_en ? MLXSW_TRAP_ID_DECAP_ECN0 : 0);
5954a44ee67SAmit Cohen 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(tidem), tidem_pl);
5964a44ee67SAmit Cohen }
5974a44ee67SAmit Cohen 
mlxsw_sp_ipip_ecn_decap_init(struct mlxsw_sp * mlxsw_sp)5984a44ee67SAmit Cohen int mlxsw_sp_ipip_ecn_decap_init(struct mlxsw_sp *mlxsw_sp)
5994a44ee67SAmit Cohen {
6004a44ee67SAmit Cohen 	int i, j, err;
6014a44ee67SAmit Cohen 
6024a44ee67SAmit Cohen 	/* Iterate over inner ECN values */
6034a44ee67SAmit Cohen 	for (i = INET_ECN_NOT_ECT; i <= INET_ECN_CE; i++) {
6044a44ee67SAmit Cohen 		/* Iterate over outer ECN values */
6054a44ee67SAmit Cohen 		for (j = INET_ECN_NOT_ECT; j <= INET_ECN_CE; j++) {
6064a44ee67SAmit Cohen 			err = mlxsw_sp_ipip_ecn_decap_init_one(mlxsw_sp, i, j);
6074a44ee67SAmit Cohen 			if (err)
6084a44ee67SAmit Cohen 				return err;
6094a44ee67SAmit Cohen 		}
6104a44ee67SAmit Cohen 	}
6114a44ee67SAmit Cohen 
6124a44ee67SAmit Cohen 	return 0;
6134a44ee67SAmit Cohen }
61459bf980dSAmit Cohen 
61559bf980dSAmit Cohen struct net_device *
mlxsw_sp_ipip_netdev_ul_dev_get(const struct net_device * ol_dev)61659bf980dSAmit Cohen mlxsw_sp_ipip_netdev_ul_dev_get(const struct net_device *ol_dev)
61759bf980dSAmit Cohen {
61859bf980dSAmit Cohen 	struct net *net = dev_net(ol_dev);
61959bf980dSAmit Cohen 	struct ip_tunnel *tun4;
620ba1c7132SAmit Cohen 	struct ip6_tnl *tun6;
62159bf980dSAmit Cohen 
62259bf980dSAmit Cohen 	switch (ol_dev->type) {
62359bf980dSAmit Cohen 	case ARPHRD_IPGRE:
62459bf980dSAmit Cohen 		tun4 = netdev_priv(ol_dev);
62559bf980dSAmit Cohen 		return dev_get_by_index_rcu(net, tun4->parms.link);
626ba1c7132SAmit Cohen 	case ARPHRD_IP6GRE:
627ba1c7132SAmit Cohen 		tun6 = netdev_priv(ol_dev);
628ba1c7132SAmit Cohen 		return dev_get_by_index_rcu(net, tun6->parms.link);
62959bf980dSAmit Cohen 	default:
63059bf980dSAmit Cohen 		return NULL;
63159bf980dSAmit Cohen 	}
63259bf980dSAmit Cohen }
633