/*
 * Copyright (C) 2011 Texas Instruments
 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#define DSS_SUBSYS_NAME "APPLY"

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/spinlock.h>
#include <linux/jiffies.h>

#include <video/omapdss.h>

#include "dss.h"
#include "dss_features.h"
#include "dispc-compat.h"

/*
 * We have 4 levels of cache for the dispc settings. First two are in SW and
 * the latter two in HW.
 *
 *       set_info()
 *          v
 * +--------------------+
 * |     user_info      |
 * +--------------------+
 *          v
 *        apply()
 *          v
 * +--------------------+
 * |       info         |
 * +--------------------+
 *          v
 *      write_regs()
 *          v
 * +--------------------+
 * |  shadow registers  |
 * +--------------------+
 *          v
 * VFP or lcd/digit_enable
 *          v
 * +--------------------+
 * |      registers     |
 * +--------------------+
 */

struct ovl_priv_data {

        bool user_info_dirty;
        struct omap_overlay_info user_info;

        bool info_dirty;
        struct omap_overlay_info info;

        bool shadow_info_dirty;

        bool extra_info_dirty;
        bool shadow_extra_info_dirty;

        bool enabled;
        u32 fifo_low, fifo_high;

        /*
         * True if overlay is to be enabled. Used to check and calculate configs
         * for the overlay before it is enabled in the HW.
         */
        bool enabling;
};

struct mgr_priv_data {

        bool user_info_dirty;
        struct omap_overlay_manager_info user_info;

        bool info_dirty;
        struct omap_overlay_manager_info info;

        bool shadow_info_dirty;

        /* If true, GO bit is up and shadow registers cannot be written.
         * Never true for manual update displays */
        bool busy;

        /* If true, dispc output is enabled */
        bool updating;

        /* If true, a display is enabled using this manager */
        bool enabled;

        bool extra_info_dirty;
        bool shadow_extra_info_dirty;

        struct omap_video_timings timings;
        struct dss_lcd_mgr_config lcd_config;

        void (*framedone_handler)(void *);
        void *framedone_handler_data;
};

static struct {
        struct ovl_priv_data ovl_priv_data_array[MAX_DSS_OVERLAYS];
        struct mgr_priv_data mgr_priv_data_array[MAX_DSS_MANAGERS];

        bool irq_enabled;
} dss_data;

/* protects dss_data */
static spinlock_t data_lock;
/* lock for blocking functions */
static DEFINE_MUTEX(apply_lock);
static DECLARE_COMPLETION(extra_updated_completion);

static void dss_register_vsync_isr(void);

static struct ovl_priv_data *get_ovl_priv(struct omap_overlay *ovl)
{
        return &dss_data.ovl_priv_data_array[ovl->id];
}

static struct mgr_priv_data *get_mgr_priv(struct omap_overlay_manager *mgr)
{
        return &dss_data.mgr_priv_data_array[mgr->id];
}

static void apply_init_priv(void)
{
        const int num_ovls = dss_feat_get_num_ovls();
        struct mgr_priv_data *mp;
        int i;

        spin_lock_init(&data_lock);

        for (i = 0; i < num_ovls; ++i) {
                struct ovl_priv_data *op;

                op = &dss_data.ovl_priv_data_array[i];

                op->info.color_mode = OMAP_DSS_COLOR_RGB16;
                op->info.rotation_type = OMAP_DSS_ROT_DMA;

                op->info.global_alpha = 255;

                switch (i) {
                case 0:
                        op->info.zorder = 0;
                        break;
                case 1:
                        op->info.zorder =
                                dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 3 : 0;
                        break;
                case 2:
                        op->info.zorder =
                                dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 2 : 0;
                        break;
                case 3:
                        op->info.zorder =
                                dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 1 : 0;
                        break;
                }

                op->user_info = op->info;
        }

        /*
         * Initialize some of the lcd_config fields for TV manager, this lets
         * us prevent checking if the manager is LCD or TV at some places
         */
        mp = &dss_data.mgr_priv_data_array[OMAP_DSS_CHANNEL_DIGIT];

        mp->lcd_config.video_port_width = 24;
        mp->lcd_config.clock_info.lck_div = 1;
        mp->lcd_config.clock_info.pck_div = 1;
}

/*
 * A LCD manager's stallmode decides whether it is in manual or auto update. TV
 * manager is always auto update, stallmode field for TV manager is false by
 * default
 */
static bool ovl_manual_update(struct omap_overlay *ovl)
{
        struct mgr_priv_data *mp = get_mgr_priv(ovl->manager);

        return mp->lcd_config.stallmode;
}

static bool mgr_manual_update(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        return mp->lcd_config.stallmode;
}

static int dss_check_settings_low(struct omap_overlay_manager *mgr,
                bool applying)
{
        struct omap_overlay_info *oi;
        struct omap_overlay_manager_info *mi;
        struct omap_overlay *ovl;
        struct omap_overlay_info *ois[MAX_DSS_OVERLAYS];
        struct ovl_priv_data *op;
        struct mgr_priv_data *mp;

        mp = get_mgr_priv(mgr);

        if (!mp->enabled)
                return 0;

        if (applying && mp->user_info_dirty)
                mi = &mp->user_info;
        else
                mi = &mp->info;

        /* collect the infos to be tested into the array */
        list_for_each_entry(ovl, &mgr->overlays, list) {
                op = get_ovl_priv(ovl);

                if (!op->enabled && !op->enabling)
                        oi = NULL;
                else if (applying && op->user_info_dirty)
                        oi = &op->user_info;
                else
                        oi = &op->info;

                ois[ovl->id] = oi;
        }

        return dss_mgr_check(mgr, mi, &mp->timings, &mp->lcd_config, ois);
}

/*
 * check manager and overlay settings using overlay_info from data->info
 */
static int dss_check_settings(struct omap_overlay_manager *mgr)
{
        return dss_check_settings_low(mgr, false);
}

/*
 * check manager and overlay settings using overlay_info from ovl->info if
 * dirty and from data->info otherwise
 */
static int dss_check_settings_apply(struct omap_overlay_manager *mgr)
{
        return dss_check_settings_low(mgr, true);
}

static bool need_isr(void)
{
        const int num_mgrs = dss_feat_get_num_mgrs();
        int i;

        for (i = 0; i < num_mgrs; ++i) {
                struct omap_overlay_manager *mgr;
                struct mgr_priv_data *mp;
                struct omap_overlay *ovl;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mp->enabled)
                        continue;

                if (mgr_manual_update(mgr)) {
                        /* to catch FRAMEDONE */
                        if (mp->updating)
                                return true;
                } else {
                        /* to catch GO bit going down */
                        if (mp->busy)
                                return true;

                        /* to write new values to registers */
                        if (mp->info_dirty)
                                return true;

                        /* to set GO bit */
                        if (mp->shadow_info_dirty)
                                return true;

                        /*
                         * NOTE: we don't check extra_info flags for disabled
                         * managers, once the manager is enabled, the extra_info
                         * related manager changes will be taken in by HW.
                         */

                        /* to write new values to registers */
                        if (mp->extra_info_dirty)
                                return true;

                        /* to set GO bit */
                        if (mp->shadow_extra_info_dirty)
                                return true;

                        list_for_each_entry(ovl, &mgr->overlays, list) {
                                struct ovl_priv_data *op;

                                op = get_ovl_priv(ovl);

                                /*
                                 * NOTE: we check extra_info flags even for
                                 * disabled overlays, as extra_infos need to be
                                 * always written.
                                 */

                                /* to write new values to registers */
                                if (op->extra_info_dirty)
                                        return true;

                                /* to set GO bit */
                                if (op->shadow_extra_info_dirty)
                                        return true;

                                if (!op->enabled)
                                        continue;

                                /* to write new values to registers */
                                if (op->info_dirty)
                                        return true;

                                /* to set GO bit */
                                if (op->shadow_info_dirty)
                                        return true;
                        }
                }
        }

        return false;
}

static bool need_go(struct omap_overlay_manager *mgr)
{
        struct omap_overlay *ovl;
        struct mgr_priv_data *mp;
        struct ovl_priv_data *op;

        mp = get_mgr_priv(mgr);

        if (mp->shadow_info_dirty || mp->shadow_extra_info_dirty)
                return true;

        list_for_each_entry(ovl, &mgr->overlays, list) {
                op = get_ovl_priv(ovl);
                if (op->shadow_info_dirty || op->shadow_extra_info_dirty)
                        return true;
        }

        return false;
}

/* returns true if an extra_info field is currently being updated */
static bool extra_info_update_ongoing(void)
{
        const int num_mgrs = dss_feat_get_num_mgrs();
        int i;

        for (i = 0; i < num_mgrs; ++i) {
                struct omap_overlay_manager *mgr;
                struct omap_overlay *ovl;
                struct mgr_priv_data *mp;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mp->enabled)
                        continue;

                if (!mp->updating)
                        continue;

                if (mp->extra_info_dirty || mp->shadow_extra_info_dirty)
                        return true;

                list_for_each_entry(ovl, &mgr->overlays, list) {
                        struct ovl_priv_data *op = get_ovl_priv(ovl);

                        if (op->extra_info_dirty || op->shadow_extra_info_dirty)
                                return true;
                }
        }

        return false;
}

/* wait until no extra_info updates are pending */
static void wait_pending_extra_info_updates(void)
{
        bool updating;
        unsigned long flags;
        unsigned long t;
        int r;

        spin_lock_irqsave(&data_lock, flags);

        updating = extra_info_update_ongoing();

        if (!updating) {
                spin_unlock_irqrestore(&data_lock, flags);
                return;
        }

        init_completion(&extra_updated_completion);

        spin_unlock_irqrestore(&data_lock, flags);

        t = msecs_to_jiffies(500);
        r = wait_for_completion_timeout(&extra_updated_completion, t);
        if (r == 0)
                DSSWARN("timeout in wait_pending_extra_info_updates\n");
}

static struct omap_dss_device *dss_mgr_get_device(struct omap_overlay_manager *mgr)
{
        struct omap_dss_device *dssdev;

        dssdev = mgr->output;
        if (dssdev == NULL)
                return NULL;

        while (dssdev->dst)
                dssdev = dssdev->dst;

        if (dssdev->driver)
                return dssdev;
        else
                return NULL;
}

static struct omap_dss_device *dss_ovl_get_device(struct omap_overlay *ovl)
{
        return ovl->manager ? dss_mgr_get_device(ovl->manager) : NULL;
}

static int dss_mgr_wait_for_vsync(struct omap_overlay_manager *mgr)
{
        unsigned long timeout = msecs_to_jiffies(500);
        u32 irq;
        int r;

        if (mgr->output == NULL)
                return -ENODEV;

        r = dispc_runtime_get();
        if (r)
                return r;

        switch (mgr->output->id) {
        case OMAP_DSS_OUTPUT_VENC:
                irq = DISPC_IRQ_EVSYNC_ODD;
                break;
        case OMAP_DSS_OUTPUT_HDMI:
                irq = DISPC_IRQ_EVSYNC_EVEN;
                break;
        default:
                irq = dispc_mgr_get_vsync_irq(mgr->id);
                break;
        }

        r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);

        dispc_runtime_put();

        return r;
}

static int dss_mgr_wait_for_go(struct omap_overlay_manager *mgr)
{
        unsigned long timeout = msecs_to_jiffies(500);
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        u32 irq;
        unsigned long flags;
        int r;
        int i;

        spin_lock_irqsave(&data_lock, flags);

        if (mgr_manual_update(mgr)) {
                spin_unlock_irqrestore(&data_lock, flags);
                return 0;
        }

        if (!mp->enabled) {
                spin_unlock_irqrestore(&data_lock, flags);
                return 0;
        }

        spin_unlock_irqrestore(&data_lock, flags);

        r = dispc_runtime_get();
        if (r)
                return r;

        irq = dispc_mgr_get_vsync_irq(mgr->id);

        i = 0;
        while (1) {
                bool shadow_dirty, dirty;

                spin_lock_irqsave(&data_lock, flags);
                dirty = mp->info_dirty;
                shadow_dirty = mp->shadow_info_dirty;
                spin_unlock_irqrestore(&data_lock, flags);

                if (!dirty && !shadow_dirty) {
                        r = 0;
                        break;
                }

                /* 4 iterations is the worst case:
                 * 1 - initial iteration, dirty = true (between VFP and VSYNC)
                 * 2 - first VSYNC, dirty = true
                 * 3 - dirty = false, shadow_dirty = true
                 * 4 - shadow_dirty = false */
                if (i++ == 3) {
                        DSSERR("mgr(%d)->wait_for_go() not finishing\n",
                                        mgr->id);
                        r = 0;
                        break;
                }

                r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
                if (r == -ERESTARTSYS)
                        break;

                if (r) {
                        DSSERR("mgr(%d)->wait_for_go() timeout\n", mgr->id);
                        break;
                }
        }

        dispc_runtime_put();

        return r;
}

static int dss_mgr_wait_for_go_ovl(struct omap_overlay *ovl)
{
        unsigned long timeout = msecs_to_jiffies(500);
        struct ovl_priv_data *op;
        struct mgr_priv_data *mp;
        u32 irq;
        unsigned long flags;
        int r;
        int i;

        if (!ovl->manager)
                return 0;

        mp = get_mgr_priv(ovl->manager);

        spin_lock_irqsave(&data_lock, flags);

        if (ovl_manual_update(ovl)) {
                spin_unlock_irqrestore(&data_lock, flags);
                return 0;
        }

        if (!mp->enabled) {
                spin_unlock_irqrestore(&data_lock, flags);
                return 0;
        }

        spin_unlock_irqrestore(&data_lock, flags);

        r = dispc_runtime_get();
        if (r)
                return r;

        irq = dispc_mgr_get_vsync_irq(ovl->manager->id);

        op = get_ovl_priv(ovl);
        i = 0;
        while (1) {
                bool shadow_dirty, dirty;

                spin_lock_irqsave(&data_lock, flags);
                dirty = op->info_dirty;
                shadow_dirty = op->shadow_info_dirty;
                spin_unlock_irqrestore(&data_lock, flags);

                if (!dirty && !shadow_dirty) {
                        r = 0;
                        break;
                }

                /* 4 iterations is the worst case:
                 * 1 - initial iteration, dirty = true (between VFP and VSYNC)
                 * 2 - first VSYNC, dirty = true
                 * 3 - dirty = false, shadow_dirty = true
                 * 4 - shadow_dirty = false */
                if (i++ == 3) {
                        DSSERR("ovl(%d)->wait_for_go() not finishing\n",
                                        ovl->id);
                        r = 0;
                        break;
                }

                r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
                if (r == -ERESTARTSYS)
                        break;

                if (r) {
                        DSSERR("ovl(%d)->wait_for_go() timeout\n", ovl->id);
                        break;
                }
        }

        dispc_runtime_put();

        return r;
}

static void dss_ovl_write_regs(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        struct omap_overlay_info *oi;
        bool replication;
        struct mgr_priv_data *mp;
        int r;

        DSSDBG("writing ovl %d regs\n", ovl->id);

        if (!op->enabled || !op->info_dirty)
                return;

        oi = &op->info;

        mp = get_mgr_priv(ovl->manager);

        replication = dss_ovl_use_replication(mp->lcd_config, oi->color_mode);

        r = dispc_ovl_setup(ovl->id, oi, replication, &mp->timings, false);
        if (r) {
                /*
                 * We can't do much here, as this function can be called from
                 * vsync interrupt.
                 */
                DSSERR("dispc_ovl_setup failed for ovl %d\n", ovl->id);

                /* This will leave fifo configurations in a nonoptimal state */
                op->enabled = false;
                dispc_ovl_enable(ovl->id, false);
                return;
        }

        op->info_dirty = false;
        if (mp->updating)
                op->shadow_info_dirty = true;
}

static void dss_ovl_write_regs_extra(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        struct mgr_priv_data *mp;

        DSSDBG("writing ovl %d regs extra\n", ovl->id);

        if (!op->extra_info_dirty)
                return;

        /* note: write also when op->enabled == false, so that the ovl gets
         * disabled */

        dispc_ovl_enable(ovl->id, op->enabled);
        dispc_ovl_set_fifo_threshold(ovl->id, op->fifo_low, op->fifo_high);

        mp = get_mgr_priv(ovl->manager);

        op->extra_info_dirty = false;
        if (mp->updating)
                op->shadow_extra_info_dirty = true;
}

static void dss_mgr_write_regs(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        struct omap_overlay *ovl;

        DSSDBG("writing mgr %d regs\n", mgr->id);

        if (!mp->enabled)
                return;

        WARN_ON(mp->busy);

        /* Commit overlay settings */
        list_for_each_entry(ovl, &mgr->overlays, list) {
                dss_ovl_write_regs(ovl);
                dss_ovl_write_regs_extra(ovl);
        }

        if (mp->info_dirty) {
                dispc_mgr_setup(mgr->id, &mp->info);

                mp->info_dirty = false;
                if (mp->updating)
                        mp->shadow_info_dirty = true;
        }
}

static void dss_mgr_write_regs_extra(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        DSSDBG("writing mgr %d regs extra\n", mgr->id);

        if (!mp->extra_info_dirty)
                return;

        dispc_mgr_set_timings(mgr->id, &mp->timings);

        /* lcd_config parameters */
        if (dss_mgr_is_lcd(mgr->id))
                dispc_mgr_set_lcd_config(mgr->id, &mp->lcd_config);

        mp->extra_info_dirty = false;
        if (mp->updating)
                mp->shadow_extra_info_dirty = true;
}

static void dss_write_regs(void)
{
        const int num_mgrs = omap_dss_get_num_overlay_managers();
        int i;

        for (i = 0; i < num_mgrs; ++i) {
                struct omap_overlay_manager *mgr;
                struct mgr_priv_data *mp;
                int r;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mp->enabled || mgr_manual_update(mgr) || mp->busy)
                        continue;

                r = dss_check_settings(mgr);
                if (r) {
                        DSSERR("cannot write registers for manager %s: "
                                        "illegal configuration\n", mgr->name);
                        continue;
                }

                dss_mgr_write_regs(mgr);
                dss_mgr_write_regs_extra(mgr);
        }
}

static void dss_set_go_bits(void)
{
        const int num_mgrs = omap_dss_get_num_overlay_managers();
        int i;

        for (i = 0; i < num_mgrs; ++i) {
                struct omap_overlay_manager *mgr;
                struct mgr_priv_data *mp;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mp->enabled || mgr_manual_update(mgr) || mp->busy)
                        continue;

                if (!need_go(mgr))
                        continue;

                mp->busy = true;

                if (!dss_data.irq_enabled && need_isr())
                        dss_register_vsync_isr();

                dispc_mgr_go(mgr->id);
        }

}

static void mgr_clear_shadow_dirty(struct omap_overlay_manager *mgr)
{
        struct omap_overlay *ovl;
        struct mgr_priv_data *mp;
        struct ovl_priv_data *op;

        mp = get_mgr_priv(mgr);
        mp->shadow_info_dirty = false;
        mp->shadow_extra_info_dirty = false;

        list_for_each_entry(ovl, &mgr->overlays, list) {
                op = get_ovl_priv(ovl);
                op->shadow_info_dirty = false;
                op->shadow_extra_info_dirty = false;
        }
}

static int dss_mgr_connect_compat(struct omap_overlay_manager *mgr,
                struct omap_dss_device *dst)
{
        return mgr->set_output(mgr, dst);
}

static void dss_mgr_disconnect_compat(struct omap_overlay_manager *mgr,
                struct omap_dss_device *dst)
{
        mgr->unset_output(mgr);
}

static void dss_mgr_start_update_compat(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;
        int r;

        spin_lock_irqsave(&data_lock, flags);

        WARN_ON(mp->updating);

        r = dss_check_settings(mgr);
        if (r) {
                DSSERR("cannot start manual update: illegal configuration\n");
                spin_unlock_irqrestore(&data_lock, flags);
                return;
        }

        dss_mgr_write_regs(mgr);
        dss_mgr_write_regs_extra(mgr);

        mp->updating = true;

        if (!dss_data.irq_enabled && need_isr())
                dss_register_vsync_isr();

        dispc_mgr_enable_sync(mgr->id);

        spin_unlock_irqrestore(&data_lock, flags);
}

static void dss_apply_irq_handler(void *data, u32 mask);

static void dss_register_vsync_isr(void)
{
        const int num_mgrs = dss_feat_get_num_mgrs();
        u32 mask;
        int r, i;

        mask = 0;
        for (i = 0; i < num_mgrs; ++i)
                mask |= dispc_mgr_get_vsync_irq(i);

        for (i = 0; i < num_mgrs; ++i)
                mask |= dispc_mgr_get_framedone_irq(i);

        r = omap_dispc_register_isr(dss_apply_irq_handler, NULL, mask);
        WARN_ON(r);

        dss_data.irq_enabled = true;
}

static void dss_unregister_vsync_isr(void)
{
        const int num_mgrs = dss_feat_get_num_mgrs();
        u32 mask;
        int r, i;

        mask = 0;
        for (i = 0; i < num_mgrs; ++i)
                mask |= dispc_mgr_get_vsync_irq(i);

        for (i = 0; i < num_mgrs; ++i)
                mask |= dispc_mgr_get_framedone_irq(i);

        r = omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, mask);
        WARN_ON(r);

        dss_data.irq_enabled = false;
}

static void dss_apply_irq_handler(void *data, u32 mask)
{
        const int num_mgrs = dss_feat_get_num_mgrs();
        int i;
        bool extra_updating;

        spin_lock(&data_lock);

        /* clear busy, updating flags, shadow_dirty flags */
        for (i = 0; i < num_mgrs; i++) {
                struct omap_overlay_manager *mgr;
                struct mgr_priv_data *mp;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mp->enabled)
                        continue;

                mp->updating = dispc_mgr_is_enabled(i);

                if (!mgr_manual_update(mgr)) {
                        bool was_busy = mp->busy;
                        mp->busy = dispc_mgr_go_busy(i);

                        if (was_busy && !mp->busy)
                                mgr_clear_shadow_dirty(mgr);
                }
        }

        dss_write_regs();
        dss_set_go_bits();

        extra_updating = extra_info_update_ongoing();
        if (!extra_updating)
                complete_all(&extra_updated_completion);

        /* call framedone handlers for manual update displays */
        for (i = 0; i < num_mgrs; i++) {
                struct omap_overlay_manager *mgr;
                struct mgr_priv_data *mp;

                mgr = omap_dss_get_overlay_manager(i);
                mp = get_mgr_priv(mgr);

                if (!mgr_manual_update(mgr) || !mp->framedone_handler)
                        continue;

                if (mask & dispc_mgr_get_framedone_irq(i))
                        mp->framedone_handler(mp->framedone_handler_data);
        }

        if (!need_isr())
                dss_unregister_vsync_isr();

        spin_unlock(&data_lock);
}

static void omap_dss_mgr_apply_ovl(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op;

        op = get_ovl_priv(ovl);

        if (!op->user_info_dirty)
                return;

        op->user_info_dirty = false;
        op->info_dirty = true;
        op->info = op->user_info;
}

static void omap_dss_mgr_apply_mgr(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp;

        mp = get_mgr_priv(mgr);

        if (!mp->user_info_dirty)
                return;

        mp->user_info_dirty = false;
        mp->info_dirty = true;
        mp->info = mp->user_info;
}

static int omap_dss_mgr_apply(struct omap_overlay_manager *mgr)
{
        unsigned long flags;
        struct omap_overlay *ovl;
        int r;

        DSSDBG("omap_dss_mgr_apply(%s)\n", mgr->name);

        spin_lock_irqsave(&data_lock, flags);

        r = dss_check_settings_apply(mgr);
        if (r) {
                spin_unlock_irqrestore(&data_lock, flags);
                DSSERR("failed to apply settings: illegal configuration.\n");
                return r;
        }

        /* Configure overlays */
        list_for_each_entry(ovl, &mgr->overlays, list)
                omap_dss_mgr_apply_ovl(ovl);

        /* Configure manager */
        omap_dss_mgr_apply_mgr(mgr);

        dss_write_regs();

        dss_set_go_bits();

        spin_unlock_irqrestore(&data_lock, flags);

        return 0;
}

static void dss_apply_ovl_enable(struct omap_overlay *ovl, bool enable)
{
        struct ovl_priv_data *op;

        op = get_ovl_priv(ovl);

        if (op->enabled == enable)
                return;

        op->enabled = enable;
        op->extra_info_dirty = true;
}

static void dss_apply_ovl_fifo_thresholds(struct omap_overlay *ovl,
                u32 fifo_low, u32 fifo_high)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);

        if (op->fifo_low == fifo_low && op->fifo_high == fifo_high)
                return;

        op->fifo_low = fifo_low;
        op->fifo_high = fifo_high;
        op->extra_info_dirty = true;
}

static void dss_ovl_setup_fifo(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        u32 fifo_low, fifo_high;
        bool use_fifo_merge = false;

        if (!op->enabled && !op->enabling)
                return;

        dispc_ovl_compute_fifo_thresholds(ovl->id, &fifo_low, &fifo_high,
                        use_fifo_merge, ovl_manual_update(ovl));

        dss_apply_ovl_fifo_thresholds(ovl, fifo_low, fifo_high);
}

static void dss_mgr_setup_fifos(struct omap_overlay_manager *mgr)
{
        struct omap_overlay *ovl;
        struct mgr_priv_data *mp;

        mp = get_mgr_priv(mgr);

        if (!mp->enabled)
                return;

        list_for_each_entry(ovl, &mgr->overlays, list)
                dss_ovl_setup_fifo(ovl);
}

static void dss_setup_fifos(void)
{
        const int num_mgrs = omap_dss_get_num_overlay_managers();
        struct omap_overlay_manager *mgr;
        int i;

        for (i = 0; i < num_mgrs; ++i) {
                mgr = omap_dss_get_overlay_manager(i);
                dss_mgr_setup_fifos(mgr);
        }
}

static int dss_mgr_enable_compat(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;
        int r;

        mutex_lock(&apply_lock);

        if (mp->enabled)
                goto out;

        spin_lock_irqsave(&data_lock, flags);

        mp->enabled = true;

        r = dss_check_settings(mgr);
        if (r) {
                DSSERR("failed to enable manager %d: check_settings failed\n",
                                mgr->id);
                goto err;
        }

        dss_setup_fifos();

        dss_write_regs();
        dss_set_go_bits();

        if (!mgr_manual_update(mgr))
                mp->updating = true;

        if (!dss_data.irq_enabled && need_isr())
                dss_register_vsync_isr();

        spin_unlock_irqrestore(&data_lock, flags);

        if (!mgr_manual_update(mgr))
                dispc_mgr_enable_sync(mgr->id);

out:
        mutex_unlock(&apply_lock);

        return 0;

err:
        mp->enabled = false;
        spin_unlock_irqrestore(&data_lock, flags);
        mutex_unlock(&apply_lock);
        return r;
}

static void dss_mgr_disable_compat(struct omap_overlay_manager *mgr)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;

        mutex_lock(&apply_lock);

        if (!mp->enabled)
                goto out;

        if (!mgr_manual_update(mgr))
                dispc_mgr_disable_sync(mgr->id);

        spin_lock_irqsave(&data_lock, flags);

        mp->updating = false;
        mp->enabled = false;

        spin_unlock_irqrestore(&data_lock, flags);

out:
        mutex_unlock(&apply_lock);
}

static int dss_mgr_set_info(struct omap_overlay_manager *mgr,
                struct omap_overlay_manager_info *info)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;
        int r;

        r = dss_mgr_simple_check(mgr, info);
        if (r)
                return r;

        spin_lock_irqsave(&data_lock, flags);

        mp->user_info = *info;
        mp->user_info_dirty = true;

        spin_unlock_irqrestore(&data_lock, flags);

        return 0;
}

static void dss_mgr_get_info(struct omap_overlay_manager *mgr,
                struct omap_overlay_manager_info *info)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;

        spin_lock_irqsave(&data_lock, flags);

        *info = mp->user_info;

        spin_unlock_irqrestore(&data_lock, flags);
}

static int dss_mgr_set_output(struct omap_overlay_manager *mgr,
                struct omap_dss_device *output)
{
        int r;

        mutex_lock(&apply_lock);

        if (mgr->output) {
                DSSERR("manager %s is already connected to an output\n",
                        mgr->name);
                r = -EINVAL;
                goto err;
        }

        if ((mgr->supported_outputs & output->id) == 0) {
                DSSERR("output does not support manager %s\n",
                        mgr->name);
                r = -EINVAL;
                goto err;
        }

        output->manager = mgr;
        mgr->output = output;

        mutex_unlock(&apply_lock);

        return 0;
err:
        mutex_unlock(&apply_lock);
        return r;
}

static int dss_mgr_unset_output(struct omap_overlay_manager *mgr)
{
        int r;
        struct mgr_priv_data *mp = get_mgr_priv(mgr);
        unsigned long flags;

        mutex_lock(&apply_lock);

        if (!mgr->output) {
                DSSERR("failed to unset output, output not set\n");
                r = -EINVAL;
                goto err;
        }

        spin_lock_irqsave(&data_lock, flags);

        if (mp->enabled) {
                DSSERR("output can't be unset when manager is enabled\n");
                r = -EINVAL;
                goto err1;
        }

        spin_unlock_irqrestore(&data_lock, flags);

        mgr->output->manager = NULL;
        mgr->output = NULL;

        mutex_unlock(&apply_lock);

        return 0;
err1:
        spin_unlock_irqrestore(&data_lock, flags);
err:
        mutex_unlock(&apply_lock);

        return r;
}

static void dss_apply_mgr_timings(struct omap_overlay_manager *mgr,
                const struct omap_video_timings *timings)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        mp->timings = *timings;
        mp->extra_info_dirty = true;
}

static void dss_mgr_set_timings_compat(struct omap_overlay_manager *mgr,
                const struct omap_video_timings *timings)
{
        unsigned long flags;
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        spin_lock_irqsave(&data_lock, flags);

        if (mp->updating) {
                DSSERR("cannot set timings for %s: manager needs to be disabled\n",
                        mgr->name);
                goto out;
        }

        dss_apply_mgr_timings(mgr, timings);
out:
        spin_unlock_irqrestore(&data_lock, flags);
}

static void dss_apply_mgr_lcd_config(struct omap_overlay_manager *mgr,
                const struct dss_lcd_mgr_config *config)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        mp->lcd_config = *config;
        mp->extra_info_dirty = true;
}

static void dss_mgr_set_lcd_config_compat(struct omap_overlay_manager *mgr,
                const struct dss_lcd_mgr_config *config)
{
        unsigned long flags;
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        spin_lock_irqsave(&data_lock, flags);

        if (mp->enabled) {
                DSSERR("cannot apply lcd config for %s: manager needs to be disabled\n",
                        mgr->name);
                goto out;
        }

        dss_apply_mgr_lcd_config(mgr, config);
out:
        spin_unlock_irqrestore(&data_lock, flags);
}

static int dss_ovl_set_info(struct omap_overlay *ovl,
                struct omap_overlay_info *info)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        int r;

        r = dss_ovl_simple_check(ovl, info);
        if (r)
                return r;

        spin_lock_irqsave(&data_lock, flags);

        op->user_info = *info;
        op->user_info_dirty = true;

        spin_unlock_irqrestore(&data_lock, flags);

        return 0;
}

static void dss_ovl_get_info(struct omap_overlay *ovl,
                struct omap_overlay_info *info)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;

        spin_lock_irqsave(&data_lock, flags);

        *info = op->user_info;

        spin_unlock_irqrestore(&data_lock, flags);
}

static int dss_ovl_set_manager(struct omap_overlay *ovl,
                struct omap_overlay_manager *mgr)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        int r;

        if (!mgr)
                return -EINVAL;

        mutex_lock(&apply_lock);

        if (ovl->manager) {
                DSSERR("overlay '%s' already has a manager '%s'\n",
                                ovl->name, ovl->manager->name);
                r = -EINVAL;
                goto err;
        }

        r = dispc_runtime_get();
        if (r)
                goto err;

        spin_lock_irqsave(&data_lock, flags);

        if (op->enabled) {
                spin_unlock_irqrestore(&data_lock, flags);
                DSSERR("overlay has to be disabled to change the manager\n");
                r = -EINVAL;
                goto err1;
        }

        dispc_ovl_set_channel_out(ovl->id, mgr->id);

        ovl->manager = mgr;
        list_add_tail(&ovl->list, &mgr->overlays);

        spin_unlock_irqrestore(&data_lock, flags);

        dispc_runtime_put();

        mutex_unlock(&apply_lock);

        return 0;

err1:
        dispc_runtime_put();
err:
        mutex_unlock(&apply_lock);
        return r;
}

static int dss_ovl_unset_manager(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        int r;

        mutex_lock(&apply_lock);

        if (!ovl->manager) {
                DSSERR("failed to detach overlay: manager not set\n");
                r = -EINVAL;
                goto err;
        }

        spin_lock_irqsave(&data_lock, flags);

        if (op->enabled) {
                spin_unlock_irqrestore(&data_lock, flags);
                DSSERR("overlay has to be disabled to unset the manager\n");
                r = -EINVAL;
                goto err;
        }

        spin_unlock_irqrestore(&data_lock, flags);

        /* wait for pending extra_info updates to ensure the ovl is disabled */
        wait_pending_extra_info_updates();

        /*
         * For a manual update display, there is no guarantee that the overlay
         * is really disabled in HW, we may need an extra update from this
         * manager before the configurations can go in. Return an error if the
         * overlay needed an update from the manager.
         *
         * TODO: Instead of returning an error, try to do a dummy manager update
         * here to disable the overlay in hardware. Use the *GATED fields in
         * the DISPC_CONFIG registers to do a dummy update.
         */
        spin_lock_irqsave(&data_lock, flags);

        if (ovl_manual_update(ovl) && op->extra_info_dirty) {
                spin_unlock_irqrestore(&data_lock, flags);
                DSSERR("need an update to change the manager\n");
                r = -EINVAL;
                goto err;
        }

        ovl->manager = NULL;
        list_del(&ovl->list);

        spin_unlock_irqrestore(&data_lock, flags);

        mutex_unlock(&apply_lock);

        return 0;
err:
        mutex_unlock(&apply_lock);
        return r;
}

static bool dss_ovl_is_enabled(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        bool e;

        spin_lock_irqsave(&data_lock, flags);

        e = op->enabled;

        spin_unlock_irqrestore(&data_lock, flags);

        return e;
}

static int dss_ovl_enable(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        int r;

        mutex_lock(&apply_lock);

        if (op->enabled) {
                r = 0;
                goto err1;
        }

        if (ovl->manager == NULL || ovl->manager->output == NULL) {
                r = -EINVAL;
                goto err1;
        }

        spin_lock_irqsave(&data_lock, flags);

        op->enabling = true;

        r = dss_check_settings(ovl->manager);
        if (r) {
                DSSERR("failed to enable overlay %d: check_settings failed\n",
                                ovl->id);
                goto err2;
        }

        dss_setup_fifos();

        op->enabling = false;
        dss_apply_ovl_enable(ovl, true);

        dss_write_regs();
        dss_set_go_bits();

        spin_unlock_irqrestore(&data_lock, flags);

        mutex_unlock(&apply_lock);

        return 0;
err2:
        op->enabling = false;
        spin_unlock_irqrestore(&data_lock, flags);
err1:
        mutex_unlock(&apply_lock);
        return r;
}

static int dss_ovl_disable(struct omap_overlay *ovl)
{
        struct ovl_priv_data *op = get_ovl_priv(ovl);
        unsigned long flags;
        int r;

        mutex_lock(&apply_lock);

        if (!op->enabled) {
                r = 0;
                goto err;
        }

        if (ovl->manager == NULL || ovl->manager->output == NULL) {
                r = -EINVAL;
                goto err;
        }

        spin_lock_irqsave(&data_lock, flags);

        dss_apply_ovl_enable(ovl, false);
        dss_write_regs();
        dss_set_go_bits();

        spin_unlock_irqrestore(&data_lock, flags);

        mutex_unlock(&apply_lock);

        return 0;

err:
        mutex_unlock(&apply_lock);
        return r;
}

static int dss_mgr_register_framedone_handler_compat(struct omap_overlay_manager *mgr,
                void (*handler)(void *), void *data)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        if (mp->framedone_handler)
                return -EBUSY;

        mp->framedone_handler = handler;
        mp->framedone_handler_data = data;

        return 0;
}

static void dss_mgr_unregister_framedone_handler_compat(struct omap_overlay_manager *mgr,
                void (*handler)(void *), void *data)
{
        struct mgr_priv_data *mp = get_mgr_priv(mgr);

        WARN_ON(mp->framedone_handler != handler ||
                        mp->framedone_handler_data != data);

        mp->framedone_handler = NULL;
        mp->framedone_handler_data = NULL;
}

static const struct dss_mgr_ops apply_mgr_ops = {
        .connect = dss_mgr_connect_compat,
        .disconnect = dss_mgr_disconnect_compat,
        .start_update = dss_mgr_start_update_compat,
        .enable = dss_mgr_enable_compat,
        .disable = dss_mgr_disable_compat,
        .set_timings = dss_mgr_set_timings_compat,
        .set_lcd_config = dss_mgr_set_lcd_config_compat,
        .register_framedone_handler = dss_mgr_register_framedone_handler_compat,
        .unregister_framedone_handler = dss_mgr_unregister_framedone_handler_compat,
};

static int compat_refcnt;
static DEFINE_MUTEX(compat_init_lock);

int omapdss_compat_init(void)
{
        struct platform_device *pdev = dss_get_core_pdev();
        int i, r;

        mutex_lock(&compat_init_lock);

        if (compat_refcnt++ > 0)
                goto out;

        apply_init_priv();

        dss_init_overlay_managers_sysfs(pdev);
        dss_init_overlays(pdev);

        for (i = 0; i < omap_dss_get_num_overlay_managers(); i++) {
                struct omap_overlay_manager *mgr;

                mgr = omap_dss_get_overlay_manager(i);

                mgr->set_output = &dss_mgr_set_output;
                mgr->unset_output = &dss_mgr_unset_output;
                mgr->apply = &omap_dss_mgr_apply;
                mgr->set_manager_info = &dss_mgr_set_info;
                mgr->get_manager_info = &dss_mgr_get_info;
                mgr->wait_for_go = &dss_mgr_wait_for_go;
                mgr->wait_for_vsync = &dss_mgr_wait_for_vsync;
                mgr->get_device = &dss_mgr_get_device;
        }

        for (i = 0; i < omap_dss_get_num_overlays(); i++) {
                struct omap_overlay *ovl = omap_dss_get_overlay(i);

                ovl->is_enabled = &dss_ovl_is_enabled;
                ovl->enable = &dss_ovl_enable;
                ovl->disable = &dss_ovl_disable;
                ovl->set_manager = &dss_ovl_set_manager;
                ovl->unset_manager = &dss_ovl_unset_manager;
                ovl->set_overlay_info = &dss_ovl_set_info;
                ovl->get_overlay_info = &dss_ovl_get_info;
                ovl->wait_for_go = &dss_mgr_wait_for_go_ovl;
                ovl->get_device = &dss_ovl_get_device;
        }

        r = dss_install_mgr_ops(&apply_mgr_ops);
        if (r)
                goto err_mgr_ops;

        r = display_init_sysfs(pdev);
        if (r)
                goto err_disp_sysfs;

        dispc_runtime_get();

        r = dss_dispc_initialize_irq();
        if (r)
                goto err_init_irq;

        dispc_runtime_put();

out:
        mutex_unlock(&compat_init_lock);

        return 0;

err_init_irq:
        dispc_runtime_put();
        display_uninit_sysfs(pdev);

err_disp_sysfs:
        dss_uninstall_mgr_ops();

err_mgr_ops:
        dss_uninit_overlay_managers_sysfs(pdev);
        dss_uninit_overlays(pdev);

        compat_refcnt--;

        mutex_unlock(&compat_init_lock);

        return r;
}
EXPORT_SYMBOL(omapdss_compat_init);

void omapdss_compat_uninit(void)
{
        struct platform_device *pdev = dss_get_core_pdev();

        mutex_lock(&compat_init_lock);

        if (--compat_refcnt > 0)
                goto out;

        dss_dispc_uninitialize_irq();

        display_uninit_sysfs(pdev);

        dss_uninstall_mgr_ops();

        dss_uninit_overlay_managers_sysfs(pdev);
        dss_uninit_overlays(pdev);
out:
        mutex_unlock(&compat_init_lock);
}
EXPORT_SYMBOL(omapdss_compat_uninit);