1cabaafc7SRob Clark /* 2cabaafc7SRob Clark * Copyright (C) 2013 Red Hat 3cabaafc7SRob Clark * 4cabaafc7SRob Clark * Permission is hereby granted, free of charge, to any person obtaining a 5cabaafc7SRob Clark * copy of this software and associated documentation files (the "Software"), 6cabaafc7SRob Clark * to deal in the Software without restriction, including without limitation 7cabaafc7SRob Clark * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8cabaafc7SRob Clark * and/or sell copies of the Software, and to permit persons to whom the 9cabaafc7SRob Clark * Software is furnished to do so, subject to the following conditions: 10cabaafc7SRob Clark * 11cabaafc7SRob Clark * The above copyright notice and this permission notice (including the next 12cabaafc7SRob Clark * paragraph) shall be included in all copies or substantial portions of the 13cabaafc7SRob Clark * Software. 14cabaafc7SRob Clark * 15cabaafc7SRob Clark * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 16cabaafc7SRob Clark * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 17cabaafc7SRob Clark * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 18cabaafc7SRob Clark * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 19cabaafc7SRob Clark * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 20cabaafc7SRob Clark * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 21cabaafc7SRob Clark * SOFTWARE. 22cabaafc7SRob Clark */ 23cabaafc7SRob Clark 24cabaafc7SRob Clark #include "drmP.h" 25cabaafc7SRob Clark #include "drm_flip_work.h" 26cabaafc7SRob Clark 27cabaafc7SRob Clark /** 28cabaafc7SRob Clark * drm_flip_work_queue - queue work 29cabaafc7SRob Clark * @work: the flip-work 30cabaafc7SRob Clark * @val: the value to queue 31cabaafc7SRob Clark * 32cabaafc7SRob Clark * Queues work, that will later be run (passed back to drm_flip_func_t 33cabaafc7SRob Clark * func) on a work queue after drm_flip_work_commit() is called. 34cabaafc7SRob Clark */ 35cabaafc7SRob Clark void drm_flip_work_queue(struct drm_flip_work *work, void *val) 36cabaafc7SRob Clark { 37cabaafc7SRob Clark if (kfifo_put(&work->fifo, (const void **)&val)) { 38cabaafc7SRob Clark atomic_inc(&work->pending); 39cabaafc7SRob Clark } else { 40cabaafc7SRob Clark DRM_ERROR("%s fifo full!\n", work->name); 41cabaafc7SRob Clark work->func(work, val); 42cabaafc7SRob Clark } 43cabaafc7SRob Clark } 44cabaafc7SRob Clark EXPORT_SYMBOL(drm_flip_work_queue); 45cabaafc7SRob Clark 46cabaafc7SRob Clark /** 47cabaafc7SRob Clark * drm_flip_work_commit - commit queued work 48cabaafc7SRob Clark * @work: the flip-work 49cabaafc7SRob Clark * @wq: the work-queue to run the queued work on 50cabaafc7SRob Clark * 51cabaafc7SRob Clark * Trigger work previously queued by drm_flip_work_queue() to run 52cabaafc7SRob Clark * on a workqueue. The typical usage would be to queue work (via 53cabaafc7SRob Clark * drm_flip_work_queue()) at any point (from vblank irq and/or 54cabaafc7SRob Clark * prior), and then from vblank irq commit the queued work. 55cabaafc7SRob Clark */ 56cabaafc7SRob Clark void drm_flip_work_commit(struct drm_flip_work *work, 57cabaafc7SRob Clark struct workqueue_struct *wq) 58cabaafc7SRob Clark { 59cabaafc7SRob Clark uint32_t pending = atomic_read(&work->pending); 60cabaafc7SRob Clark atomic_add(pending, &work->count); 61cabaafc7SRob Clark atomic_sub(pending, &work->pending); 62cabaafc7SRob Clark queue_work(wq, &work->worker); 63cabaafc7SRob Clark } 64cabaafc7SRob Clark EXPORT_SYMBOL(drm_flip_work_commit); 65cabaafc7SRob Clark 66cabaafc7SRob Clark static void flip_worker(struct work_struct *w) 67cabaafc7SRob Clark { 68cabaafc7SRob Clark struct drm_flip_work *work = container_of(w, struct drm_flip_work, worker); 69cabaafc7SRob Clark uint32_t count = atomic_read(&work->count); 70cabaafc7SRob Clark void *val = NULL; 71cabaafc7SRob Clark 72cabaafc7SRob Clark atomic_sub(count, &work->count); 73cabaafc7SRob Clark 74cabaafc7SRob Clark while(count--) 75cabaafc7SRob Clark if (!WARN_ON(!kfifo_get(&work->fifo, &val))) 76cabaafc7SRob Clark work->func(work, val); 77cabaafc7SRob Clark } 78cabaafc7SRob Clark 79cabaafc7SRob Clark /** 80cabaafc7SRob Clark * drm_flip_work_init - initialize flip-work 81cabaafc7SRob Clark * @work: the flip-work to initialize 82cabaafc7SRob Clark * @size: the max queue depth 83cabaafc7SRob Clark * @name: debug name 84cabaafc7SRob Clark * @func: the callback work function 85cabaafc7SRob Clark * 86cabaafc7SRob Clark * Initializes/allocates resources for the flip-work 87cabaafc7SRob Clark * 88cabaafc7SRob Clark * RETURNS: 89cabaafc7SRob Clark * Zero on success, error code on failure. 90cabaafc7SRob Clark */ 91cabaafc7SRob Clark int drm_flip_work_init(struct drm_flip_work *work, int size, 92cabaafc7SRob Clark const char *name, drm_flip_func_t func) 93cabaafc7SRob Clark { 94cabaafc7SRob Clark int ret; 95cabaafc7SRob Clark 96cabaafc7SRob Clark work->name = name; 97cabaafc7SRob Clark atomic_set(&work->count, 0); 98cabaafc7SRob Clark atomic_set(&work->pending, 0); 99cabaafc7SRob Clark work->func = func; 100cabaafc7SRob Clark 101cabaafc7SRob Clark ret = kfifo_alloc(&work->fifo, size, GFP_KERNEL); 102cabaafc7SRob Clark if (ret) { 103cabaafc7SRob Clark DRM_ERROR("could not allocate %s fifo\n", name); 104cabaafc7SRob Clark return ret; 105cabaafc7SRob Clark } 106cabaafc7SRob Clark 107cabaafc7SRob Clark INIT_WORK(&work->worker, flip_worker); 108cabaafc7SRob Clark 109cabaafc7SRob Clark return 0; 110cabaafc7SRob Clark } 111cabaafc7SRob Clark EXPORT_SYMBOL(drm_flip_work_init); 112cabaafc7SRob Clark 113cabaafc7SRob Clark /** 114cabaafc7SRob Clark * drm_flip_work_cleanup - cleans up flip-work 115cabaafc7SRob Clark * @work: the flip-work to cleanup 116cabaafc7SRob Clark * 117cabaafc7SRob Clark * Destroy resources allocated for the flip-work 118cabaafc7SRob Clark */ 119cabaafc7SRob Clark void drm_flip_work_cleanup(struct drm_flip_work *work) 120cabaafc7SRob Clark { 121cabaafc7SRob Clark WARN_ON(!kfifo_is_empty(&work->fifo)); 122cabaafc7SRob Clark kfifo_free(&work->fifo); 123cabaafc7SRob Clark } 124cabaafc7SRob Clark EXPORT_SYMBOL(drm_flip_work_cleanup); 125