xref: /wlan-driver/qca-wifi-host-cmn/scheduler/src/scheduler_api.c (revision 5113495b16420b49004c444715d2daae2066e7dc)
1*5113495bSYour Name /*
2*5113495bSYour Name  * Copyright (c) 2014-2021 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 #include <scheduler_api.h>
21*5113495bSYour Name #include <scheduler_core.h>
22*5113495bSYour Name #include <qdf_atomic.h>
23*5113495bSYour Name #include <qdf_module.h>
24*5113495bSYour Name #include <qdf_platform.h>
25*5113495bSYour Name 
26*5113495bSYour Name struct sched_qdf_mc_timer_cb_wrapper {
27*5113495bSYour Name 	qdf_mc_timer_callback_t timer_callback;
28*5113495bSYour Name 	void *data;
29*5113495bSYour Name };
30*5113495bSYour Name 
scheduler_disable(void)31*5113495bSYour Name QDF_STATUS scheduler_disable(void)
32*5113495bSYour Name {
33*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
34*5113495bSYour Name 
35*5113495bSYour Name 	sched_debug("Disabling Scheduler");
36*5113495bSYour Name 
37*5113495bSYour Name 	sched_ctx = scheduler_get_context();
38*5113495bSYour Name 	QDF_BUG(sched_ctx);
39*5113495bSYour Name 	if (!sched_ctx)
40*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
41*5113495bSYour Name 
42*5113495bSYour Name 	if (!sched_ctx->sch_thread) {
43*5113495bSYour Name 		sched_debug("Scheduler already disabled");
44*5113495bSYour Name 		return QDF_STATUS_SUCCESS;
45*5113495bSYour Name 	}
46*5113495bSYour Name 
47*5113495bSYour Name 	/* send shutdown signal to scheduler thread */
48*5113495bSYour Name 	qdf_atomic_set_bit(MC_SHUTDOWN_EVENT_MASK, &sched_ctx->sch_event_flag);
49*5113495bSYour Name 	qdf_atomic_set_bit(MC_POST_EVENT_MASK, &sched_ctx->sch_event_flag);
50*5113495bSYour Name 	qdf_wake_up_interruptible(&sched_ctx->sch_wait_queue);
51*5113495bSYour Name 
52*5113495bSYour Name 	/* wait for scheduler thread to shutdown */
53*5113495bSYour Name 	qdf_wait_single_event(&sched_ctx->sch_shutdown, 0);
54*5113495bSYour Name 	sched_ctx->sch_thread = NULL;
55*5113495bSYour Name 
56*5113495bSYour Name 	/* flush any unprocessed scheduler messages */
57*5113495bSYour Name 	scheduler_queues_flush(sched_ctx);
58*5113495bSYour Name 
59*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
60*5113495bSYour Name }
61*5113495bSYour Name 
scheduler_watchdog_notify(struct scheduler_ctx * sched)62*5113495bSYour Name static inline void scheduler_watchdog_notify(struct scheduler_ctx *sched)
63*5113495bSYour Name {
64*5113495bSYour Name 	char symbol[QDF_SYMBOL_LEN];
65*5113495bSYour Name 
66*5113495bSYour Name 	if (sched->watchdog_callback)
67*5113495bSYour Name 		qdf_sprint_symbol(symbol, sched->watchdog_callback);
68*5113495bSYour Name 
69*5113495bSYour Name 	sched_fatal("Callback %s (type 0x%x) exceeded its allotted time of %ds",
70*5113495bSYour Name 		    sched->watchdog_callback ? symbol : "<null>",
71*5113495bSYour Name 		    sched->watchdog_msg_type,
72*5113495bSYour Name 		    sched->timeout / 1000);
73*5113495bSYour Name }
74*5113495bSYour Name 
scheduler_watchdog_timeout(void * arg)75*5113495bSYour Name static void scheduler_watchdog_timeout(void *arg)
76*5113495bSYour Name {
77*5113495bSYour Name 	struct scheduler_ctx *sched = arg;
78*5113495bSYour Name 
79*5113495bSYour Name 	if (qdf_is_recovering()) {
80*5113495bSYour Name 		sched_debug("Recovery is in progress ignore timeout");
81*5113495bSYour Name 		return;
82*5113495bSYour Name 	}
83*5113495bSYour Name 
84*5113495bSYour Name 	scheduler_watchdog_notify(sched);
85*5113495bSYour Name 	if (sched->sch_thread)
86*5113495bSYour Name 		qdf_print_thread_trace(sched->sch_thread);
87*5113495bSYour Name 
88*5113495bSYour Name 	/* avoid crashing during shutdown */
89*5113495bSYour Name 	if (qdf_atomic_test_bit(MC_SHUTDOWN_EVENT_MASK, &sched->sch_event_flag))
90*5113495bSYour Name 		return;
91*5113495bSYour Name 
92*5113495bSYour Name 	sched_err("Triggering self recovery on sheduler timeout");
93*5113495bSYour Name 	qdf_trigger_self_recovery(NULL, QDF_SCHED_TIMEOUT);
94*5113495bSYour Name }
95*5113495bSYour Name 
scheduler_enable(void)96*5113495bSYour Name QDF_STATUS scheduler_enable(void)
97*5113495bSYour Name {
98*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
99*5113495bSYour Name 
100*5113495bSYour Name 	sched_debug("Enabling Scheduler");
101*5113495bSYour Name 
102*5113495bSYour Name 	sched_ctx = scheduler_get_context();
103*5113495bSYour Name 	QDF_BUG(sched_ctx);
104*5113495bSYour Name 	if (!sched_ctx)
105*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
106*5113495bSYour Name 
107*5113495bSYour Name 	qdf_atomic_clear_bit(MC_SHUTDOWN_EVENT_MASK,
108*5113495bSYour Name 			     &sched_ctx->sch_event_flag);
109*5113495bSYour Name 	qdf_atomic_clear_bit(MC_POST_EVENT_MASK,
110*5113495bSYour Name 			     &sched_ctx->sch_event_flag);
111*5113495bSYour Name 
112*5113495bSYour Name 	/* create the scheduler thread */
113*5113495bSYour Name 	sched_ctx->sch_thread = qdf_create_thread(scheduler_thread, sched_ctx,
114*5113495bSYour Name 						  "scheduler_thread");
115*5113495bSYour Name 	if (!sched_ctx->sch_thread) {
116*5113495bSYour Name 		sched_fatal("Failed to create scheduler thread");
117*5113495bSYour Name 		return QDF_STATUS_E_RESOURCES;
118*5113495bSYour Name 	}
119*5113495bSYour Name 
120*5113495bSYour Name 	sched_debug("Scheduler thread created");
121*5113495bSYour Name 
122*5113495bSYour Name 	/* wait for the scheduler thread to startup */
123*5113495bSYour Name 	qdf_wake_up_process(sched_ctx->sch_thread);
124*5113495bSYour Name 	qdf_wait_single_event(&sched_ctx->sch_start_event, 0);
125*5113495bSYour Name 
126*5113495bSYour Name 	sched_debug("Scheduler thread started");
127*5113495bSYour Name 
128*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
129*5113495bSYour Name }
130*5113495bSYour Name 
scheduler_init(void)131*5113495bSYour Name QDF_STATUS scheduler_init(void)
132*5113495bSYour Name {
133*5113495bSYour Name 	QDF_STATUS status;
134*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
135*5113495bSYour Name 
136*5113495bSYour Name 	sched_debug("Initializing Scheduler");
137*5113495bSYour Name 
138*5113495bSYour Name 	status = scheduler_create_ctx();
139*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
140*5113495bSYour Name 		sched_fatal("Failed to create context; status:%d", status);
141*5113495bSYour Name 		return status;
142*5113495bSYour Name 	}
143*5113495bSYour Name 
144*5113495bSYour Name 	sched_ctx = scheduler_get_context();
145*5113495bSYour Name 	QDF_BUG(sched_ctx);
146*5113495bSYour Name 	if (!sched_ctx) {
147*5113495bSYour Name 		status = QDF_STATUS_E_FAILURE;
148*5113495bSYour Name 		goto ctx_destroy;
149*5113495bSYour Name 	}
150*5113495bSYour Name 
151*5113495bSYour Name 	status = scheduler_queues_init(sched_ctx);
152*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
153*5113495bSYour Name 		sched_fatal("Failed to init queues; status:%d", status);
154*5113495bSYour Name 		goto ctx_destroy;
155*5113495bSYour Name 	}
156*5113495bSYour Name 
157*5113495bSYour Name 	status = qdf_event_create(&sched_ctx->sch_start_event);
158*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
159*5113495bSYour Name 		sched_fatal("Failed to create start event; status:%d", status);
160*5113495bSYour Name 		goto queues_deinit;
161*5113495bSYour Name 	}
162*5113495bSYour Name 
163*5113495bSYour Name 	status = qdf_event_create(&sched_ctx->sch_shutdown);
164*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
165*5113495bSYour Name 		sched_fatal("Failed to create shutdown event; status:%d",
166*5113495bSYour Name 			    status);
167*5113495bSYour Name 		goto start_event_destroy;
168*5113495bSYour Name 	}
169*5113495bSYour Name 
170*5113495bSYour Name 	status = qdf_event_create(&sched_ctx->resume_sch_event);
171*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
172*5113495bSYour Name 		sched_fatal("Failed to create resume event; status:%d", status);
173*5113495bSYour Name 		goto shutdown_event_destroy;
174*5113495bSYour Name 	}
175*5113495bSYour Name 
176*5113495bSYour Name 	qdf_spinlock_create(&sched_ctx->sch_thread_lock);
177*5113495bSYour Name 	qdf_init_waitqueue_head(&sched_ctx->sch_wait_queue);
178*5113495bSYour Name 	sched_ctx->sch_event_flag = 0;
179*5113495bSYour Name 	sched_ctx->timeout = SCHEDULER_WATCHDOG_TIMEOUT;
180*5113495bSYour Name 	qdf_timer_init(NULL,
181*5113495bSYour Name 		       &sched_ctx->watchdog_timer,
182*5113495bSYour Name 		       &scheduler_watchdog_timeout,
183*5113495bSYour Name 		       sched_ctx,
184*5113495bSYour Name 		       QDF_TIMER_TYPE_SW);
185*5113495bSYour Name 
186*5113495bSYour Name 	qdf_register_mc_timer_callback(scheduler_mc_timer_callback);
187*5113495bSYour Name 
188*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
189*5113495bSYour Name 
190*5113495bSYour Name shutdown_event_destroy:
191*5113495bSYour Name 	qdf_event_destroy(&sched_ctx->sch_shutdown);
192*5113495bSYour Name 
193*5113495bSYour Name start_event_destroy:
194*5113495bSYour Name 	qdf_event_destroy(&sched_ctx->sch_start_event);
195*5113495bSYour Name 
196*5113495bSYour Name queues_deinit:
197*5113495bSYour Name 	scheduler_queues_deinit(sched_ctx);
198*5113495bSYour Name 
199*5113495bSYour Name ctx_destroy:
200*5113495bSYour Name 	scheduler_destroy_ctx();
201*5113495bSYour Name 
202*5113495bSYour Name 	return status;
203*5113495bSYour Name }
204*5113495bSYour Name 
scheduler_deinit(void)205*5113495bSYour Name QDF_STATUS scheduler_deinit(void)
206*5113495bSYour Name {
207*5113495bSYour Name 	QDF_STATUS status;
208*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
209*5113495bSYour Name 
210*5113495bSYour Name 	sched_debug("Deinitializing Scheduler");
211*5113495bSYour Name 
212*5113495bSYour Name 	sched_ctx = scheduler_get_context();
213*5113495bSYour Name 	QDF_BUG(sched_ctx);
214*5113495bSYour Name 	if (!sched_ctx)
215*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
216*5113495bSYour Name 
217*5113495bSYour Name 	qdf_timer_free(&sched_ctx->watchdog_timer);
218*5113495bSYour Name 	qdf_spinlock_destroy(&sched_ctx->sch_thread_lock);
219*5113495bSYour Name 	qdf_event_destroy(&sched_ctx->resume_sch_event);
220*5113495bSYour Name 	qdf_event_destroy(&sched_ctx->sch_shutdown);
221*5113495bSYour Name 	qdf_event_destroy(&sched_ctx->sch_start_event);
222*5113495bSYour Name 
223*5113495bSYour Name 	status = scheduler_queues_deinit(sched_ctx);
224*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status))
225*5113495bSYour Name 		sched_err("Failed to deinit queues; status:%d", status);
226*5113495bSYour Name 
227*5113495bSYour Name 	status = scheduler_destroy_ctx();
228*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status))
229*5113495bSYour Name 		sched_err("Failed to destroy context; status:%d", status);
230*5113495bSYour Name 
231*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
232*5113495bSYour Name }
233*5113495bSYour Name 
scheduler_post_msg_by_priority(uint32_t qid,struct scheduler_msg * msg,bool is_high_priority)234*5113495bSYour Name QDF_STATUS scheduler_post_msg_by_priority(uint32_t qid,
235*5113495bSYour Name 					  struct scheduler_msg *msg,
236*5113495bSYour Name 					  bool is_high_priority)
237*5113495bSYour Name {
238*5113495bSYour Name 	uint8_t qidx;
239*5113495bSYour Name 	struct scheduler_mq_type *target_mq;
240*5113495bSYour Name 	struct scheduler_msg *queue_msg;
241*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
242*5113495bSYour Name 	uint16_t src_id;
243*5113495bSYour Name 	uint16_t dest_id;
244*5113495bSYour Name 	uint16_t que_id;
245*5113495bSYour Name 
246*5113495bSYour Name 	QDF_BUG(msg);
247*5113495bSYour Name 	if (!msg)
248*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
249*5113495bSYour Name 
250*5113495bSYour Name 	sched_ctx = scheduler_get_context();
251*5113495bSYour Name 	QDF_BUG(sched_ctx);
252*5113495bSYour Name 	if (!sched_ctx)
253*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
254*5113495bSYour Name 
255*5113495bSYour Name 	if (!sched_ctx->sch_thread) {
256*5113495bSYour Name 		sched_err("Cannot post message; scheduler thread is stopped");
257*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
258*5113495bSYour Name 	}
259*5113495bSYour Name 
260*5113495bSYour Name 	if (msg->reserved != 0 && msg->reserved != SYS_MSG_COOKIE) {
261*5113495bSYour Name 		QDF_DEBUG_PANIC("Scheduler messages must be initialized");
262*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
263*5113495bSYour Name 	}
264*5113495bSYour Name 
265*5113495bSYour Name 	dest_id = scheduler_get_dest_id(qid);
266*5113495bSYour Name 	src_id = scheduler_get_src_id(qid);
267*5113495bSYour Name 	que_id = scheduler_get_que_id(qid);
268*5113495bSYour Name 
269*5113495bSYour Name 	if (que_id >= QDF_MODULE_ID_MAX || src_id >= QDF_MODULE_ID_MAX ||
270*5113495bSYour Name 	    dest_id >= QDF_MODULE_ID_MAX) {
271*5113495bSYour Name 		sched_err("Src_id/Dest_id invalid, cannot post message");
272*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
273*5113495bSYour Name 	}
274*5113495bSYour Name 	/* Target_If is a special message queue in phase 3 convergence because
275*5113495bSYour Name 	 * its used by both legacy WMA and as well as new UMAC components which
276*5113495bSYour Name 	 * directly populate callback handlers in message body.
277*5113495bSYour Name 	 * 1) WMA legacy messages should not have callback
278*5113495bSYour Name 	 * 2) New target_if message needs to have valid callback
279*5113495bSYour Name 	 * Clear callback handler for legacy WMA messages such that in case
280*5113495bSYour Name 	 * if someone is sending legacy WMA message from stack which has
281*5113495bSYour Name 	 * uninitialized callback then its handled properly. Also change
282*5113495bSYour Name 	 * legacy WMA message queue id to target_if queue such that its  always
283*5113495bSYour Name 	 * handled in right order.
284*5113495bSYour Name 	 */
285*5113495bSYour Name 	if (QDF_MODULE_ID_WMA == que_id) {
286*5113495bSYour Name 		msg->callback = NULL;
287*5113495bSYour Name 		/* change legacy WMA message id to new target_if mq id */
288*5113495bSYour Name 		que_id = QDF_MODULE_ID_TARGET_IF;
289*5113495bSYour Name 	}
290*5113495bSYour Name 	qdf_mtrace(src_id, dest_id, msg->type, 0xFF, 0);
291*5113495bSYour Name 
292*5113495bSYour Name 	qidx = sched_ctx->queue_ctx.scheduler_msg_qid_to_qidx[que_id];
293*5113495bSYour Name 	if (qidx >= SCHEDULER_NUMBER_OF_MSG_QUEUE) {
294*5113495bSYour Name 		sched_err("Scheduler is deinitialized ignore msg");
295*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
296*5113495bSYour Name 	}
297*5113495bSYour Name 
298*5113495bSYour Name 	if (!sched_ctx->queue_ctx.scheduler_msg_process_fn[qidx]) {
299*5113495bSYour Name 		sched_err("callback not registered for qid[%d]", que_id);
300*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
301*5113495bSYour Name 	}
302*5113495bSYour Name 
303*5113495bSYour Name 	target_mq = &(sched_ctx->queue_ctx.sch_msg_q[qidx]);
304*5113495bSYour Name 
305*5113495bSYour Name 	queue_msg = scheduler_core_msg_dup(msg);
306*5113495bSYour Name 	if (!queue_msg)
307*5113495bSYour Name 		return QDF_STATUS_E_NOMEM;
308*5113495bSYour Name 
309*5113495bSYour Name 	if (is_high_priority)
310*5113495bSYour Name 		scheduler_mq_put_front(target_mq, queue_msg);
311*5113495bSYour Name 	else
312*5113495bSYour Name 		scheduler_mq_put(target_mq, queue_msg);
313*5113495bSYour Name 
314*5113495bSYour Name 	qdf_atomic_set_bit(MC_POST_EVENT_MASK, &sched_ctx->sch_event_flag);
315*5113495bSYour Name 	qdf_wake_up_interruptible(&sched_ctx->sch_wait_queue);
316*5113495bSYour Name 
317*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
318*5113495bSYour Name }
319*5113495bSYour Name 
scheduler_register_module(QDF_MODULE_ID qid,scheduler_msg_process_fn_t callback)320*5113495bSYour Name QDF_STATUS scheduler_register_module(QDF_MODULE_ID qid,
321*5113495bSYour Name 				     scheduler_msg_process_fn_t callback)
322*5113495bSYour Name {
323*5113495bSYour Name 	struct scheduler_mq_ctx *ctx;
324*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
325*5113495bSYour Name 
326*5113495bSYour Name 	sched_enter();
327*5113495bSYour Name 
328*5113495bSYour Name 	QDF_BUG(sched_ctx);
329*5113495bSYour Name 	if (!sched_ctx)
330*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
331*5113495bSYour Name 
332*5113495bSYour Name 	if (sched_ctx->sch_last_qidx >= SCHEDULER_NUMBER_OF_MSG_QUEUE) {
333*5113495bSYour Name 		sched_err("Already registered max %d no of message queues",
334*5113495bSYour Name 			  SCHEDULER_NUMBER_OF_MSG_QUEUE);
335*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
336*5113495bSYour Name 	}
337*5113495bSYour Name 
338*5113495bSYour Name 	ctx = &sched_ctx->queue_ctx;
339*5113495bSYour Name 	ctx->scheduler_msg_qid_to_qidx[qid] = sched_ctx->sch_last_qidx;
340*5113495bSYour Name 	ctx->sch_msg_q[sched_ctx->sch_last_qidx].qid = qid;
341*5113495bSYour Name 	ctx->scheduler_msg_process_fn[sched_ctx->sch_last_qidx] = callback;
342*5113495bSYour Name 	sched_ctx->sch_last_qidx++;
343*5113495bSYour Name 
344*5113495bSYour Name 	sched_exit();
345*5113495bSYour Name 
346*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
347*5113495bSYour Name }
348*5113495bSYour Name 
scheduler_deregister_module(QDF_MODULE_ID qid)349*5113495bSYour Name QDF_STATUS scheduler_deregister_module(QDF_MODULE_ID qid)
350*5113495bSYour Name {
351*5113495bSYour Name 	struct scheduler_mq_ctx *ctx;
352*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
353*5113495bSYour Name 	uint8_t qidx;
354*5113495bSYour Name 
355*5113495bSYour Name 	sched_enter();
356*5113495bSYour Name 
357*5113495bSYour Name 	QDF_BUG(sched_ctx);
358*5113495bSYour Name 	if (!sched_ctx)
359*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
360*5113495bSYour Name 
361*5113495bSYour Name 	ctx = &sched_ctx->queue_ctx;
362*5113495bSYour Name 	qidx = ctx->scheduler_msg_qid_to_qidx[qid];
363*5113495bSYour Name 	ctx->scheduler_msg_process_fn[qidx] = NULL;
364*5113495bSYour Name 	sched_ctx->sch_last_qidx--;
365*5113495bSYour Name 	ctx->scheduler_msg_qid_to_qidx[qidx] = SCHEDULER_NUMBER_OF_MSG_QUEUE;
366*5113495bSYour Name 
367*5113495bSYour Name 	sched_exit();
368*5113495bSYour Name 
369*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
370*5113495bSYour Name }
371*5113495bSYour Name 
scheduler_resume(void)372*5113495bSYour Name void scheduler_resume(void)
373*5113495bSYour Name {
374*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
375*5113495bSYour Name 
376*5113495bSYour Name 	if (sched_ctx)
377*5113495bSYour Name 		qdf_event_set(&sched_ctx->resume_sch_event);
378*5113495bSYour Name }
379*5113495bSYour Name 
scheduler_register_hdd_suspend_callback(hdd_suspend_callback callback)380*5113495bSYour Name void scheduler_register_hdd_suspend_callback(hdd_suspend_callback callback)
381*5113495bSYour Name {
382*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
383*5113495bSYour Name 
384*5113495bSYour Name 	if (sched_ctx)
385*5113495bSYour Name 		sched_ctx->hdd_callback = callback;
386*5113495bSYour Name }
scheduler_wake_up_controller_thread(void)387*5113495bSYour Name void scheduler_wake_up_controller_thread(void)
388*5113495bSYour Name {
389*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
390*5113495bSYour Name 
391*5113495bSYour Name 	if (sched_ctx)
392*5113495bSYour Name 		qdf_wake_up_interruptible(&sched_ctx->sch_wait_queue);
393*5113495bSYour Name }
scheduler_set_event_mask(uint32_t event_mask)394*5113495bSYour Name void scheduler_set_event_mask(uint32_t event_mask)
395*5113495bSYour Name {
396*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
397*5113495bSYour Name 
398*5113495bSYour Name 	if (sched_ctx)
399*5113495bSYour Name 		qdf_atomic_set_bit(event_mask, &sched_ctx->sch_event_flag);
400*5113495bSYour Name }
401*5113495bSYour Name 
scheduler_clear_event_mask(uint32_t event_mask)402*5113495bSYour Name void scheduler_clear_event_mask(uint32_t event_mask)
403*5113495bSYour Name {
404*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
405*5113495bSYour Name 
406*5113495bSYour Name 	if (sched_ctx)
407*5113495bSYour Name 		qdf_atomic_clear_bit(event_mask, &sched_ctx->sch_event_flag);
408*5113495bSYour Name }
409*5113495bSYour Name 
scheduler_target_if_mq_handler(struct scheduler_msg * msg)410*5113495bSYour Name QDF_STATUS scheduler_target_if_mq_handler(struct scheduler_msg *msg)
411*5113495bSYour Name {
412*5113495bSYour Name 	QDF_STATUS status;
413*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
414*5113495bSYour Name 	QDF_STATUS (*target_if_msg_handler)(struct scheduler_msg *);
415*5113495bSYour Name 
416*5113495bSYour Name 	QDF_BUG(msg);
417*5113495bSYour Name 	if (!msg)
418*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
419*5113495bSYour Name 
420*5113495bSYour Name 	QDF_BUG(sched_ctx);
421*5113495bSYour Name 	if (!sched_ctx)
422*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
423*5113495bSYour Name 
424*5113495bSYour Name 	target_if_msg_handler = msg->callback;
425*5113495bSYour Name 
426*5113495bSYour Name 	/* Target_If is a special message queue in phase 3 convergence because
427*5113495bSYour Name 	 * its used by both legacy WMA and as well as new UMAC components. New
428*5113495bSYour Name 	 * UMAC components directly pass their message handlers as callback in
429*5113495bSYour Name 	 * message body.
430*5113495bSYour Name 	 * 1) All Legacy WMA messages do not contain message callback so invoke
431*5113495bSYour Name 	 *    registered legacy WMA handler. Scheduler message posting APIs
432*5113495bSYour Name 	 *    makes sure legacy WMA messages do not have callbacks.
433*5113495bSYour Name 	 * 2) For new messages which have valid callbacks invoke their callbacks
434*5113495bSYour Name 	 *    directly.
435*5113495bSYour Name 	 */
436*5113495bSYour Name 	if (!target_if_msg_handler)
437*5113495bSYour Name 		status = sched_ctx->legacy_wma_handler(msg);
438*5113495bSYour Name 	else
439*5113495bSYour Name 		status = target_if_msg_handler(msg);
440*5113495bSYour Name 
441*5113495bSYour Name 	return status;
442*5113495bSYour Name }
443*5113495bSYour Name 
scheduler_os_if_mq_handler(struct scheduler_msg * msg)444*5113495bSYour Name QDF_STATUS scheduler_os_if_mq_handler(struct scheduler_msg *msg)
445*5113495bSYour Name {
446*5113495bSYour Name 	QDF_STATUS (*os_if_msg_handler)(struct scheduler_msg *);
447*5113495bSYour Name 
448*5113495bSYour Name 	QDF_BUG(msg);
449*5113495bSYour Name 	if (!msg)
450*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
451*5113495bSYour Name 
452*5113495bSYour Name 	os_if_msg_handler = msg->callback;
453*5113495bSYour Name 
454*5113495bSYour Name 	QDF_BUG(os_if_msg_handler);
455*5113495bSYour Name 	if (!os_if_msg_handler)
456*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
457*5113495bSYour Name 
458*5113495bSYour Name 	os_if_msg_handler(msg);
459*5113495bSYour Name 
460*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
461*5113495bSYour Name }
462*5113495bSYour Name 
scheduler_qdf_mc_timer_init(qdf_mc_timer_callback_t timer_callback,void * data)463*5113495bSYour Name struct sched_qdf_mc_timer_cb_wrapper *scheduler_qdf_mc_timer_init(
464*5113495bSYour Name 		qdf_mc_timer_callback_t timer_callback,
465*5113495bSYour Name 		void *data)
466*5113495bSYour Name {
467*5113495bSYour Name 	struct sched_qdf_mc_timer_cb_wrapper *wrapper_ptr;
468*5113495bSYour Name 
469*5113495bSYour Name 	wrapper_ptr = qdf_mem_malloc(sizeof(*wrapper_ptr));
470*5113495bSYour Name 	if (!wrapper_ptr)
471*5113495bSYour Name 		return NULL;
472*5113495bSYour Name 
473*5113495bSYour Name 	wrapper_ptr->timer_callback = timer_callback;
474*5113495bSYour Name 	wrapper_ptr->data = data;
475*5113495bSYour Name 	return wrapper_ptr;
476*5113495bSYour Name }
477*5113495bSYour Name 
scheduler_qdf_mc_timer_deinit_return_data_ptr(struct sched_qdf_mc_timer_cb_wrapper * wrapper_ptr)478*5113495bSYour Name void *scheduler_qdf_mc_timer_deinit_return_data_ptr(
479*5113495bSYour Name 		struct sched_qdf_mc_timer_cb_wrapper *wrapper_ptr)
480*5113495bSYour Name {
481*5113495bSYour Name 	void *data_ptr;
482*5113495bSYour Name 
483*5113495bSYour Name 	if (!wrapper_ptr) {
484*5113495bSYour Name 		sched_err("pointer to wrapper ptr is NULL");
485*5113495bSYour Name 		return NULL;
486*5113495bSYour Name 	}
487*5113495bSYour Name 
488*5113495bSYour Name 	data_ptr = wrapper_ptr->data;
489*5113495bSYour Name 	qdf_mem_free(wrapper_ptr);
490*5113495bSYour Name 	return data_ptr;
491*5113495bSYour Name }
492*5113495bSYour Name 
scheduler_qdf_mc_timer_callback_t_wrapper(struct scheduler_msg * msg)493*5113495bSYour Name QDF_STATUS scheduler_qdf_mc_timer_callback_t_wrapper(struct scheduler_msg *msg)
494*5113495bSYour Name {
495*5113495bSYour Name 	struct sched_qdf_mc_timer_cb_wrapper *mc_timer_wrapper;
496*5113495bSYour Name 	qdf_mc_timer_callback_t timer_cb;
497*5113495bSYour Name 
498*5113495bSYour Name 	mc_timer_wrapper = msg->bodyptr;
499*5113495bSYour Name 	if (!mc_timer_wrapper) {
500*5113495bSYour Name 		sched_err("NULL mc_timer_wrapper from msg body");
501*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
502*5113495bSYour Name 	}
503*5113495bSYour Name 
504*5113495bSYour Name 	timer_cb = mc_timer_wrapper->timer_callback;
505*5113495bSYour Name 
506*5113495bSYour Name 	QDF_BUG(timer_cb);
507*5113495bSYour Name 	if (!timer_cb)
508*5113495bSYour Name 		goto sched_qdf_mc_timer_err;
509*5113495bSYour Name 
510*5113495bSYour Name 	timer_cb(mc_timer_wrapper->data);
511*5113495bSYour Name 
512*5113495bSYour Name 	qdf_mem_free(mc_timer_wrapper);
513*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
514*5113495bSYour Name 
515*5113495bSYour Name sched_qdf_mc_timer_err:
516*5113495bSYour Name 	sched_err("failed to get timer cb is NULL");
517*5113495bSYour Name 	qdf_mem_free(mc_timer_wrapper);
518*5113495bSYour Name 	return QDF_STATUS_E_FAILURE;
519*5113495bSYour Name }
520*5113495bSYour Name 
scheduler_timer_q_mq_handler(struct scheduler_msg * msg)521*5113495bSYour Name QDF_STATUS scheduler_timer_q_mq_handler(struct scheduler_msg *msg)
522*5113495bSYour Name {
523*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
524*5113495bSYour Name 	scheduler_msg_process_fn_t sched_mc_timer_callback;
525*5113495bSYour Name 
526*5113495bSYour Name 	QDF_BUG(msg);
527*5113495bSYour Name 	if (!msg)
528*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
529*5113495bSYour Name 
530*5113495bSYour Name 	QDF_BUG(sched_ctx);
531*5113495bSYour Name 	if (!sched_ctx)
532*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
533*5113495bSYour Name 
534*5113495bSYour Name 	/* legacy sys message handler? */
535*5113495bSYour Name 	if (msg->reserved != SYS_MSG_COOKIE || msg->type != SYS_MSG_ID_MC_TIMER)
536*5113495bSYour Name 		return sched_ctx->legacy_sys_handler(msg);
537*5113495bSYour Name 
538*5113495bSYour Name 	sched_mc_timer_callback = msg->callback;
539*5113495bSYour Name 	QDF_BUG(sched_mc_timer_callback);
540*5113495bSYour Name 	if (!sched_mc_timer_callback)
541*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
542*5113495bSYour Name 
543*5113495bSYour Name 	return sched_mc_timer_callback(msg);
544*5113495bSYour Name }
545*5113495bSYour Name 
scheduler_mlme_mq_handler(struct scheduler_msg * msg)546*5113495bSYour Name QDF_STATUS scheduler_mlme_mq_handler(struct scheduler_msg *msg)
547*5113495bSYour Name {
548*5113495bSYour Name 	scheduler_msg_process_fn_t mlme_msg_handler;
549*5113495bSYour Name 
550*5113495bSYour Name 	QDF_BUG(msg);
551*5113495bSYour Name 	if (!msg)
552*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
553*5113495bSYour Name 
554*5113495bSYour Name 	mlme_msg_handler = msg->callback;
555*5113495bSYour Name 
556*5113495bSYour Name 	QDF_BUG(mlme_msg_handler);
557*5113495bSYour Name 	if (!mlme_msg_handler)
558*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
559*5113495bSYour Name 
560*5113495bSYour Name 	mlme_msg_handler(msg);
561*5113495bSYour Name 
562*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
563*5113495bSYour Name }
564*5113495bSYour Name 
scheduler_scan_mq_handler(struct scheduler_msg * msg)565*5113495bSYour Name QDF_STATUS scheduler_scan_mq_handler(struct scheduler_msg *msg)
566*5113495bSYour Name {
567*5113495bSYour Name 	QDF_STATUS (*scan_q_msg_handler)(struct scheduler_msg *);
568*5113495bSYour Name 
569*5113495bSYour Name 	QDF_BUG(msg);
570*5113495bSYour Name 	if (!msg)
571*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
572*5113495bSYour Name 
573*5113495bSYour Name 	scan_q_msg_handler = msg->callback;
574*5113495bSYour Name 
575*5113495bSYour Name 	QDF_BUG(scan_q_msg_handler);
576*5113495bSYour Name 	if (!scan_q_msg_handler)
577*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
578*5113495bSYour Name 
579*5113495bSYour Name 	scan_q_msg_handler(msg);
580*5113495bSYour Name 
581*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
582*5113495bSYour Name }
583*5113495bSYour Name 
scheduler_set_watchdog_timeout(uint32_t timeout)584*5113495bSYour Name void scheduler_set_watchdog_timeout(uint32_t timeout)
585*5113495bSYour Name {
586*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
587*5113495bSYour Name 
588*5113495bSYour Name 	QDF_BUG(sched_ctx);
589*5113495bSYour Name 	if (!sched_ctx)
590*5113495bSYour Name 		return;
591*5113495bSYour Name 
592*5113495bSYour Name 	sched_ctx->timeout = timeout;
593*5113495bSYour Name }
594*5113495bSYour Name 
scheduler_register_wma_legacy_handler(scheduler_msg_process_fn_t wma_callback)595*5113495bSYour Name QDF_STATUS scheduler_register_wma_legacy_handler(scheduler_msg_process_fn_t
596*5113495bSYour Name 						wma_callback)
597*5113495bSYour Name {
598*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
599*5113495bSYour Name 
600*5113495bSYour Name 	QDF_BUG(sched_ctx);
601*5113495bSYour Name 	if (!sched_ctx)
602*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
603*5113495bSYour Name 
604*5113495bSYour Name 	sched_ctx->legacy_wma_handler = wma_callback;
605*5113495bSYour Name 
606*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
607*5113495bSYour Name }
608*5113495bSYour Name 
scheduler_register_sys_legacy_handler(scheduler_msg_process_fn_t sys_callback)609*5113495bSYour Name QDF_STATUS scheduler_register_sys_legacy_handler(scheduler_msg_process_fn_t
610*5113495bSYour Name 						sys_callback)
611*5113495bSYour Name {
612*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
613*5113495bSYour Name 
614*5113495bSYour Name 	QDF_BUG(sched_ctx);
615*5113495bSYour Name 	if (!sched_ctx)
616*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
617*5113495bSYour Name 
618*5113495bSYour Name 	sched_ctx->legacy_sys_handler = sys_callback;
619*5113495bSYour Name 
620*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
621*5113495bSYour Name }
622*5113495bSYour Name 
scheduler_deregister_wma_legacy_handler(void)623*5113495bSYour Name QDF_STATUS scheduler_deregister_wma_legacy_handler(void)
624*5113495bSYour Name {
625*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
626*5113495bSYour Name 
627*5113495bSYour Name 	QDF_BUG(sched_ctx);
628*5113495bSYour Name 	if (!sched_ctx)
629*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
630*5113495bSYour Name 
631*5113495bSYour Name 	sched_ctx->legacy_wma_handler = NULL;
632*5113495bSYour Name 
633*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
634*5113495bSYour Name }
635*5113495bSYour Name 
scheduler_deregister_sys_legacy_handler(void)636*5113495bSYour Name QDF_STATUS scheduler_deregister_sys_legacy_handler(void)
637*5113495bSYour Name {
638*5113495bSYour Name 	struct scheduler_ctx *sched_ctx = scheduler_get_context();
639*5113495bSYour Name 
640*5113495bSYour Name 	QDF_BUG(sched_ctx);
641*5113495bSYour Name 	if (!sched_ctx)
642*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
643*5113495bSYour Name 
644*5113495bSYour Name 	sched_ctx->legacy_sys_handler = NULL;
645*5113495bSYour Name 
646*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
647*5113495bSYour Name }
648*5113495bSYour Name 
scheduler_msg_flush_mc(struct scheduler_msg * msg)649*5113495bSYour Name static QDF_STATUS scheduler_msg_flush_mc(struct scheduler_msg *msg)
650*5113495bSYour Name {
651*5113495bSYour Name 	scheduler_qdf_mc_timer_deinit_return_data_ptr(msg->bodyptr);
652*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
653*5113495bSYour Name }
654*5113495bSYour Name 
scheduler_mc_timer_callback(qdf_mc_timer_t * timer)655*5113495bSYour Name void scheduler_mc_timer_callback(qdf_mc_timer_t *timer)
656*5113495bSYour Name {
657*5113495bSYour Name 	struct scheduler_msg msg = {0};
658*5113495bSYour Name 	QDF_STATUS status;
659*5113495bSYour Name 	struct sched_qdf_mc_timer_cb_wrapper *mc_timer_wrapper;
660*5113495bSYour Name 	qdf_mc_timer_callback_t callback = NULL;
661*5113495bSYour Name 	void *user_data = NULL;
662*5113495bSYour Name 	QDF_TIMER_TYPE type = QDF_TIMER_TYPE_SW;
663*5113495bSYour Name 
664*5113495bSYour Name 	QDF_BUG(timer);
665*5113495bSYour Name 	if (!timer)
666*5113495bSYour Name 		return;
667*5113495bSYour Name 
668*5113495bSYour Name 	/*
669*5113495bSYour Name 	 * Save the jiffies value in a per-timer context in qdf_mc_timer_t.
670*5113495bSYour Name 	 * It will help the debugger to know the exact time at which the host
671*5113495bSYour Name 	 * stops/expiry of the QDF timer.
672*5113495bSYour Name 	 */
673*5113495bSYour Name 	timer->timer_end_jiffies = jiffies;
674*5113495bSYour Name 
675*5113495bSYour Name 	qdf_spin_lock_irqsave(&timer->platform_info.spinlock);
676*5113495bSYour Name 
677*5113495bSYour Name 	switch (timer->state) {
678*5113495bSYour Name 	case QDF_TIMER_STATE_STARTING:
679*5113495bSYour Name 		/* we are in this state because someone just started the timer,
680*5113495bSYour Name 		 * MC timer got started and expired, but the time content have
681*5113495bSYour Name 		 * not been updated this is a rare race condition!
682*5113495bSYour Name 		 */
683*5113495bSYour Name 		timer->state = QDF_TIMER_STATE_STOPPED;
684*5113495bSYour Name 		status = QDF_STATUS_E_ALREADY;
685*5113495bSYour Name 		break;
686*5113495bSYour Name 
687*5113495bSYour Name 	case QDF_TIMER_STATE_STOPPED:
688*5113495bSYour Name 		status = QDF_STATUS_E_ALREADY;
689*5113495bSYour Name 		break;
690*5113495bSYour Name 
691*5113495bSYour Name 	case QDF_TIMER_STATE_UNUSED:
692*5113495bSYour Name 		status = QDF_STATUS_E_EXISTS;
693*5113495bSYour Name 		break;
694*5113495bSYour Name 
695*5113495bSYour Name 	case QDF_TIMER_STATE_RUNNING:
696*5113495bSYour Name 		/* need to go to stop state here because the call-back function
697*5113495bSYour Name 		 * may restart timer (to emulate periodic timer)
698*5113495bSYour Name 		 */
699*5113495bSYour Name 		timer->state = QDF_TIMER_STATE_STOPPED;
700*5113495bSYour Name 		/* copy the relevant timer information to local variables;
701*5113495bSYour Name 		 * once we exits from this critical section, the timer content
702*5113495bSYour Name 		 * may be modified by other tasks
703*5113495bSYour Name 		 */
704*5113495bSYour Name 		callback = timer->callback;
705*5113495bSYour Name 		user_data = timer->user_data;
706*5113495bSYour Name 		type = timer->type;
707*5113495bSYour Name 		status = QDF_STATUS_SUCCESS;
708*5113495bSYour Name 		break;
709*5113495bSYour Name 
710*5113495bSYour Name 	default:
711*5113495bSYour Name 		QDF_ASSERT(0);
712*5113495bSYour Name 		status = QDF_STATUS_E_FAULT;
713*5113495bSYour Name 		break;
714*5113495bSYour Name 	}
715*5113495bSYour Name 
716*5113495bSYour Name 	qdf_spin_unlock_irqrestore(&timer->platform_info.spinlock);
717*5113495bSYour Name 
718*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
719*5113495bSYour Name 		sched_debug("MC timer fired but is not running; skip callback");
720*5113495bSYour Name 		return;
721*5113495bSYour Name 	}
722*5113495bSYour Name 
723*5113495bSYour Name 	qdf_try_allowing_sleep(type);
724*5113495bSYour Name 
725*5113495bSYour Name 	QDF_BUG(callback);
726*5113495bSYour Name 	if (!callback)
727*5113495bSYour Name 		return;
728*5113495bSYour Name 
729*5113495bSYour Name 	mc_timer_wrapper = scheduler_qdf_mc_timer_init(callback, user_data);
730*5113495bSYour Name 	if (!mc_timer_wrapper) {
731*5113495bSYour Name 		sched_err("failed to allocate sched_qdf_mc_timer_cb_wrapper");
732*5113495bSYour Name 		return;
733*5113495bSYour Name 	}
734*5113495bSYour Name 
735*5113495bSYour Name 	/* serialize to scheduler controller thread */
736*5113495bSYour Name 	msg.type = SYS_MSG_ID_MC_TIMER;
737*5113495bSYour Name 	msg.reserved = SYS_MSG_COOKIE;
738*5113495bSYour Name 	msg.callback = scheduler_qdf_mc_timer_callback_t_wrapper;
739*5113495bSYour Name 	msg.bodyptr = mc_timer_wrapper;
740*5113495bSYour Name 	msg.bodyval = 0;
741*5113495bSYour Name 	msg.flush_callback = scheduler_msg_flush_mc;
742*5113495bSYour Name 
743*5113495bSYour Name 	status = scheduler_post_message(QDF_MODULE_ID_SCHEDULER,
744*5113495bSYour Name 					QDF_MODULE_ID_SCHEDULER,
745*5113495bSYour Name 					QDF_MODULE_ID_SYS, &msg);
746*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status)) {
747*5113495bSYour Name 		sched_err("Could not enqueue timer to timer queue");
748*5113495bSYour Name 		qdf_mem_free(mc_timer_wrapper);
749*5113495bSYour Name 	}
750*5113495bSYour Name }
751*5113495bSYour Name 
scheduler_get_queue_size(QDF_MODULE_ID qid,uint32_t * size)752*5113495bSYour Name QDF_STATUS scheduler_get_queue_size(QDF_MODULE_ID qid, uint32_t *size)
753*5113495bSYour Name {
754*5113495bSYour Name 	uint8_t qidx;
755*5113495bSYour Name 	struct scheduler_mq_type *target_mq;
756*5113495bSYour Name 	struct scheduler_ctx *sched_ctx;
757*5113495bSYour Name 
758*5113495bSYour Name 	sched_ctx = scheduler_get_context();
759*5113495bSYour Name 	if (!sched_ctx)
760*5113495bSYour Name 		return QDF_STATUS_E_INVAL;
761*5113495bSYour Name 
762*5113495bSYour Name 	/* WMA also uses the target_if queue, so replace the QID */
763*5113495bSYour Name 	if (QDF_MODULE_ID_WMA == qid)
764*5113495bSYour Name 		qid = QDF_MODULE_ID_TARGET_IF;
765*5113495bSYour Name 
766*5113495bSYour Name 	qidx = sched_ctx->queue_ctx.scheduler_msg_qid_to_qidx[qid];
767*5113495bSYour Name 	if (qidx >= SCHEDULER_NUMBER_OF_MSG_QUEUE) {
768*5113495bSYour Name 		sched_err("Scheduler is deinitialized");
769*5113495bSYour Name 		return QDF_STATUS_E_FAILURE;
770*5113495bSYour Name 	}
771*5113495bSYour Name 
772*5113495bSYour Name 	target_mq = &(sched_ctx->queue_ctx.sch_msg_q[qidx]);
773*5113495bSYour Name 
774*5113495bSYour Name 	*size = qdf_list_size(&target_mq->mq_list);
775*5113495bSYour Name 
776*5113495bSYour Name 	return QDF_STATUS_SUCCESS;
777*5113495bSYour Name }
778*5113495bSYour Name 
scheduler_post_message_debug(QDF_MODULE_ID src_id,QDF_MODULE_ID dest_id,QDF_MODULE_ID que_id,struct scheduler_msg * msg,int line,const char * func)779*5113495bSYour Name QDF_STATUS scheduler_post_message_debug(QDF_MODULE_ID src_id,
780*5113495bSYour Name 					QDF_MODULE_ID dest_id,
781*5113495bSYour Name 					QDF_MODULE_ID que_id,
782*5113495bSYour Name 					struct scheduler_msg *msg,
783*5113495bSYour Name 					int line,
784*5113495bSYour Name 					const char *func)
785*5113495bSYour Name {
786*5113495bSYour Name 	QDF_STATUS status;
787*5113495bSYour Name 
788*5113495bSYour Name 	status = scheduler_post_msg(scheduler_get_qid(src_id, dest_id, que_id),
789*5113495bSYour Name 				    msg);
790*5113495bSYour Name 
791*5113495bSYour Name 	if (QDF_IS_STATUS_ERROR(status))
792*5113495bSYour Name 		sched_err("couldn't post from %d to %d - called from %d, %s",
793*5113495bSYour Name 			  src_id, dest_id, line, func);
794*5113495bSYour Name 
795*5113495bSYour Name 	return status;
796*5113495bSYour Name }
797*5113495bSYour Name 
798*5113495bSYour Name qdf_export_symbol(scheduler_post_message_debug);
799