diff options
| author | WBI\nxf44444 <[email protected]> | 2022-01-26 01:43:05 +0800 |
|---|---|---|
| committer | WBI\nxf44444 <[email protected]> | 2022-01-26 01:43:05 +0800 |
| commit | 8b0f50b7e211ee32ab08ba085ecd74588c3a3c63 (patch) | |
| tree | 75440be5ecd30cc1403a9387851c0530ed057981 /components/drivers/src/workqueue.c | |
| parent | 3be35fecae513b07c35bd6f3992bf7824434bdd6 (diff) | |
| parent | 32a5668593c578b85560338c29d76f3a252c8dbc (diff) | |
Update i2c driver, add read ACK and BUS status check
Diffstat (limited to 'components/drivers/src/workqueue.c')
| -rw-r--r-- | components/drivers/src/workqueue.c | 429 |
1 files changed, 0 insertions, 429 deletions
diff --git a/components/drivers/src/workqueue.c b/components/drivers/src/workqueue.c deleted file mode 100644 index 2b5630d8d0..0000000000 --- a/components/drivers/src/workqueue.c +++ /dev/null @@ -1,429 +0,0 @@ -/* - * Copyright (c) 2006-2018, RT-Thread Development Team - * - * SPDX-License-Identifier: Apache-2.0 - * - * Change Logs: - * Date Author Notes - * 2017-02-27 bernard fix the re-work issue. - */ - -#include <rthw.h> -#include <rtthread.h> -#include <rtdevice.h> - -#ifdef RT_USING_HEAP - -static void _delayed_work_timeout_handler(void *parameter); - -rt_inline rt_err_t _workqueue_work_completion(struct rt_workqueue *queue) -{ - rt_err_t result; - - rt_enter_critical(); - while (1) - { - /* try to take condition semaphore */ - result = rt_sem_trytake(&(queue->sem)); - if (result == -RT_ETIMEOUT) - { - /* it's timeout, release this semaphore */ - rt_sem_release(&(queue->sem)); - } - else if (result == RT_EOK) - { - /* keep the sem value = 0 */ - result = RT_EOK; - break; - } - else - { - result = -RT_ERROR; - break; - } - } - rt_exit_critical(); - - return result; -} - -static void _workqueue_thread_entry(void *parameter) -{ - rt_base_t level; - struct rt_work *work; - struct rt_workqueue *queue; - - queue = (struct rt_workqueue *) parameter; - RT_ASSERT(queue != RT_NULL); - - while (1) - { - if (rt_list_isempty(&(queue->work_list))) - { - /* no software timer exist, suspend self. */ - rt_thread_suspend(rt_thread_self()); - rt_schedule(); - } - - /* we have work to do with. */ - level = rt_hw_interrupt_disable(); - work = rt_list_entry(queue->work_list.next, struct rt_work, list); - rt_list_remove(&(work->list)); - queue->work_current = work; - work->flags &= ~RT_WORK_STATE_PENDING; - work->workqueue = RT_NULL; - rt_hw_interrupt_enable(level); - - /* do work */ - work->work_func(work, work->work_data); - level = rt_hw_interrupt_disable(); - /* clean current work */ - queue->work_current = RT_NULL; - rt_hw_interrupt_enable(level); - - /* ack work completion */ - _workqueue_work_completion(queue); - } -} - -static rt_err_t _workqueue_submit_work(struct rt_workqueue *queue, struct rt_work *work) -{ - rt_base_t level; - - level = rt_hw_interrupt_disable(); - if (work->flags & RT_WORK_STATE_PENDING) - { - rt_hw_interrupt_enable(level); - return -RT_EBUSY; - } - - if (queue->work_current == work) - { - rt_hw_interrupt_enable(level); - return -RT_EBUSY; - } - - /* NOTE: the work MUST be initialized firstly */ - rt_list_remove(&(work->list)); - - rt_list_insert_after(queue->work_list.prev, &(work->list)); - work->flags |= RT_WORK_STATE_PENDING; - - /* whether the workqueue is doing work */ - if (queue->work_current == RT_NULL) - { - rt_hw_interrupt_enable(level); - /* resume work thread */ - rt_thread_resume(queue->work_thread); - rt_schedule(); - } - else - { - rt_hw_interrupt_enable(level); - } - - return RT_EOK; -} - -static rt_err_t _workqueue_cancel_work(struct rt_workqueue *queue, struct rt_work *work) -{ - rt_base_t level; - - level = rt_hw_interrupt_disable(); - if (queue->work_current == work) - { - rt_hw_interrupt_enable(level); - return -RT_EBUSY; - } - rt_list_remove(&(work->list)); - work->flags &= ~RT_WORK_STATE_PENDING; - rt_hw_interrupt_enable(level); - - return RT_EOK; -} - -static rt_err_t _workqueue_cancel_delayed_work(struct rt_work *work) -{ - rt_base_t level; - int ret = RT_EOK; - - if (!work->workqueue) - { - ret = -EINVAL; - goto __exit; - } - - if (work->flags & RT_WORK_STATE_PENDING) - { - /* Remove from the queue if already submitted */ - ret = _workqueue_cancel_work(work->workqueue, work); - if (ret) - { - goto __exit; - } - } - else - { - if (work->flags & RT_WORK_STATE_SUBMITTING) - { - level = rt_hw_interrupt_disable(); - rt_timer_stop(&(work->timer)); - rt_timer_detach(&(work->timer)); - work->flags &= ~RT_WORK_STATE_SUBMITTING; - rt_hw_interrupt_enable(level); - } - } - - level = rt_hw_interrupt_disable(); - /* Detach from workqueue */ - work->workqueue = RT_NULL; - work->flags &= ~(RT_WORK_STATE_PENDING); - rt_hw_interrupt_enable(level); - -__exit: - return ret; -} - -static rt_err_t _workqueue_submit_delayed_work(struct rt_workqueue *queue, - struct rt_work *work, rt_tick_t ticks) -{ - rt_base_t level; - rt_err_t ret = RT_EOK; - - /* Work cannot be active in multiple queues */ - if (work->workqueue && work->workqueue != queue) - { - ret = -RT_EINVAL; - goto __exit; - } - - /* Cancel if work has been submitted */ - if (work->workqueue == queue) - { - ret = _workqueue_cancel_delayed_work(work); - if (ret < 0) - { - goto __exit; - } - } - - level = rt_hw_interrupt_disable(); - /* Attach workqueue so the timeout callback can submit it */ - work->workqueue = queue; - rt_hw_interrupt_enable(level); - - if (!ticks) - { - /* Submit work if no ticks is 0 */ - ret = _workqueue_submit_work(work->workqueue, work); - } - else - { - level = rt_hw_interrupt_disable(); - /* Add timeout */ - work->flags |= RT_WORK_STATE_SUBMITTING; - rt_timer_init(&(work->timer), "work", _delayed_work_timeout_handler, work, ticks, - RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER); - rt_hw_interrupt_enable(level); - rt_timer_start(&(work->timer)); - } - -__exit: - return ret; -} - -static void _delayed_work_timeout_handler(void *parameter) -{ - struct rt_work *delayed_work; - rt_base_t level; - - delayed_work = (struct rt_work *)parameter; - level = rt_hw_interrupt_disable(); - rt_timer_stop(&(delayed_work->timer)); - rt_timer_detach(&(delayed_work->timer)); - delayed_work->flags &= ~RT_WORK_STATE_SUBMITTING; - delayed_work->type &= ~RT_WORK_TYPE_DELAYED; - rt_hw_interrupt_enable(level); - _workqueue_submit_work(delayed_work->workqueue, delayed_work); -} - -struct rt_workqueue *rt_workqueue_create(const char *name, rt_uint16_t stack_size, rt_uint8_t priority) -{ - struct rt_workqueue *queue = RT_NULL; - - queue = (struct rt_workqueue *)RT_KERNEL_MALLOC(sizeof(struct rt_workqueue)); - if (queue != RT_NULL) - { - /* initialize work list */ - rt_list_init(&(queue->work_list)); - queue->work_current = RT_NULL; - rt_sem_init(&(queue->sem), "wqueue", 0, RT_IPC_FLAG_FIFO); - - /* create the work thread */ - queue->work_thread = rt_thread_create(name, _workqueue_thread_entry, queue, stack_size, priority, 10); - if (queue->work_thread == RT_NULL) - { - RT_KERNEL_FREE(queue); - return RT_NULL; - } - - rt_thread_startup(queue->work_thread); - } - - return queue; -} - -rt_err_t rt_workqueue_destroy(struct rt_workqueue *queue) -{ - RT_ASSERT(queue != RT_NULL); - - rt_thread_delete(queue->work_thread); - RT_KERNEL_FREE(queue); - - return RT_EOK; -} - -rt_err_t rt_workqueue_dowork(struct rt_workqueue *queue, struct rt_work *work) -{ - RT_ASSERT(queue != RT_NULL); - RT_ASSERT(work != RT_NULL); - - return _workqueue_submit_work(queue, work); -} - -rt_err_t rt_workqueue_submit_work(struct rt_workqueue *queue, struct rt_work *work, rt_tick_t time) -{ - RT_ASSERT(queue != RT_NULL); - RT_ASSERT(work != RT_NULL); - - if (time > 0) - { - work->type |= RT_WORK_TYPE_DELAYED; - } - - if (work->type & RT_WORK_TYPE_DELAYED) - { - return _workqueue_submit_delayed_work(queue, work, time); - } - else - { - return _workqueue_submit_work(queue, work); - } -} - -rt_err_t rt_workqueue_critical_work(struct rt_workqueue *queue, struct rt_work *work) -{ - rt_base_t level; - RT_ASSERT(queue != RT_NULL); - RT_ASSERT(work != RT_NULL); - - level = rt_hw_interrupt_disable(); - if (queue->work_current == work) - { - rt_hw_interrupt_enable(level); - return -RT_EBUSY; - } - - /* NOTE: the work MUST be initialized firstly */ - rt_list_remove(&(work->list)); - - rt_list_insert_after(queue->work_list.prev, &(work->list)); - if (queue->work_current == RT_NULL) - { - rt_hw_interrupt_enable(level); - /* resume work thread */ - rt_thread_resume(queue->work_thread); - rt_schedule(); - } - else rt_hw_interrupt_enable(level); - - return RT_EOK; -} - -rt_err_t rt_workqueue_cancel_work(struct rt_workqueue *queue, struct rt_work *work) -{ - RT_ASSERT(queue != RT_NULL); - RT_ASSERT(work != RT_NULL); - - if (work->type & RT_WORK_TYPE_DELAYED) - { - return _workqueue_cancel_delayed_work(work); - } - else - { - return _workqueue_cancel_work(queue, work); - } -} - -rt_err_t rt_workqueue_cancel_work_sync(struct rt_workqueue *queue, struct rt_work *work) -{ - rt_base_t level; - - RT_ASSERT(queue != RT_NULL); - RT_ASSERT(work != RT_NULL); - - level = rt_hw_interrupt_disable(); - if (queue->work_current == work) /* it's current work in the queue */ - { - /* wait for work completion */ - rt_sem_take(&(queue->sem), RT_WAITING_FOREVER); - } - else - { - rt_list_remove(&(work->list)); - } - work->flags &= ~RT_WORK_STATE_PENDING; - rt_hw_interrupt_enable(level); - - return RT_EOK; -} - -rt_err_t rt_workqueue_cancel_all_work(struct rt_workqueue *queue) -{ - struct rt_list_node *node, *next; - RT_ASSERT(queue != RT_NULL); - - rt_enter_critical(); - for (node = queue->work_list.next; node != &(queue->work_list); node = next) - { - next = node->next; - rt_list_remove(node); - } - rt_exit_critical(); - - return RT_EOK; -} - -void rt_delayed_work_init(struct rt_delayed_work *work, void (*work_func)(struct rt_work *work, - void *work_data), void *work_data) -{ - rt_work_init(&work->work, work_func, work_data); -} - -#ifdef RT_USING_SYSTEM_WORKQUEUE -static struct rt_workqueue *sys_workq; - -rt_err_t rt_work_submit(struct rt_work *work, rt_tick_t time) -{ - return rt_workqueue_submit_work(sys_workq, work, time); -} - -rt_err_t rt_work_cancel(struct rt_work *work) -{ - return rt_workqueue_cancel_work(sys_workq, work); -} - -int rt_work_sys_workqueue_init(void) -{ - if (sys_workq != RT_NULL) - return 0; - - sys_workq = rt_workqueue_create("sys_work", RT_SYSTEM_WORKQUEUE_STACKSIZE, - RT_SYSTEM_WORKQUEUE_PRIORITY); - - return RT_EOK; -} - -INIT_PREV_EXPORT(rt_work_sys_workqueue_init); -#endif -#endif |
