123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180 |
- /****************************************************************************
- * sched/wqueue/kwork_queue.c
- *
- * Licensed to the Apache Software Foundation (ASF) under one or more
- * contributor license agreements. See the NOTICE file distributed with
- * this work for additional information regarding copyright ownership. The
- * ASF licenses this file to you under the Apache License, Version 2.0 (the
- * "License"); you may not use this file except in compliance with the
- * License. You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
- * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
- * License for the specific language governing permissions and limitations
- * under the License.
- *
- ****************************************************************************/
- /****************************************************************************
- * Included Files
- ****************************************************************************/
- #include <nuttx/config.h>
- #include <stdint.h>
- #include <queue.h>
- #include <assert.h>
- #include <errno.h>
- #include <nuttx/irq.h>
- #include <nuttx/arch.h>
- #include <nuttx/clock.h>
- #include <nuttx/wqueue.h>
- #include "wqueue/wqueue.h"
- #ifdef CONFIG_SCHED_WORKQUEUE
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: work_qqueue
- *
- * Description:
- * Queue work to be performed at a later time. All queued work will be
- * performed on the worker thread of execution (not the caller's).
- *
- * The work structure is allocated by caller, but completely managed by
- * the work queue logic. The caller should never modify the contents of
- * the work queue structure; the caller should not call work_qqueue()
- * again until either (1) the previous work has been performed and removed
- * from the queue, or (2) work_cancel() has been called to cancel the work
- * and remove it from the work queue.
- *
- * Input Parameters:
- * qid - The work queue ID (index)
- * work - The work structure to queue
- * worker - The worker callback to be invoked. The callback will invoked
- * on the worker thread of execution.
- * arg - The argument that will be passed to the workder callback when
- * int is invoked.
- * delay - Delay (in clock ticks) from the time queue until the worker
- * is invoked. Zero means to perform the work immediately.
- *
- * Returned Value:
- * None
- *
- ****************************************************************************/
- static void work_qqueue(FAR struct kwork_wqueue_s *wqueue,
- FAR struct work_s *work, worker_t worker,
- FAR void *arg, clock_t delay)
- {
- irqstate_t flags;
- DEBUGASSERT(work != NULL && worker != NULL);
- /* Interrupts are disabled so that this logic can be called from with
- * task logic or ifrom nterrupt handling logic.
- */
- flags = enter_critical_section();
- /* Is there already pending work? */
- if (work->worker != NULL)
- {
- /* Remove the entry from the work queue. It will re requeued at the
- * end of the work queue.
- */
- dq_rem((FAR dq_entry_t *)work, &wqueue->q);
- }
- /* Initialize the work structure. */
- work->worker = worker; /* Work callback. non-NULL means queued */
- work->arg = arg; /* Callback argument */
- work->delay = delay; /* Delay until work performed */
- /* Now, time-tag that entry and put it in the work queue */
- work->qtime = clock_systime_ticks(); /* Time work queued */
- dq_addlast((FAR dq_entry_t *)work, &wqueue->q);
- leave_critical_section(flags);
- }
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: work_queue
- *
- * Description:
- * Queue kernel-mode work to be performed at a later time. All queued
- * work will be performed on the worker thread of execution (not the
- * caller's).
- *
- * The work structure is allocated and must be initialized to all zero by
- * the caller. Otherwise, the work structure is completely managed by the
- * work queue logic. The caller should never modify the contents of the
- * work queue structure directly. If work_queue() is called before the
- * previous work as been performed and removed from the queue, then any
- * pending work will be canceled and lost.
- *
- * Input Parameters:
- * qid - The work queue ID (index)
- * work - The work structure to queue
- * worker - The worker callback to be invoked. The callback will invoked
- * on the worker thread of execution.
- * arg - The argument that will be passed to the workder callback when
- * int is invoked.
- * delay - Delay (in clock ticks) from the time queue until the worker
- * is invoked. Zero means to perform the work immediately.
- *
- * Returned Value:
- * Zero on success, a negated errno on failure
- *
- ****************************************************************************/
- int work_queue(int qid, FAR struct work_s *work, worker_t worker,
- FAR void *arg, clock_t delay)
- {
- /* Queue the new work */
- #ifdef CONFIG_SCHED_HPWORK
- if (qid == HPWORK)
- {
- /* Queue high priority work */
- work_qqueue((FAR struct kwork_wqueue_s *)&g_hpwork, work, worker,
- arg, delay);
- return work_signal(HPWORK);
- }
- else
- #endif
- #ifdef CONFIG_SCHED_LPWORK
- if (qid == LPWORK)
- {
- /* Queue low priority work */
- work_qqueue((FAR struct kwork_wqueue_s *)&g_lpwork, work, worker,
- arg, delay);
- return work_signal(LPWORK);
- }
- else
- #endif
- {
- return -EINVAL;
- }
- }
- #endif /* CONFIG_SCHED_WORKQUEUE */
|