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