| 1 | /* | 
|---|
| 2 | * Copyright (C) 2013 Red Hat | 
|---|
| 3 | * | 
|---|
| 4 | * Permission is hereby granted, free of charge, to any person obtaining a | 
|---|
| 5 | * copy of this software and associated documentation files (the "Software"), | 
|---|
| 6 | * to deal in the Software without restriction, including without limitation | 
|---|
| 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, | 
|---|
| 8 | * and/or sell copies of the Software, and to permit persons to whom the | 
|---|
| 9 | * Software is furnished to do so, subject to the following conditions: | 
|---|
| 10 | * | 
|---|
| 11 | * The above copyright notice and this permission notice (including the next | 
|---|
| 12 | * paragraph) shall be included in all copies or substantial portions of the | 
|---|
| 13 | * Software. | 
|---|
| 14 | * | 
|---|
| 15 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | 
|---|
| 16 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | 
|---|
| 17 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL | 
|---|
| 18 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | 
|---|
| 19 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | 
|---|
| 20 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | 
|---|
| 21 | * SOFTWARE. | 
|---|
| 22 | */ | 
|---|
| 23 |  | 
|---|
| 24 | #include <linux/export.h> | 
|---|
| 25 | #include <linux/slab.h> | 
|---|
| 26 |  | 
|---|
| 27 | #include <drm/drm_flip_work.h> | 
|---|
| 28 | #include <drm/drm_print.h> | 
|---|
| 29 | #include <drm/drm_util.h> | 
|---|
| 30 |  | 
|---|
| 31 | struct drm_flip_task { | 
|---|
| 32 | struct list_head node; | 
|---|
| 33 | void *data; | 
|---|
| 34 | }; | 
|---|
| 35 |  | 
|---|
| 36 | static struct drm_flip_task *drm_flip_work_allocate_task(void *data, gfp_t flags) | 
|---|
| 37 | { | 
|---|
| 38 | struct drm_flip_task *task; | 
|---|
| 39 |  | 
|---|
| 40 | task = kzalloc(sizeof(*task), flags); | 
|---|
| 41 | if (task) | 
|---|
| 42 | task->data = data; | 
|---|
| 43 |  | 
|---|
| 44 | return task; | 
|---|
| 45 | } | 
|---|
| 46 |  | 
|---|
| 47 | static void drm_flip_work_queue_task(struct drm_flip_work *work, struct drm_flip_task *task) | 
|---|
| 48 | { | 
|---|
| 49 | unsigned long flags; | 
|---|
| 50 |  | 
|---|
| 51 | spin_lock_irqsave(&work->lock, flags); | 
|---|
| 52 | list_add_tail(new: &task->node, head: &work->queued); | 
|---|
| 53 | spin_unlock_irqrestore(lock: &work->lock, flags); | 
|---|
| 54 | } | 
|---|
| 55 |  | 
|---|
| 56 | /** | 
|---|
| 57 | * drm_flip_work_queue - queue work | 
|---|
| 58 | * @work: the flip-work | 
|---|
| 59 | * @val: the value to queue | 
|---|
| 60 | * | 
|---|
| 61 | * Queues work, that will later be run (passed back to drm_flip_func_t | 
|---|
| 62 | * func) on a work queue after drm_flip_work_commit() is called. | 
|---|
| 63 | */ | 
|---|
| 64 | void drm_flip_work_queue(struct drm_flip_work *work, void *val) | 
|---|
| 65 | { | 
|---|
| 66 | struct drm_flip_task *task; | 
|---|
| 67 |  | 
|---|
| 68 | task = drm_flip_work_allocate_task(data: val, | 
|---|
| 69 | flags: drm_can_sleep() ? GFP_KERNEL : GFP_ATOMIC); | 
|---|
| 70 | if (task) { | 
|---|
| 71 | drm_flip_work_queue_task(work, task); | 
|---|
| 72 | } else { | 
|---|
| 73 | DRM_ERROR( "%s could not allocate task!\n", work->name); | 
|---|
| 74 | work->func(work, val); | 
|---|
| 75 | } | 
|---|
| 76 | } | 
|---|
| 77 | EXPORT_SYMBOL(drm_flip_work_queue); | 
|---|
| 78 |  | 
|---|
| 79 | /** | 
|---|
| 80 | * drm_flip_work_commit - commit queued work | 
|---|
| 81 | * @work: the flip-work | 
|---|
| 82 | * @wq: the work-queue to run the queued work on | 
|---|
| 83 | * | 
|---|
| 84 | * Trigger work previously queued by drm_flip_work_queue() to run | 
|---|
| 85 | * on a workqueue.  The typical usage would be to queue work (via | 
|---|
| 86 | * drm_flip_work_queue()) at any point (from vblank irq and/or | 
|---|
| 87 | * prior), and then from vblank irq commit the queued work. | 
|---|
| 88 | */ | 
|---|
| 89 | void drm_flip_work_commit(struct drm_flip_work *work, | 
|---|
| 90 | struct workqueue_struct *wq) | 
|---|
| 91 | { | 
|---|
| 92 | unsigned long flags; | 
|---|
| 93 |  | 
|---|
| 94 | spin_lock_irqsave(&work->lock, flags); | 
|---|
| 95 | list_splice_tail(list: &work->queued, head: &work->commited); | 
|---|
| 96 | INIT_LIST_HEAD(list: &work->queued); | 
|---|
| 97 | spin_unlock_irqrestore(lock: &work->lock, flags); | 
|---|
| 98 | queue_work(wq, work: &work->worker); | 
|---|
| 99 | } | 
|---|
| 100 | EXPORT_SYMBOL(drm_flip_work_commit); | 
|---|
| 101 |  | 
|---|
| 102 | static void flip_worker(struct work_struct *w) | 
|---|
| 103 | { | 
|---|
| 104 | struct drm_flip_work *work = container_of(w, struct drm_flip_work, worker); | 
|---|
| 105 | struct list_head tasks; | 
|---|
| 106 | unsigned long flags; | 
|---|
| 107 |  | 
|---|
| 108 | while (1) { | 
|---|
| 109 | struct drm_flip_task *task, *tmp; | 
|---|
| 110 |  | 
|---|
| 111 | INIT_LIST_HEAD(list: &tasks); | 
|---|
| 112 | spin_lock_irqsave(&work->lock, flags); | 
|---|
| 113 | list_splice_tail(list: &work->commited, head: &tasks); | 
|---|
| 114 | INIT_LIST_HEAD(list: &work->commited); | 
|---|
| 115 | spin_unlock_irqrestore(lock: &work->lock, flags); | 
|---|
| 116 |  | 
|---|
| 117 | if (list_empty(head: &tasks)) | 
|---|
| 118 | break; | 
|---|
| 119 |  | 
|---|
| 120 | list_for_each_entry_safe(task, tmp, &tasks, node) { | 
|---|
| 121 | work->func(work, task->data); | 
|---|
| 122 | kfree(objp: task); | 
|---|
| 123 | } | 
|---|
| 124 | } | 
|---|
| 125 | } | 
|---|
| 126 |  | 
|---|
| 127 | /** | 
|---|
| 128 | * drm_flip_work_init - initialize flip-work | 
|---|
| 129 | * @work: the flip-work to initialize | 
|---|
| 130 | * @name: debug name | 
|---|
| 131 | * @func: the callback work function | 
|---|
| 132 | * | 
|---|
| 133 | * Initializes/allocates resources for the flip-work | 
|---|
| 134 | */ | 
|---|
| 135 | void drm_flip_work_init(struct drm_flip_work *work, | 
|---|
| 136 | const char *name, drm_flip_func_t func) | 
|---|
| 137 | { | 
|---|
| 138 | work->name = name; | 
|---|
| 139 | INIT_LIST_HEAD(list: &work->queued); | 
|---|
| 140 | INIT_LIST_HEAD(list: &work->commited); | 
|---|
| 141 | spin_lock_init(&work->lock); | 
|---|
| 142 | work->func = func; | 
|---|
| 143 |  | 
|---|
| 144 | INIT_WORK(&work->worker, flip_worker); | 
|---|
| 145 | } | 
|---|
| 146 | EXPORT_SYMBOL(drm_flip_work_init); | 
|---|
| 147 |  | 
|---|
| 148 | /** | 
|---|
| 149 | * drm_flip_work_cleanup - cleans up flip-work | 
|---|
| 150 | * @work: the flip-work to cleanup | 
|---|
| 151 | * | 
|---|
| 152 | * Destroy resources allocated for the flip-work | 
|---|
| 153 | */ | 
|---|
| 154 | void drm_flip_work_cleanup(struct drm_flip_work *work) | 
|---|
| 155 | { | 
|---|
| 156 | WARN_ON(!list_empty(&work->queued) || !list_empty(&work->commited)); | 
|---|
| 157 | } | 
|---|
| 158 | EXPORT_SYMBOL(drm_flip_work_cleanup); | 
|---|
| 159 |  | 
|---|