1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2017-2020 The Linux Foundation. All rights reserved.
3*5113495bSYour Name * Copyright (c) 2022-2023 Qualcomm Innovation Center, Inc. All rights reserved.
4*5113495bSYour Name *
5*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for
6*5113495bSYour Name * any purpose with or without fee is hereby granted, provided that the
7*5113495bSYour Name * above copyright notice and this permission notice appear in all
8*5113495bSYour Name * copies.
9*5113495bSYour Name *
10*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
11*5113495bSYour Name * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
12*5113495bSYour Name * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
13*5113495bSYour Name * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
14*5113495bSYour Name * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
15*5113495bSYour Name * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
16*5113495bSYour Name * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
17*5113495bSYour Name * PERFORMANCE OF THIS SOFTWARE.
18*5113495bSYour Name */
19*5113495bSYour Name /**
20*5113495bSYour Name * DOC: wlan_serialization_non_scan.c
21*5113495bSYour Name * This file defines the functions which deals with
22*5113495bSYour Name * serialization non scan commands.
23*5113495bSYour Name */
24*5113495bSYour Name
25*5113495bSYour Name #include <wlan_objmgr_psoc_obj.h>
26*5113495bSYour Name #include <wlan_objmgr_pdev_obj.h>
27*5113495bSYour Name #include <wlan_objmgr_vdev_obj.h>
28*5113495bSYour Name #include "wlan_serialization_main_i.h"
29*5113495bSYour Name #include "wlan_serialization_utils_i.h"
30*5113495bSYour Name #include "wlan_serialization_non_scan_i.h"
31*5113495bSYour Name #include "qdf_util.h"
32*5113495bSYour Name
33*5113495bSYour Name bool
wlan_serialization_is_non_scan_pending_queue_empty(struct wlan_serialization_command * cmd)34*5113495bSYour Name wlan_serialization_is_non_scan_pending_queue_empty(
35*5113495bSYour Name struct wlan_serialization_command *cmd)
36*5113495bSYour Name {
37*5113495bSYour Name struct wlan_objmgr_vdev *vdev = NULL;
38*5113495bSYour Name struct wlan_ser_vdev_obj *ser_vdev_obj = NULL;
39*5113495bSYour Name struct wlan_serialization_vdev_queue *vdev_q;
40*5113495bSYour Name bool status = false;
41*5113495bSYour Name
42*5113495bSYour Name vdev = wlan_serialization_get_vdev_from_cmd(cmd);
43*5113495bSYour Name
44*5113495bSYour Name if (!vdev) {
45*5113495bSYour Name ser_err("vdev object is invalid");
46*5113495bSYour Name goto error;
47*5113495bSYour Name }
48*5113495bSYour Name
49*5113495bSYour Name ser_vdev_obj = wlan_serialization_get_vdev_obj(vdev);
50*5113495bSYour Name vdev_q = &ser_vdev_obj->vdev_q[SER_VDEV_QUEUE_COMP_NON_SCAN];
51*5113495bSYour Name
52*5113495bSYour Name if (qdf_list_empty(&vdev_q->pending_list))
53*5113495bSYour Name status = true;
54*5113495bSYour Name
55*5113495bSYour Name error:
56*5113495bSYour Name return status;
57*5113495bSYour Name }
58*5113495bSYour Name
59*5113495bSYour Name bool
wlan_serialization_is_active_non_scan_cmd_allowed(struct wlan_serialization_command * cmd)60*5113495bSYour Name wlan_serialization_is_active_non_scan_cmd_allowed(
61*5113495bSYour Name struct wlan_serialization_command *cmd)
62*5113495bSYour Name {
63*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_queue;
64*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj;
65*5113495bSYour Name unsigned long *vdev_active_cmd_bitmap;
66*5113495bSYour Name bool blocking_cmd_active = 0;
67*5113495bSYour Name uint8_t blocking_cmd_waiting = 0;
68*5113495bSYour Name bool status = false;
69*5113495bSYour Name uint32_t vdev_id;
70*5113495bSYour Name
71*5113495bSYour Name ser_pdev_obj = wlan_serialization_get_pdev_obj(
72*5113495bSYour Name wlan_serialization_get_pdev_from_cmd(cmd));
73*5113495bSYour Name
74*5113495bSYour Name pdev_queue = wlan_serialization_get_pdev_queue_obj(ser_pdev_obj,
75*5113495bSYour Name cmd->cmd_type);
76*5113495bSYour Name
77*5113495bSYour Name vdev_active_cmd_bitmap = pdev_queue->vdev_active_cmd_bitmap;
78*5113495bSYour Name
79*5113495bSYour Name blocking_cmd_active = pdev_queue->blocking_cmd_active;
80*5113495bSYour Name blocking_cmd_waiting = pdev_queue->blocking_cmd_waiting;
81*5113495bSYour Name
82*5113495bSYour Name /*
83*5113495bSYour Name * Command is blocking
84*5113495bSYour Name */
85*5113495bSYour Name if (cmd->is_blocking) {
86*5113495bSYour Name /*
87*5113495bSYour Name * For blocking commands, no other
88*5113495bSYour Name * commands from any vdev should be active
89*5113495bSYour Name */
90*5113495bSYour Name
91*5113495bSYour Name if (wlan_serialization_any_vdev_cmd_active(pdev_queue)) {
92*5113495bSYour Name status = false;
93*5113495bSYour Name pdev_queue->blocking_cmd_waiting++;
94*5113495bSYour Name } else {
95*5113495bSYour Name status = true;
96*5113495bSYour Name }
97*5113495bSYour Name } else {
98*5113495bSYour Name /*
99*5113495bSYour Name * Command is non blocking
100*5113495bSYour Name * For activating non blocking commands, if there any blocking
101*5113495bSYour Name * commands, waiting or active, put it to pending queue
102*5113495bSYour Name */
103*5113495bSYour Name if (blocking_cmd_active || blocking_cmd_waiting) {
104*5113495bSYour Name status = false;
105*5113495bSYour Name } else {
106*5113495bSYour Name /*
107*5113495bSYour Name * For non blocking command, and no blocking commands
108*5113495bSYour Name * waiting or active, check if a cmd for that vdev is active
109*5113495bSYour Name * If not active, put to active else pending queue
110*5113495bSYour Name */
111*5113495bSYour Name vdev_id = wlan_vdev_get_id(cmd->vdev);
112*5113495bSYour Name status = qdf_test_bit(vdev_id, vdev_active_cmd_bitmap)
113*5113495bSYour Name ? false : true;
114*5113495bSYour Name
115*5113495bSYour Name ser_debug_hex(
116*5113495bSYour Name vdev_active_cmd_bitmap,
117*5113495bSYour Name sizeof(pdev_queue->vdev_active_cmd_bitmap));
118*5113495bSYour Name
119*5113495bSYour Name }
120*5113495bSYour Name }
121*5113495bSYour Name return status;
122*5113495bSYour Name }
123*5113495bSYour Name
wlan_ser_add_non_scan_cmd(struct wlan_ser_pdev_obj * ser_pdev_obj,struct wlan_serialization_command_list * cmd_list,uint8_t is_cmd_for_active_queue)124*5113495bSYour Name enum wlan_serialization_status wlan_ser_add_non_scan_cmd(
125*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj,
126*5113495bSYour Name struct wlan_serialization_command_list *cmd_list,
127*5113495bSYour Name uint8_t is_cmd_for_active_queue)
128*5113495bSYour Name {
129*5113495bSYour Name enum wlan_serialization_status pdev_status, vdev_status;
130*5113495bSYour Name enum wlan_serialization_status status = WLAN_SER_CMD_DENIED_UNSPECIFIED;
131*5113495bSYour Name struct wlan_serialization_command_list *pcmd_list;
132*5113495bSYour Name uint8_t vdev_id;
133*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_queue;
134*5113495bSYour Name
135*5113495bSYour Name vdev_status = wlan_serialization_add_cmd_to_vdev_queue(
136*5113495bSYour Name ser_pdev_obj, cmd_list, is_cmd_for_active_queue);
137*5113495bSYour Name
138*5113495bSYour Name if (vdev_status == WLAN_SER_CMD_DENIED_LIST_FULL) {
139*5113495bSYour Name ser_err_rl("List is full cannot add type %d cmd id %d",
140*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
141*5113495bSYour Name status = vdev_status;
142*5113495bSYour Name goto vdev_error;
143*5113495bSYour Name }
144*5113495bSYour Name
145*5113495bSYour Name if (is_cmd_for_active_queue) {
146*5113495bSYour Name if (vdev_status != WLAN_SER_CMD_ACTIVE) {
147*5113495bSYour Name ser_err("Failed to add type %d cmd id %d to vdev active queue",
148*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
149*5113495bSYour Name QDF_ASSERT(0);
150*5113495bSYour Name goto vdev_error;
151*5113495bSYour Name }
152*5113495bSYour Name } else {
153*5113495bSYour Name if (vdev_status != WLAN_SER_CMD_PENDING) {
154*5113495bSYour Name ser_err("Failed to add type %d cmd id %d to vdev pending queue",
155*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
156*5113495bSYour Name QDF_ASSERT(0);
157*5113495bSYour Name goto vdev_error;
158*5113495bSYour Name }
159*5113495bSYour Name }
160*5113495bSYour Name
161*5113495bSYour Name pdev_status = wlan_serialization_add_cmd_to_pdev_queue(
162*5113495bSYour Name ser_pdev_obj, cmd_list, is_cmd_for_active_queue);
163*5113495bSYour Name
164*5113495bSYour Name if (pdev_status == WLAN_SER_CMD_DENIED_LIST_FULL) {
165*5113495bSYour Name ser_err_rl("pdev List is full cannot add type %d cmd id %d",
166*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
167*5113495bSYour Name status = pdev_status;
168*5113495bSYour Name goto pdev_error;
169*5113495bSYour Name }
170*5113495bSYour Name
171*5113495bSYour Name if (is_cmd_for_active_queue) {
172*5113495bSYour Name if (pdev_status != WLAN_SER_CMD_ACTIVE) {
173*5113495bSYour Name ser_err("Failed to add type %d cmd id %d to pdev active queue",
174*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
175*5113495bSYour Name QDF_ASSERT(0);
176*5113495bSYour Name goto pdev_error;
177*5113495bSYour Name }
178*5113495bSYour Name } else {
179*5113495bSYour Name if (pdev_status != WLAN_SER_CMD_PENDING) {
180*5113495bSYour Name ser_err("Failed to add type %d cmd id %d to pdev pending queue",
181*5113495bSYour Name cmd_list->cmd.cmd_type, cmd_list->cmd.cmd_id);
182*5113495bSYour Name QDF_ASSERT(0);
183*5113495bSYour Name goto pdev_error;
184*5113495bSYour Name }
185*5113495bSYour Name }
186*5113495bSYour Name pdev_error:
187*5113495bSYour Name /*
188*5113495bSYour Name * If cmd added to vdev queue, but failed while
189*5113495bSYour Name * adding to pdev queue, remove cmd from vdev queue as well
190*5113495bSYour Name */
191*5113495bSYour Name if (pdev_status != vdev_status) {
192*5113495bSYour Name wlan_serialization_remove_cmd_from_vdev_queue(
193*5113495bSYour Name ser_pdev_obj, &pcmd_list,
194*5113495bSYour Name &cmd_list->cmd,
195*5113495bSYour Name is_cmd_for_active_queue);
196*5113495bSYour Name goto vdev_error;
197*5113495bSYour Name } else {
198*5113495bSYour Name status = pdev_status;
199*5113495bSYour Name }
200*5113495bSYour Name
201*5113495bSYour Name if (is_cmd_for_active_queue) {
202*5113495bSYour Name pdev_queue = wlan_serialization_get_pdev_queue_obj(
203*5113495bSYour Name ser_pdev_obj, cmd_list->cmd.cmd_type);
204*5113495bSYour Name vdev_id = wlan_vdev_get_id(cmd_list->cmd.vdev);
205*5113495bSYour Name qdf_set_bit(vdev_id, pdev_queue->vdev_active_cmd_bitmap);
206*5113495bSYour Name
207*5113495bSYour Name if (cmd_list->cmd.is_blocking)
208*5113495bSYour Name pdev_queue->blocking_cmd_active = 1;
209*5113495bSYour Name }
210*5113495bSYour Name
211*5113495bSYour Name vdev_error:
212*5113495bSYour Name return status;
213*5113495bSYour Name }
214*5113495bSYour Name
215*5113495bSYour Name enum wlan_serialization_status
wlan_ser_move_non_scan_pending_to_active(struct wlan_ser_pdev_obj * ser_pdev_obj,struct wlan_objmgr_vdev * vdev,bool blocking_cmd_removed)216*5113495bSYour Name wlan_ser_move_non_scan_pending_to_active(
217*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj,
218*5113495bSYour Name struct wlan_objmgr_vdev *vdev,
219*5113495bSYour Name bool blocking_cmd_removed)
220*5113495bSYour Name {
221*5113495bSYour Name struct wlan_serialization_command_list *pending_cmd_list = NULL;
222*5113495bSYour Name struct wlan_serialization_command_list *next_cmd_list = NULL;
223*5113495bSYour Name struct wlan_serialization_command_list *active_cmd_list;
224*5113495bSYour Name struct wlan_serialization_command cmd_to_remove;
225*5113495bSYour Name enum wlan_serialization_status status = WLAN_SER_CMD_DENIED_UNSPECIFIED;
226*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_queue;
227*5113495bSYour Name struct wlan_serialization_vdev_queue *vdev_queue = NULL;
228*5113495bSYour Name
229*5113495bSYour Name struct wlan_ser_vdev_obj *ser_vdev_obj;
230*5113495bSYour Name
231*5113495bSYour Name qdf_list_t *pending_queue;
232*5113495bSYour Name qdf_list_node_t *pending_node = NULL;
233*5113495bSYour Name qdf_list_node_t *next_node = NULL;
234*5113495bSYour Name QDF_STATUS qdf_status = QDF_STATUS_E_FAILURE;
235*5113495bSYour Name uint32_t blocking_cmd_waiting = 0;
236*5113495bSYour Name uint32_t vdev_id;
237*5113495bSYour Name uint32_t qsize;
238*5113495bSYour Name bool vdev_cmd_active = 0;
239*5113495bSYour Name bool vdev_queue_lookup = false;
240*5113495bSYour Name
241*5113495bSYour Name if (!ser_pdev_obj) {
242*5113495bSYour Name ser_err("Can't find ser_pdev_obj");
243*5113495bSYour Name goto error;
244*5113495bSYour Name }
245*5113495bSYour Name
246*5113495bSYour Name pdev_queue = &ser_pdev_obj->pdev_q[SER_PDEV_QUEUE_COMP_NON_SCAN];
247*5113495bSYour Name
248*5113495bSYour Name if (vdev) {
249*5113495bSYour Name ser_vdev_obj = wlan_serialization_get_vdev_obj(vdev);
250*5113495bSYour Name if (!ser_vdev_obj) {
251*5113495bSYour Name ser_err("Can't find ser_vdev_obj");
252*5113495bSYour Name goto error;
253*5113495bSYour Name }
254*5113495bSYour Name
255*5113495bSYour Name vdev_queue =
256*5113495bSYour Name &ser_vdev_obj->vdev_q[SER_VDEV_QUEUE_COMP_NON_SCAN];
257*5113495bSYour Name }
258*5113495bSYour Name
259*5113495bSYour Name wlan_serialization_acquire_lock(&pdev_queue->pdev_queue_lock);
260*5113495bSYour Name
261*5113495bSYour Name blocking_cmd_waiting = pdev_queue->blocking_cmd_waiting;
262*5113495bSYour Name
263*5113495bSYour Name if (!blocking_cmd_removed && !blocking_cmd_waiting && vdev_queue) {
264*5113495bSYour Name pending_queue = &vdev_queue->pending_list;
265*5113495bSYour Name vdev_queue_lookup = true;
266*5113495bSYour Name } else {
267*5113495bSYour Name pending_queue = &pdev_queue->pending_list;
268*5113495bSYour Name }
269*5113495bSYour Name
270*5113495bSYour Name qsize = wlan_serialization_list_size(pending_queue);
271*5113495bSYour Name if (!qsize) {
272*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
273*5113495bSYour Name goto error;
274*5113495bSYour Name }
275*5113495bSYour Name
276*5113495bSYour Name qdf_status = wlan_serialization_peek_front(pending_queue,
277*5113495bSYour Name &pending_node);
278*5113495bSYour Name if (qdf_status != QDF_STATUS_SUCCESS) {
279*5113495bSYour Name ser_err("can't peek cmd");
280*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
281*5113495bSYour Name goto error;
282*5113495bSYour Name }
283*5113495bSYour Name
284*5113495bSYour Name while (qsize--) {
285*5113495bSYour Name if (vdev_queue_lookup) {
286*5113495bSYour Name pending_cmd_list =
287*5113495bSYour Name qdf_container_of(
288*5113495bSYour Name pending_node,
289*5113495bSYour Name struct wlan_serialization_command_list,
290*5113495bSYour Name vdev_node);
291*5113495bSYour Name } else {
292*5113495bSYour Name pending_cmd_list =
293*5113495bSYour Name qdf_container_of(
294*5113495bSYour Name pending_node,
295*5113495bSYour Name struct wlan_serialization_command_list,
296*5113495bSYour Name pdev_node);
297*5113495bSYour Name }
298*5113495bSYour Name
299*5113495bSYour Name if (!pending_cmd_list) {
300*5113495bSYour Name wlan_serialization_release_lock(
301*5113495bSYour Name &pdev_queue->pdev_queue_lock);
302*5113495bSYour Name ser_debug(
303*5113495bSYour Name "non scan cmd cannot move frm pendin to actv");
304*5113495bSYour Name goto error;
305*5113495bSYour Name }
306*5113495bSYour Name
307*5113495bSYour Name vdev_id = wlan_vdev_get_id(pending_cmd_list->cmd.vdev);
308*5113495bSYour Name vdev_cmd_active = qdf_test_bit(
309*5113495bSYour Name vdev_id, pdev_queue->vdev_active_cmd_bitmap);
310*5113495bSYour Name
311*5113495bSYour Name if (!vdev_queue_lookup) {
312*5113495bSYour Name if (pending_cmd_list->cmd.is_blocking &&
313*5113495bSYour Name wlan_serialization_any_vdev_cmd_active(
314*5113495bSYour Name pdev_queue)) {
315*5113495bSYour Name break;
316*5113495bSYour Name }
317*5113495bSYour Name /*
318*5113495bSYour Name * For the last node we dont need the next node
319*5113495bSYour Name */
320*5113495bSYour Name if (qsize) {
321*5113495bSYour Name qdf_status = wlan_serialization_peek_next(
322*5113495bSYour Name pending_queue,
323*5113495bSYour Name pending_node,
324*5113495bSYour Name &next_node);
325*5113495bSYour Name
326*5113495bSYour Name if (qdf_status != QDF_STATUS_SUCCESS) {
327*5113495bSYour Name ser_err("can't peek cmd");
328*5113495bSYour Name break;
329*5113495bSYour Name }
330*5113495bSYour Name
331*5113495bSYour Name pending_node = next_node;
332*5113495bSYour Name
333*5113495bSYour Name next_cmd_list = qdf_container_of(
334*5113495bSYour Name next_node,
335*5113495bSYour Name struct wlan_serialization_command_list,
336*5113495bSYour Name pdev_node);
337*5113495bSYour Name
338*5113495bSYour Name qdf_atomic_set_bit(CMD_MARKED_FOR_MOVEMENT,
339*5113495bSYour Name &next_cmd_list->cmd_in_use);
340*5113495bSYour Name }
341*5113495bSYour Name
342*5113495bSYour Name if (vdev_cmd_active) {
343*5113495bSYour Name qdf_atomic_clear_bit(CMD_MARKED_FOR_MOVEMENT,
344*5113495bSYour Name &pending_cmd_list->cmd_in_use);
345*5113495bSYour Name continue;
346*5113495bSYour Name }
347*5113495bSYour Name } else {
348*5113495bSYour Name if (vdev_cmd_active)
349*5113495bSYour Name break;
350*5113495bSYour Name
351*5113495bSYour Name if (qdf_atomic_test_bit(
352*5113495bSYour Name CMD_MARKED_FOR_MOVEMENT,
353*5113495bSYour Name &pending_cmd_list->cmd_in_use)) {
354*5113495bSYour Name break;
355*5113495bSYour Name }
356*5113495bSYour Name }
357*5113495bSYour Name
358*5113495bSYour Name qdf_mem_copy(&cmd_to_remove, &pending_cmd_list->cmd,
359*5113495bSYour Name sizeof(struct wlan_serialization_command));
360*5113495bSYour Name
361*5113495bSYour Name qdf_status = wlan_ser_remove_non_scan_cmd(ser_pdev_obj,
362*5113495bSYour Name &pending_cmd_list,
363*5113495bSYour Name &cmd_to_remove,
364*5113495bSYour Name false);
365*5113495bSYour Name
366*5113495bSYour Name wlan_ser_update_cmd_history(
367*5113495bSYour Name pdev_queue, &pending_cmd_list->cmd,
368*5113495bSYour Name SER_PENDING_TO_ACTIVE,
369*5113495bSYour Name false, false);
370*5113495bSYour Name
371*5113495bSYour Name if (QDF_STATUS_SUCCESS != qdf_status) {
372*5113495bSYour Name wlan_serialization_release_lock(
373*5113495bSYour Name &pdev_queue->pdev_queue_lock);
374*5113495bSYour Name ser_err("Can't remove cmd from pendingQ id-%d type-%d",
375*5113495bSYour Name pending_cmd_list->cmd.cmd_id,
376*5113495bSYour Name pending_cmd_list->cmd.cmd_type);
377*5113495bSYour Name QDF_ASSERT(0);
378*5113495bSYour Name status = WLAN_SER_CMD_DENIED_UNSPECIFIED;
379*5113495bSYour Name goto error;
380*5113495bSYour Name }
381*5113495bSYour Name
382*5113495bSYour Name active_cmd_list = pending_cmd_list;
383*5113495bSYour Name
384*5113495bSYour Name status = wlan_ser_add_non_scan_cmd(
385*5113495bSYour Name ser_pdev_obj, active_cmd_list, true);
386*5113495bSYour Name
387*5113495bSYour Name if (WLAN_SER_CMD_ACTIVE != status) {
388*5113495bSYour Name wlan_serialization_release_lock(
389*5113495bSYour Name &pdev_queue->pdev_queue_lock);
390*5113495bSYour Name ser_err("Can't move cmd to activeQ id-%d type-%d",
391*5113495bSYour Name pending_cmd_list->cmd.cmd_id,
392*5113495bSYour Name pending_cmd_list->cmd.cmd_type);
393*5113495bSYour Name wlan_serialization_insert_back(
394*5113495bSYour Name &pdev_queue->cmd_pool_list,
395*5113495bSYour Name &active_cmd_list->pdev_node);
396*5113495bSYour Name status = WLAN_SER_CMD_DENIED_UNSPECIFIED;
397*5113495bSYour Name QDF_ASSERT(0);
398*5113495bSYour Name goto error;
399*5113495bSYour Name }
400*5113495bSYour Name
401*5113495bSYour Name wlan_ser_update_cmd_history(
402*5113495bSYour Name pdev_queue, &active_cmd_list->cmd,
403*5113495bSYour Name SER_PENDING_TO_ACTIVE,
404*5113495bSYour Name true, true);
405*5113495bSYour Name
406*5113495bSYour Name qdf_atomic_set_bit(CMD_MARKED_FOR_ACTIVATION,
407*5113495bSYour Name &active_cmd_list->cmd_in_use);
408*5113495bSYour Name
409*5113495bSYour Name if (active_cmd_list->cmd.is_blocking)
410*5113495bSYour Name pdev_queue->blocking_cmd_waiting--;
411*5113495bSYour Name
412*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
413*5113495bSYour Name
414*5113495bSYour Name wlan_serialization_activate_cmd(active_cmd_list, ser_pdev_obj,
415*5113495bSYour Name SER_PENDING_TO_ACTIVE);
416*5113495bSYour Name
417*5113495bSYour Name wlan_serialization_acquire_lock(&pdev_queue->pdev_queue_lock);
418*5113495bSYour Name
419*5113495bSYour Name if (vdev_queue_lookup || pdev_queue->blocking_cmd_active)
420*5113495bSYour Name break;
421*5113495bSYour Name
422*5113495bSYour Name qsize = wlan_serialization_list_size(pending_queue);
423*5113495bSYour Name if (!qsize) {
424*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
425*5113495bSYour Name goto error;
426*5113495bSYour Name }
427*5113495bSYour Name
428*5113495bSYour Name qdf_status = wlan_serialization_peek_front(pending_queue,
429*5113495bSYour Name &pending_node);
430*5113495bSYour Name if (qdf_status != QDF_STATUS_SUCCESS) {
431*5113495bSYour Name ser_err("can't peek cmd");
432*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
433*5113495bSYour Name goto error;
434*5113495bSYour Name }
435*5113495bSYour Name }
436*5113495bSYour Name
437*5113495bSYour Name wlan_serialization_release_lock(&pdev_queue->pdev_queue_lock);
438*5113495bSYour Name error:
439*5113495bSYour Name
440*5113495bSYour Name return status;
441*5113495bSYour Name }
442*5113495bSYour Name
wlan_ser_remove_non_scan_cmd(struct wlan_ser_pdev_obj * ser_pdev_obj,struct wlan_serialization_command_list ** pcmd_list,struct wlan_serialization_command * cmd,uint8_t is_active_cmd)443*5113495bSYour Name QDF_STATUS wlan_ser_remove_non_scan_cmd(
444*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj,
445*5113495bSYour Name struct wlan_serialization_command_list **pcmd_list,
446*5113495bSYour Name struct wlan_serialization_command *cmd,
447*5113495bSYour Name uint8_t is_active_cmd)
448*5113495bSYour Name {
449*5113495bSYour Name QDF_STATUS pdev_status, vdev_status;
450*5113495bSYour Name QDF_STATUS status = QDF_STATUS_E_FAILURE;
451*5113495bSYour Name uint32_t vdev_id;
452*5113495bSYour Name bool blocking_cmd_removed = 0;
453*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_queue;
454*5113495bSYour Name
455*5113495bSYour Name vdev_status =
456*5113495bSYour Name wlan_serialization_remove_cmd_from_vdev_queue(ser_pdev_obj,
457*5113495bSYour Name pcmd_list,
458*5113495bSYour Name cmd,
459*5113495bSYour Name is_active_cmd);
460*5113495bSYour Name
461*5113495bSYour Name /* Here command removal can fail for 2 reasons
462*5113495bSYour Name * 1. The cmd is not present
463*5113495bSYour Name * 2. The command had not returned from activation
464*5113495bSYour Name * and will not be removed now.
465*5113495bSYour Name *
466*5113495bSYour Name * In the second case, we should not flag it as error
467*5113495bSYour Name * since it will removed after the activation completes.
468*5113495bSYour Name */
469*5113495bSYour Name
470*5113495bSYour Name if (vdev_status != QDF_STATUS_SUCCESS) {
471*5113495bSYour Name status = vdev_status;
472*5113495bSYour Name if (vdev_status != QDF_STATUS_E_PENDING)
473*5113495bSYour Name ser_debug("Failed to remove type %d id %d from vdev queue",
474*5113495bSYour Name cmd->cmd_type, cmd->cmd_id);
475*5113495bSYour Name goto error;
476*5113495bSYour Name }
477*5113495bSYour Name
478*5113495bSYour Name pdev_status =
479*5113495bSYour Name wlan_serialization_remove_cmd_from_pdev_queue(ser_pdev_obj,
480*5113495bSYour Name pcmd_list,
481*5113495bSYour Name cmd,
482*5113495bSYour Name is_active_cmd);
483*5113495bSYour Name
484*5113495bSYour Name if (pdev_status != QDF_STATUS_SUCCESS) {
485*5113495bSYour Name ser_debug("Failed to remove type %d id %d from pdev active/pending queue",
486*5113495bSYour Name cmd->cmd_type, cmd->cmd_id);
487*5113495bSYour Name goto error;
488*5113495bSYour Name }
489*5113495bSYour Name
490*5113495bSYour Name if (is_active_cmd) {
491*5113495bSYour Name blocking_cmd_removed = (*pcmd_list)->cmd.is_blocking;
492*5113495bSYour Name pdev_queue = wlan_serialization_get_pdev_queue_obj(
493*5113495bSYour Name ser_pdev_obj, (*pcmd_list)->cmd.cmd_type);
494*5113495bSYour Name
495*5113495bSYour Name if (blocking_cmd_removed)
496*5113495bSYour Name pdev_queue->blocking_cmd_active = 0;
497*5113495bSYour Name
498*5113495bSYour Name vdev_id = wlan_vdev_get_id(cmd->vdev);
499*5113495bSYour Name qdf_clear_bit(vdev_id, pdev_queue->vdev_active_cmd_bitmap);
500*5113495bSYour Name }
501*5113495bSYour Name
502*5113495bSYour Name status = QDF_STATUS_SUCCESS;
503*5113495bSYour Name
504*5113495bSYour Name error:
505*5113495bSYour Name return status;
506*5113495bSYour Name }
507*5113495bSYour Name
508*5113495bSYour Name enum wlan_serialization_cmd_status
wlan_ser_cancel_non_scan_cmd(struct wlan_ser_pdev_obj * ser_pdev_obj,struct wlan_objmgr_pdev * pdev,struct wlan_objmgr_vdev * vdev,struct wlan_serialization_command * cmd,enum wlan_serialization_cmd_type cmd_type,uint8_t is_active_queue,enum wlan_ser_cmd_attr cmd_attr)509*5113495bSYour Name wlan_ser_cancel_non_scan_cmd(
510*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj,
511*5113495bSYour Name struct wlan_objmgr_pdev *pdev, struct wlan_objmgr_vdev *vdev,
512*5113495bSYour Name struct wlan_serialization_command *cmd,
513*5113495bSYour Name enum wlan_serialization_cmd_type cmd_type,
514*5113495bSYour Name uint8_t is_active_queue, enum wlan_ser_cmd_attr cmd_attr)
515*5113495bSYour Name {
516*5113495bSYour Name qdf_list_t *pdev_queue;
517*5113495bSYour Name qdf_list_t *vdev_queue;
518*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_q;
519*5113495bSYour Name uint32_t qsize;
520*5113495bSYour Name uint8_t vdev_id;
521*5113495bSYour Name bool is_blocking;
522*5113495bSYour Name struct wlan_serialization_command_list *cmd_list = NULL;
523*5113495bSYour Name struct wlan_serialization_command cmd_bkup;
524*5113495bSYour Name qdf_list_node_t *nnode = NULL, *pnode = NULL;
525*5113495bSYour Name enum wlan_serialization_cmd_status status = WLAN_SER_CMD_NOT_FOUND;
526*5113495bSYour Name struct wlan_objmgr_psoc *psoc = NULL;
527*5113495bSYour Name QDF_STATUS qdf_status;
528*5113495bSYour Name QDF_STATUS pdev_status, vdev_status;
529*5113495bSYour Name struct wlan_ser_vdev_obj *ser_vdev_obj;
530*5113495bSYour Name
531*5113495bSYour Name pdev_q = wlan_serialization_get_pdev_queue_obj(ser_pdev_obj, cmd_type);
532*5113495bSYour Name
533*5113495bSYour Name pdev_queue = wlan_serialization_get_list_from_pdev_queue(
534*5113495bSYour Name ser_pdev_obj, cmd_type, is_active_queue);
535*5113495bSYour Name
536*5113495bSYour Name if (pdev)
537*5113495bSYour Name psoc = wlan_pdev_get_psoc(pdev);
538*5113495bSYour Name else if (vdev)
539*5113495bSYour Name psoc = wlan_vdev_get_psoc(vdev);
540*5113495bSYour Name else if (cmd && cmd->vdev)
541*5113495bSYour Name psoc = wlan_vdev_get_psoc(cmd->vdev);
542*5113495bSYour Name else
543*5113495bSYour Name ser_debug("Can't find psoc");
544*5113495bSYour Name
545*5113495bSYour Name wlan_serialization_acquire_lock(&pdev_q->pdev_queue_lock);
546*5113495bSYour Name
547*5113495bSYour Name qsize = wlan_serialization_list_size(pdev_queue);
548*5113495bSYour Name while (!wlan_serialization_list_empty(pdev_queue) && qsize--) {
549*5113495bSYour Name if (wlan_serialization_get_cmd_from_queue(pdev_queue, &nnode)
550*5113495bSYour Name != QDF_STATUS_SUCCESS) {
551*5113495bSYour Name ser_err("can't read cmd from queue");
552*5113495bSYour Name status = WLAN_SER_CMD_NOT_FOUND;
553*5113495bSYour Name break;
554*5113495bSYour Name }
555*5113495bSYour Name cmd_list =
556*5113495bSYour Name qdf_container_of(nnode,
557*5113495bSYour Name struct wlan_serialization_command_list,
558*5113495bSYour Name pdev_node);
559*5113495bSYour Name if (cmd &&
560*5113495bSYour Name !(wlan_serialization_match_cmd_id_type(nnode, cmd,
561*5113495bSYour Name WLAN_SER_PDEV_NODE) &&
562*5113495bSYour Name wlan_serialization_match_cmd_vdev(nnode, cmd->vdev,
563*5113495bSYour Name WLAN_SER_PDEV_NODE))) {
564*5113495bSYour Name pnode = nnode;
565*5113495bSYour Name continue;
566*5113495bSYour Name }
567*5113495bSYour Name
568*5113495bSYour Name if (vdev &&
569*5113495bSYour Name !wlan_serialization_match_cmd_vdev(nnode,
570*5113495bSYour Name vdev,
571*5113495bSYour Name WLAN_SER_PDEV_NODE)) {
572*5113495bSYour Name pnode = nnode;
573*5113495bSYour Name continue;
574*5113495bSYour Name }
575*5113495bSYour Name
576*5113495bSYour Name if (pdev &&
577*5113495bSYour Name !wlan_serialization_match_cmd_pdev(nnode,
578*5113495bSYour Name pdev,
579*5113495bSYour Name WLAN_SER_PDEV_NODE)) {
580*5113495bSYour Name pnode = nnode;
581*5113495bSYour Name continue;
582*5113495bSYour Name }
583*5113495bSYour Name
584*5113495bSYour Name if (cmd_type > WLAN_SER_CMD_NONSCAN && vdev &&
585*5113495bSYour Name (!wlan_serialization_match_cmd_type(nnode, cmd_type,
586*5113495bSYour Name WLAN_SER_PDEV_NODE) ||
587*5113495bSYour Name !wlan_serialization_match_cmd_vdev(nnode, vdev,
588*5113495bSYour Name WLAN_SER_PDEV_NODE))) {
589*5113495bSYour Name pnode = nnode;
590*5113495bSYour Name continue;
591*5113495bSYour Name }
592*5113495bSYour Name
593*5113495bSYour Name /*
594*5113495bSYour Name * If a non-blocking cmd is required to be cancelled, but
595*5113495bSYour Name * the nnode cmd is a blocking cmd then continue with the
596*5113495bSYour Name * next command in the list else proceed with cmd cancel.
597*5113495bSYour Name */
598*5113495bSYour Name if ((cmd_attr == WLAN_SER_CMD_ATTR_NONBLOCK) &&
599*5113495bSYour Name wlan_serialization_match_cmd_blocking(nnode,
600*5113495bSYour Name WLAN_SER_PDEV_NODE)) {
601*5113495bSYour Name pnode = nnode;
602*5113495bSYour Name continue;
603*5113495bSYour Name }
604*5113495bSYour Name
605*5113495bSYour Name /*
606*5113495bSYour Name * active queue can't be removed directly, requester needs to
607*5113495bSYour Name * wait for active command response and send remove request for
608*5113495bSYour Name * active command separately
609*5113495bSYour Name */
610*5113495bSYour Name if (is_active_queue) {
611*5113495bSYour Name if (!psoc || !cmd_list) {
612*5113495bSYour Name ser_err("psoc:0x%pK, cmd_list:0x%pK",
613*5113495bSYour Name psoc, cmd_list);
614*5113495bSYour Name status = WLAN_SER_CMD_NOT_FOUND;
615*5113495bSYour Name break;
616*5113495bSYour Name }
617*5113495bSYour Name
618*5113495bSYour Name /* Cancel request received for a cmd in active
619*5113495bSYour Name * queue which has not been activated yet, we mark
620*5113495bSYour Name * it as CMD_ACTIVE_MARKED_FOR_CANCEL and remove
621*5113495bSYour Name * the cmd after activation
622*5113495bSYour Name */
623*5113495bSYour Name if (qdf_atomic_test_bit(CMD_MARKED_FOR_ACTIVATION,
624*5113495bSYour Name &cmd_list->cmd_in_use)) {
625*5113495bSYour Name qdf_atomic_set_bit(CMD_ACTIVE_MARKED_FOR_CANCEL,
626*5113495bSYour Name &cmd_list->cmd_in_use);
627*5113495bSYour Name status = WLAN_SER_CMD_MARKED_FOR_ACTIVATION;
628*5113495bSYour Name continue;
629*5113495bSYour Name }
630*5113495bSYour Name
631*5113495bSYour Name qdf_status = wlan_serialization_find_and_stop_timer(
632*5113495bSYour Name psoc, &cmd_list->cmd,
633*5113495bSYour Name SER_CANCEL);
634*5113495bSYour Name if (QDF_IS_STATUS_ERROR(qdf_status)) {
635*5113495bSYour Name ser_err("Can't find timer for active cmd");
636*5113495bSYour Name status = WLAN_SER_CMD_NOT_FOUND;
637*5113495bSYour Name /*
638*5113495bSYour Name * This should not happen, as an active command
639*5113495bSYour Name * should always have the timer.
640*5113495bSYour Name */
641*5113495bSYour Name QDF_BUG(0);
642*5113495bSYour Name break;
643*5113495bSYour Name }
644*5113495bSYour Name
645*5113495bSYour Name status = WLAN_SER_CMD_IN_ACTIVE_LIST;
646*5113495bSYour Name }
647*5113495bSYour Name
648*5113495bSYour Name qdf_mem_copy(&cmd_bkup, &cmd_list->cmd,
649*5113495bSYour Name sizeof(struct wlan_serialization_command));
650*5113495bSYour Name
651*5113495bSYour Name pdev_status =
652*5113495bSYour Name wlan_serialization_remove_node(pdev_queue,
653*5113495bSYour Name &cmd_list->pdev_node);
654*5113495bSYour Name
655*5113495bSYour Name ser_vdev_obj = wlan_serialization_get_vdev_obj(
656*5113495bSYour Name cmd_list->cmd.vdev);
657*5113495bSYour Name
658*5113495bSYour Name vdev_queue = wlan_serialization_get_list_from_vdev_queue(
659*5113495bSYour Name ser_vdev_obj, cmd_type, is_active_queue);
660*5113495bSYour Name
661*5113495bSYour Name vdev_status =
662*5113495bSYour Name wlan_serialization_remove_node(vdev_queue,
663*5113495bSYour Name &cmd_list->vdev_node);
664*5113495bSYour Name
665*5113495bSYour Name if (pdev_status != QDF_STATUS_SUCCESS ||
666*5113495bSYour Name vdev_status != QDF_STATUS_SUCCESS) {
667*5113495bSYour Name ser_err("can't remove cmd from pdev/vdev queue");
668*5113495bSYour Name status = WLAN_SER_CMD_NOT_FOUND;
669*5113495bSYour Name break;
670*5113495bSYour Name }
671*5113495bSYour Name
672*5113495bSYour Name qdf_mem_zero(&cmd_list->cmd,
673*5113495bSYour Name sizeof(struct wlan_serialization_command));
674*5113495bSYour Name cmd_list->cmd_in_use = 0;
675*5113495bSYour Name qdf_status = wlan_serialization_insert_back(
676*5113495bSYour Name &pdev_q->cmd_pool_list,
677*5113495bSYour Name &cmd_list->pdev_node);
678*5113495bSYour Name
679*5113495bSYour Name if (QDF_STATUS_SUCCESS != qdf_status) {
680*5113495bSYour Name ser_err("can't remove cmd from queue");
681*5113495bSYour Name status = WLAN_SER_CMD_NOT_FOUND;
682*5113495bSYour Name break;
683*5113495bSYour Name }
684*5113495bSYour Name nnode = pnode;
685*5113495bSYour Name
686*5113495bSYour Name vdev_id = wlan_vdev_get_id(cmd_bkup.vdev);
687*5113495bSYour Name is_blocking = cmd_bkup.is_blocking;
688*5113495bSYour Name
689*5113495bSYour Name wlan_ser_update_cmd_history(pdev_q, &cmd_bkup,
690*5113495bSYour Name SER_CANCEL, false, is_active_queue);
691*5113495bSYour Name
692*5113495bSYour Name wlan_serialization_release_lock(&pdev_q->pdev_queue_lock);
693*5113495bSYour Name /*
694*5113495bSYour Name * call pending cmd's callback to notify that
695*5113495bSYour Name * it is being removed
696*5113495bSYour Name */
697*5113495bSYour Name if (cmd_bkup.cmd_cb) {
698*5113495bSYour Name /* caller should now do necessary clean up */
699*5113495bSYour Name ser_debug("Cancel command: type %d id %d vdev %d and Release memory",
700*5113495bSYour Name cmd_bkup.cmd_type, cmd_bkup.cmd_id, vdev_id);
701*5113495bSYour Name cmd_bkup.cmd_cb(&cmd_bkup, WLAN_SER_CB_CANCEL_CMD);
702*5113495bSYour Name /* caller should release the memory */
703*5113495bSYour Name cmd_bkup.cmd_cb(&cmd_bkup, WLAN_SER_CB_RELEASE_MEM_CMD);
704*5113495bSYour Name }
705*5113495bSYour Name
706*5113495bSYour Name wlan_serialization_acquire_lock(&pdev_q->pdev_queue_lock);
707*5113495bSYour Name
708*5113495bSYour Name if (is_active_queue) {
709*5113495bSYour Name if (is_blocking)
710*5113495bSYour Name pdev_q->blocking_cmd_active = 0;
711*5113495bSYour Name
712*5113495bSYour Name qdf_clear_bit(vdev_id, pdev_q->vdev_active_cmd_bitmap);
713*5113495bSYour Name
714*5113495bSYour Name ser_debug("active_cmd_bitmap after resetting vdev %d",
715*5113495bSYour Name vdev_id);
716*5113495bSYour Name ser_debug_hex(pdev_q->vdev_active_cmd_bitmap,
717*5113495bSYour Name sizeof(pdev_q->vdev_active_cmd_bitmap));
718*5113495bSYour Name
719*5113495bSYour Name } else {
720*5113495bSYour Name if (is_blocking)
721*5113495bSYour Name pdev_q->blocking_cmd_waiting--;
722*5113495bSYour Name
723*5113495bSYour Name status = WLAN_SER_CMD_IN_PENDING_LIST;
724*5113495bSYour Name }
725*5113495bSYour Name
726*5113495bSYour Name
727*5113495bSYour Name if (!vdev && !pdev)
728*5113495bSYour Name break;
729*5113495bSYour Name }
730*5113495bSYour Name
731*5113495bSYour Name wlan_serialization_release_lock(&pdev_q->pdev_queue_lock);
732*5113495bSYour Name
733*5113495bSYour Name if (is_active_queue && wlan_serialization_list_empty(pdev_queue) &&
734*5113495bSYour Name !wlan_serialization_any_vdev_cmd_active(pdev_q)) {
735*5113495bSYour Name /*
736*5113495bSYour Name * Try to do reactive pdev pending list command to active list
737*5113495bSYour Name * since all active list commands are already canceled and no
738*5113495bSYour Name * active vdev commands.
739*5113495bSYour Name */
740*5113495bSYour Name wlan_ser_move_non_scan_pending_to_active(ser_pdev_obj,
741*5113495bSYour Name NULL, false);
742*5113495bSYour Name }
743*5113495bSYour Name
744*5113495bSYour Name return status;
745*5113495bSYour Name }
746*5113495bSYour Name
747*5113495bSYour Name bool
wlan_serialization_is_blocking_non_scan_cmd_waiting(struct wlan_objmgr_pdev * pdev)748*5113495bSYour Name wlan_serialization_is_blocking_non_scan_cmd_waiting(
749*5113495bSYour Name struct wlan_objmgr_pdev *pdev)
750*5113495bSYour Name {
751*5113495bSYour Name struct wlan_serialization_pdev_queue *pdev_queue;
752*5113495bSYour Name struct wlan_ser_pdev_obj *ser_pdev_obj;
753*5113495bSYour Name bool blocking_cmd_active = 0;
754*5113495bSYour Name uint8_t blocking_cmd_waiting = 0;
755*5113495bSYour Name
756*5113495bSYour Name ser_pdev_obj = wlan_serialization_get_pdev_obj(pdev);
757*5113495bSYour Name
758*5113495bSYour Name pdev_queue = wlan_serialization_get_pdev_queue_obj(
759*5113495bSYour Name ser_pdev_obj,
760*5113495bSYour Name WLAN_SER_CMD_NONSCAN);
761*5113495bSYour Name
762*5113495bSYour Name blocking_cmd_active = pdev_queue->blocking_cmd_active;
763*5113495bSYour Name blocking_cmd_waiting = pdev_queue->blocking_cmd_waiting;
764*5113495bSYour Name
765*5113495bSYour Name if (blocking_cmd_active || blocking_cmd_waiting)
766*5113495bSYour Name return true;
767*5113495bSYour Name
768*5113495bSYour Name return false;
769*5113495bSYour Name }
770