18e99ea8dSJohannes Berg // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
28e99ea8dSJohannes Berg /*
3f276e20bSJohannes Berg * Copyright (C) 2012-2014, 2021-2022 Intel Corporation
48e99ea8dSJohannes Berg * Copyright (C) 2013-2014 Intel Mobile Communications GmbH
58e99ea8dSJohannes Berg * Copyright (C) 2015 Intel Deutschland GmbH
68e99ea8dSJohannes Berg */
7e705c121SKalle Valo #include <net/ipv6.h>
8e705c121SKalle Valo #include <net/addrconf.h>
9c97dab40SSara Sharon #include <linux/bitops.h>
10e705c121SKalle Valo #include "mvm.h"
11e705c121SKalle Valo
iwl_mvm_set_wowlan_qos_seq(struct iwl_mvm_sta * mvm_ap_sta,struct iwl_wowlan_config_cmd * cmd)12e705c121SKalle Valo void iwl_mvm_set_wowlan_qos_seq(struct iwl_mvm_sta *mvm_ap_sta,
13e705c121SKalle Valo struct iwl_wowlan_config_cmd *cmd)
14e705c121SKalle Valo {
15e705c121SKalle Valo int i;
16e705c121SKalle Valo
17e705c121SKalle Valo /*
18e705c121SKalle Valo * For QoS counters, we store the one to use next, so subtract 0x10
19e705c121SKalle Valo * since the uCode will add 0x10 *before* using the value while we
20e705c121SKalle Valo * increment after using the value (i.e. store the next value to use).
21e705c121SKalle Valo */
22e705c121SKalle Valo for (i = 0; i < IWL_MAX_TID_COUNT; i++) {
23e705c121SKalle Valo u16 seq = mvm_ap_sta->tid_data[i].seq_number;
24e705c121SKalle Valo seq -= 0x10;
25e705c121SKalle Valo cmd->qos_seq[i] = cpu_to_le16(seq);
26e705c121SKalle Valo }
27e705c121SKalle Valo }
28e705c121SKalle Valo
iwl_mvm_send_proto_offload(struct iwl_mvm * mvm,struct ieee80211_vif * vif,bool disable_offloading,bool offload_ns,u32 cmd_flags)29e705c121SKalle Valo int iwl_mvm_send_proto_offload(struct iwl_mvm *mvm,
30e705c121SKalle Valo struct ieee80211_vif *vif,
31e705c121SKalle Valo bool disable_offloading,
32c97dab40SSara Sharon bool offload_ns,
33e705c121SKalle Valo u32 cmd_flags)
34e705c121SKalle Valo {
35e705c121SKalle Valo union {
36e705c121SKalle Valo struct iwl_proto_offload_cmd_v1 v1;
37e705c121SKalle Valo struct iwl_proto_offload_cmd_v2 v2;
38e705c121SKalle Valo struct iwl_proto_offload_cmd_v3_small v3s;
39b60bc716SEmmanuel Grumbach struct iwl_proto_offload_cmd_v4 v4;
40e705c121SKalle Valo } cmd = {};
41e705c121SKalle Valo struct iwl_host_cmd hcmd = {
42e705c121SKalle Valo .id = PROT_OFFLOAD_CONFIG_CMD,
43e705c121SKalle Valo .flags = cmd_flags,
44e705c121SKalle Valo .data[0] = &cmd,
45e705c121SKalle Valo .dataflags[0] = IWL_HCMD_DFL_DUP,
46e705c121SKalle Valo };
47e705c121SKalle Valo struct iwl_proto_offload_cmd_common *common;
48e705c121SKalle Valo u32 enabled = 0, size;
49e705c121SKalle Valo u32 capa_flags = mvm->fw->ucode_capa.flags;
50971cbe50SJohannes Berg int ver = iwl_fw_lookup_cmd_ver(mvm->fw, hcmd.id, 0);
51b60bc716SEmmanuel Grumbach
52e705c121SKalle Valo #if IS_ENABLED(CONFIG_IPV6)
53e705c121SKalle Valo struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
54e705c121SKalle Valo int i;
55c97dab40SSara Sharon /*
56c97dab40SSara Sharon * Skip tentative address when ns offload is enabled to avoid
57c97dab40SSara Sharon * violating RFC4862.
58c97dab40SSara Sharon * Keep tentative address when ns offload is disabled so the NS packets
59c97dab40SSara Sharon * will not be filtered out and will wake up the host.
60c97dab40SSara Sharon */
61c97dab40SSara Sharon bool skip_tentative = offload_ns;
62e705c121SKalle Valo
63e705c121SKalle Valo if (capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_SMALL ||
64e705c121SKalle Valo capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_LARGE) {
65e705c121SKalle Valo struct iwl_ns_config *nsc;
66e705c121SKalle Valo struct iwl_targ_addr *addrs;
67e705c121SKalle Valo int n_nsc, n_addrs;
68e705c121SKalle Valo int c;
69c97dab40SSara Sharon int num_skipped = 0;
70e705c121SKalle Valo
71e705c121SKalle Valo if (capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_SMALL) {
72e705c121SKalle Valo nsc = cmd.v3s.ns_config;
73e705c121SKalle Valo n_nsc = IWL_PROTO_OFFLOAD_NUM_NS_CONFIG_V3S;
74e705c121SKalle Valo addrs = cmd.v3s.targ_addrs;
75e705c121SKalle Valo n_addrs = IWL_PROTO_OFFLOAD_NUM_IPV6_ADDRS_V3S;
76e705c121SKalle Valo } else {
77b60bc716SEmmanuel Grumbach nsc = cmd.v4.ns_config;
78e705c121SKalle Valo n_nsc = IWL_PROTO_OFFLOAD_NUM_NS_CONFIG_V3L;
79b60bc716SEmmanuel Grumbach addrs = cmd.v4.targ_addrs;
80e705c121SKalle Valo n_addrs = IWL_PROTO_OFFLOAD_NUM_IPV6_ADDRS_V3L;
81e705c121SKalle Valo }
82e705c121SKalle Valo
83e705c121SKalle Valo /*
84e705c121SKalle Valo * For each address we have (and that will fit) fill a target
85e705c121SKalle Valo * address struct and combine for NS offload structs with the
86e705c121SKalle Valo * solicited node addresses.
87e705c121SKalle Valo */
88e705c121SKalle Valo for (i = 0, c = 0;
89e705c121SKalle Valo i < mvmvif->num_target_ipv6_addrs &&
90e705c121SKalle Valo i < n_addrs && c < n_nsc; i++) {
91e705c121SKalle Valo struct in6_addr solicited_addr;
92e705c121SKalle Valo int j;
93e705c121SKalle Valo
94c97dab40SSara Sharon if (skip_tentative &&
95c97dab40SSara Sharon test_bit(i, mvmvif->tentative_addrs)) {
96c97dab40SSara Sharon num_skipped++;
97c97dab40SSara Sharon continue;
98c97dab40SSara Sharon }
99c97dab40SSara Sharon
100e705c121SKalle Valo addrconf_addr_solict_mult(&mvmvif->target_ipv6_addrs[i],
101e705c121SKalle Valo &solicited_addr);
102e705c121SKalle Valo for (j = 0; j < c; j++)
103e705c121SKalle Valo if (ipv6_addr_cmp(&nsc[j].dest_ipv6_addr,
104e705c121SKalle Valo &solicited_addr) == 0)
105e705c121SKalle Valo break;
106e705c121SKalle Valo if (j == c)
107e705c121SKalle Valo c++;
108e705c121SKalle Valo addrs[i].addr = mvmvif->target_ipv6_addrs[i];
109e705c121SKalle Valo addrs[i].config_num = cpu_to_le32(j);
110e705c121SKalle Valo nsc[j].dest_ipv6_addr = solicited_addr;
111e705c121SKalle Valo memcpy(nsc[j].target_mac_addr, vif->addr, ETH_ALEN);
112e705c121SKalle Valo }
113e705c121SKalle Valo
114c97dab40SSara Sharon if (mvmvif->num_target_ipv6_addrs - num_skipped)
115c97dab40SSara Sharon enabled |= IWL_D3_PROTO_IPV6_VALID;
116c97dab40SSara Sharon
117e705c121SKalle Valo if (capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_SMALL)
118c97dab40SSara Sharon cmd.v3s.num_valid_ipv6_addrs =
119c97dab40SSara Sharon cpu_to_le32(i - num_skipped);
120e705c121SKalle Valo else
121b60bc716SEmmanuel Grumbach cmd.v4.num_valid_ipv6_addrs =
122c97dab40SSara Sharon cpu_to_le32(i - num_skipped);
123e705c121SKalle Valo } else if (capa_flags & IWL_UCODE_TLV_FLAGS_D3_6_IPV6_ADDRS) {
124c97dab40SSara Sharon bool found = false;
125e705c121SKalle Valo
126e705c121SKalle Valo BUILD_BUG_ON(sizeof(cmd.v2.target_ipv6_addr[0]) !=
127e705c121SKalle Valo sizeof(mvmvif->target_ipv6_addrs[0]));
128e705c121SKalle Valo
129e705c121SKalle Valo for (i = 0; i < min(mvmvif->num_target_ipv6_addrs,
130c97dab40SSara Sharon IWL_PROTO_OFFLOAD_NUM_IPV6_ADDRS_V2); i++) {
131c97dab40SSara Sharon if (skip_tentative &&
132c97dab40SSara Sharon test_bit(i, mvmvif->tentative_addrs))
133c97dab40SSara Sharon continue;
134c97dab40SSara Sharon
135e705c121SKalle Valo memcpy(cmd.v2.target_ipv6_addr[i],
136e705c121SKalle Valo &mvmvif->target_ipv6_addrs[i],
137e705c121SKalle Valo sizeof(cmd.v2.target_ipv6_addr[i]));
138e705c121SKalle Valo
139c97dab40SSara Sharon found = true;
140c97dab40SSara Sharon }
141c97dab40SSara Sharon if (found) {
142c97dab40SSara Sharon enabled |= IWL_D3_PROTO_IPV6_VALID;
143c97dab40SSara Sharon memcpy(cmd.v2.ndp_mac_addr, vif->addr, ETH_ALEN);
144c97dab40SSara Sharon }
145c97dab40SSara Sharon } else {
146c97dab40SSara Sharon bool found = false;
147e705c121SKalle Valo BUILD_BUG_ON(sizeof(cmd.v1.target_ipv6_addr[0]) !=
148e705c121SKalle Valo sizeof(mvmvif->target_ipv6_addrs[0]));
149e705c121SKalle Valo
150e705c121SKalle Valo for (i = 0; i < min(mvmvif->num_target_ipv6_addrs,
151c97dab40SSara Sharon IWL_PROTO_OFFLOAD_NUM_IPV6_ADDRS_V1); i++) {
152c97dab40SSara Sharon if (skip_tentative &&
153c97dab40SSara Sharon test_bit(i, mvmvif->tentative_addrs))
154c97dab40SSara Sharon continue;
155c97dab40SSara Sharon
156e705c121SKalle Valo memcpy(cmd.v1.target_ipv6_addr[i],
157e705c121SKalle Valo &mvmvif->target_ipv6_addrs[i],
158e705c121SKalle Valo sizeof(cmd.v1.target_ipv6_addr[i]));
159e705c121SKalle Valo
160c97dab40SSara Sharon found = true;
161c97dab40SSara Sharon }
162c97dab40SSara Sharon
163c97dab40SSara Sharon if (found) {
164c97dab40SSara Sharon enabled |= IWL_D3_PROTO_IPV6_VALID;
165c97dab40SSara Sharon memcpy(cmd.v1.ndp_mac_addr, vif->addr, ETH_ALEN);
166c97dab40SSara Sharon }
167c97dab40SSara Sharon }
168c97dab40SSara Sharon
169c97dab40SSara Sharon if (offload_ns && (enabled & IWL_D3_PROTO_IPV6_VALID))
170c97dab40SSara Sharon enabled |= IWL_D3_PROTO_OFFLOAD_NS;
171c97dab40SSara Sharon #endif
172e705c121SKalle Valo if (capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_SMALL) {
173e705c121SKalle Valo common = &cmd.v3s.common;
174e705c121SKalle Valo size = sizeof(cmd.v3s);
175e705c121SKalle Valo } else if (capa_flags & IWL_UCODE_TLV_FLAGS_NEW_NSOFFL_LARGE) {
176b60bc716SEmmanuel Grumbach common = &cmd.v4.common;
177b60bc716SEmmanuel Grumbach size = sizeof(cmd.v4);
178b60bc716SEmmanuel Grumbach if (ver < 4) {
179b60bc716SEmmanuel Grumbach /*
180b60bc716SEmmanuel Grumbach * This basically uses iwl_proto_offload_cmd_v3_large
181b60bc716SEmmanuel Grumbach * which doesn't have the sta_id parameter before the
182b60bc716SEmmanuel Grumbach * common part.
183b60bc716SEmmanuel Grumbach */
184b60bc716SEmmanuel Grumbach size -= sizeof(cmd.v4.sta_id);
185b60bc716SEmmanuel Grumbach hcmd.data[0] = common;
186b60bc716SEmmanuel Grumbach }
187e705c121SKalle Valo } else if (capa_flags & IWL_UCODE_TLV_FLAGS_D3_6_IPV6_ADDRS) {
188e705c121SKalle Valo common = &cmd.v2.common;
189e705c121SKalle Valo size = sizeof(cmd.v2);
190e705c121SKalle Valo } else {
191e705c121SKalle Valo common = &cmd.v1.common;
192e705c121SKalle Valo size = sizeof(cmd.v1);
193e705c121SKalle Valo }
194e705c121SKalle Valo
195f276e20bSJohannes Berg if (vif->cfg.arp_addr_cnt) {
196c97dab40SSara Sharon enabled |= IWL_D3_PROTO_OFFLOAD_ARP | IWL_D3_PROTO_IPV4_VALID;
197f276e20bSJohannes Berg common->host_ipv4_addr = vif->cfg.arp_addr_list[0];
198e705c121SKalle Valo memcpy(common->arp_mac_addr, vif->addr, ETH_ALEN);
199e705c121SKalle Valo }
200e705c121SKalle Valo
2013b67a20bSHaim Dreyfuss if (fw_has_capa(&mvm->fw->ucode_capa,
202*e9f5ce34SHaim Dreyfuss IWL_UCODE_TLV_CAPA_OFFLOAD_BTM_SUPPORT))
203*e9f5ce34SHaim Dreyfuss enabled |= IWL_D3_PROTO_OFFLOAD_BTM;
2043b67a20bSHaim Dreyfuss
205e705c121SKalle Valo if (!disable_offloading)
206e705c121SKalle Valo common->enabled = cpu_to_le32(enabled);
207e705c121SKalle Valo
208e705c121SKalle Valo hcmd.len[0] = size;
209e705c121SKalle Valo return iwl_mvm_send_cmd(mvm, &hcmd);
210e705c121SKalle Valo }
211