From dbce0160af31d2ea323656c201d8debf5af789bf Mon Sep 17 00:00:00 2001 From: Tomi Valkeinen Date: Tue, 15 Nov 2011 11:18:12 +0200 Subject: [PATCH] OMAPDSS: APPLY: separate vsync isr register/unregister Create separate functions for the vsync isr register/unregister code for cleaner code. Signed-off-by: Tomi Valkeinen --- drivers/video/omap2/dss/apply.c | 61 ++++++++++++++++++++------------- 1 file changed, 37 insertions(+), 24 deletions(-) diff --git a/drivers/video/omap2/dss/apply.c b/drivers/video/omap2/dss/apply.c index 34879d0628bd..dfce82e11a36 100644 --- a/drivers/video/omap2/dss/apply.c +++ b/drivers/video/omap2/dss/apply.c @@ -417,6 +417,40 @@ void dss_mgr_start_update(struct omap_overlay_manager *mgr) dispc_mgr_enable(mgr->id, true); } +static void dss_apply_irq_handler(void *data, u32 mask); + +static void dss_register_vsync_isr(void) +{ + u32 mask; + int r; + + mask = DISPC_IRQ_VSYNC | DISPC_IRQ_EVSYNC_ODD | + DISPC_IRQ_EVSYNC_EVEN; + if (dss_has_feature(FEAT_MGR_LCD2)) + mask |= DISPC_IRQ_VSYNC2; + + r = omap_dispc_register_isr(dss_apply_irq_handler, NULL, mask); + WARN_ON(r); + + dss_cache.irq_enabled = true; +} + +static void dss_unregister_vsync_isr(void) +{ + u32 mask; + int r; + + mask = DISPC_IRQ_VSYNC | DISPC_IRQ_EVSYNC_ODD | + DISPC_IRQ_EVSYNC_EVEN; + if (dss_has_feature(FEAT_MGR_LCD2)) + mask |= DISPC_IRQ_VSYNC2; + + r = omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, mask); + WARN_ON(r); + + dss_cache.irq_enabled = false; +} + static void dss_apply_irq_handler(void *data, u32 mask) { struct manager_cache_data *mc; @@ -425,7 +459,6 @@ static void dss_apply_irq_handler(void *data, u32 mask) const int num_mgrs = dss_feat_get_num_mgrs(); int i, r; bool mgr_busy[MAX_DSS_MANAGERS]; - u32 irq_mask; for (i = 0; i < num_mgrs; i++) mgr_busy[i] = dispc_mgr_go_busy(i); @@ -459,13 +492,7 @@ static void dss_apply_irq_handler(void *data, u32 mask) goto end; } - irq_mask = DISPC_IRQ_VSYNC | DISPC_IRQ_EVSYNC_ODD | - DISPC_IRQ_EVSYNC_EVEN; - if (dss_has_feature(FEAT_MGR_LCD2)) - irq_mask |= DISPC_IRQ_VSYNC2; - - omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, irq_mask); - dss_cache.irq_enabled = false; + dss_unregister_vsync_isr(); end: spin_unlock(&dss_cache.lock); @@ -605,22 +632,8 @@ int omap_dss_mgr_apply(struct omap_overlay_manager *mgr) r = 0; if (mgr->enabled && !mgr_manual_update(mgr)) { - if (!dss_cache.irq_enabled) { - u32 mask; - - mask = DISPC_IRQ_VSYNC | DISPC_IRQ_EVSYNC_ODD | - DISPC_IRQ_EVSYNC_EVEN; - if (dss_has_feature(FEAT_MGR_LCD2)) - mask |= DISPC_IRQ_VSYNC2; - - r = omap_dispc_register_isr(dss_apply_irq_handler, - NULL, mask); - - if (r) - DSSERR("failed to register apply isr\n"); - - dss_cache.irq_enabled = true; - } + if (!dss_cache.irq_enabled) + dss_register_vsync_isr(); configure_dispc(); } -- 2.30.2