Archipelago » qemu

/*

 * TI OMAP processors emulation.

 *

 * Copyright (C) 2007-2008 Nokia Corporation

 * Written by Andrzej Zaborowski <andrew@openedhand.com>

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License as

 * published by the Free Software Foundation; either version 2 or

 * (at your option) version 3 of the License.

 *

 * 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, write to the Free Software Foundation, Inc.,

 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.

 */

#include "hw.h"

#include "arm-misc.h"

#include "omap.h"

#include "sysemu.h"

#include "qemu-timer.h"

#include "qemu-char.h"

#include "flash.h"

#include "soc_dma.h"

#include "audio/audio.h"

/* GP timers */

struct omap_gp_timer_s {

    qemu_irq irq;

    qemu_irq wkup;

    qemu_irq in;

    qemu_irq out;

    omap_clk clk;

    QEMUTimer *timer;

    QEMUTimer *match;

    struct omap_target_agent_s *ta;

    int in_val;

    int out_val;

    int64_t time;

    int64_t rate;

    int64_t ticks_per_sec;

    int16_t config;

    int status;

    int it_ena;

    int wu_ena;

    int enable;

    int inout;

    int capt2;

    int pt;

    enum {

        gpt_trigger_none, gpt_trigger_overflow, gpt_trigger_both

    } trigger;

    enum {

        gpt_capture_none, gpt_capture_rising,

        gpt_capture_falling, gpt_capture_both

    } capture;

    int scpwm;

    int ce;

    int pre;

    int ptv;

    int ar;

    int st;

    int posted;

    uint32_t val;

    uint32_t load_val;

    uint32_t capture_val[2];

    uint32_t match_val;

    int capt_num;

    uint16_t writeh;        /* LSB */

    uint16_t readh;        /* MSB */

};

#define GPT_TCAR_IT        (1 << 2)

#define GPT_OVF_IT        (1 << 1)

#define GPT_MAT_IT        (1 << 0)

static inline void omap_gp_timer_intr(struct omap_gp_timer_s *timer, int it)

{

    if (timer->it_ena & it) {

        if (!timer->status)

            qemu_irq_raise(timer->irq);

        timer->status |= it;

        /* Or are the status bits set even when masked?

         * i.e. is masking applied before or after the status register?  */

    }

    if (timer->wu_ena & it)

        qemu_irq_pulse(timer->wkup);

}

static inline void omap_gp_timer_out(struct omap_gp_timer_s *timer, int level)

{

    if (!timer->inout && timer->out_val != level) {

        timer->out_val = level;

        qemu_set_irq(timer->out, level);

    }

}

static inline uint32_t omap_gp_timer_read(struct omap_gp_timer_s *timer)

{

    uint64_t distance;

    if (timer->st && timer->rate) {

        distance = qemu_get_clock(vm_clock) - timer->time;

        distance = muldiv64(distance, timer->rate, timer->ticks_per_sec);

        if (distance >= 0xffffffff - timer->val)

            return 0xffffffff;

        else

            return timer->val + distance;

    } else

        return timer->val;

}

static inline void omap_gp_timer_sync(struct omap_gp_timer_s *timer)

{

    if (timer->st) {

        timer->val = omap_gp_timer_read(timer);

        timer->time = qemu_get_clock(vm_clock);

    }

}

static inline void omap_gp_timer_update(struct omap_gp_timer_s *timer)

{

    int64_t expires, matches;

    if (timer->st && timer->rate) {

        expires = muldiv64(0x100000000ll - timer->val,

                        timer->ticks_per_sec, timer->rate);

        qemu_mod_timer(timer->timer, timer->time + expires);

        if (timer->ce && timer->match_val >= timer->val) {

            matches = muldiv64(timer->match_val - timer->val,

                            timer->ticks_per_sec, timer->rate);

            qemu_mod_timer(timer->match, timer->time + matches);

        } else

            qemu_del_timer(timer->match);

    } else {

        qemu_del_timer(timer->timer);

        qemu_del_timer(timer->match);

        omap_gp_timer_out(timer, timer->scpwm);

    }

}

static inline void omap_gp_timer_trigger(struct omap_gp_timer_s *timer)

{

    if (timer->pt)

        /* TODO in overflow-and-match mode if the first event to

         * occur is the match, don't toggle.  */

        omap_gp_timer_out(timer, !timer->out_val);

    else

        /* TODO inverted pulse on timer->out_val == 1?  */

        qemu_irq_pulse(timer->out);

}

static void omap_gp_timer_tick(void *opaque)

{

    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;

    if (!timer->ar) {

        timer->st = 0;

        timer->val = 0;

    } else {

        timer->val = timer->load_val;

        timer->time = qemu_get_clock(vm_clock);

    }

    if (timer->trigger == gpt_trigger_overflow ||

                    timer->trigger == gpt_trigger_both)

        omap_gp_timer_trigger(timer);

    omap_gp_timer_intr(timer, GPT_OVF_IT);

    omap_gp_timer_update(timer);

}

static void omap_gp_timer_match(void *opaque)

{

    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;

    if (timer->trigger == gpt_trigger_both)

        omap_gp_timer_trigger(timer);

    omap_gp_timer_intr(timer, GPT_MAT_IT);

}

static void omap_gp_timer_input(void *opaque, int line, int on)

{

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;

    int trigger;

    switch (s->capture) {

    default:

    case gpt_capture_none:

        trigger = 0;

        break;

    case gpt_capture_rising:

        trigger = !s->in_val && on;

        break;

    case gpt_capture_falling:

        trigger = s->in_val && !on;

        break;

    case gpt_capture_both:

        trigger = (s->in_val == !on);

        break;

    }

    s->in_val = on;

    if (s->inout && trigger && s->capt_num < 2) {

        s->capture_val[s->capt_num] = omap_gp_timer_read(s);

        if (s->capt2 == s->capt_num ++)

            omap_gp_timer_intr(s, GPT_TCAR_IT);

    }

}

static void omap_gp_timer_clk_update(void *opaque, int line, int on)

{

    struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;

    omap_gp_timer_sync(timer);

    timer->rate = on ? omap_clk_getrate(timer->clk) : 0;

    omap_gp_timer_update(timer);

}

static void omap_gp_timer_clk_setup(struct omap_gp_timer_s *timer)

{

    omap_clk_adduser(timer->clk,

                    qemu_allocate_irqs(omap_gp_timer_clk_update, timer, 1)[0]);

    timer->rate = omap_clk_getrate(timer->clk);

}

static void omap_gp_timer_reset(struct omap_gp_timer_s *s)

{

    s->config = 0x000;

    s->status = 0;

    s->it_ena = 0;

    s->wu_ena = 0;

    s->inout = 0;

    s->capt2 = 0;

    s->capt_num = 0;

    s->pt = 0;

    s->trigger = gpt_trigger_none;

    s->capture = gpt_capture_none;

    s->scpwm = 0;

    s->ce = 0;

    s->pre = 0;

    s->ptv = 0;

    s->ar = 0;

    s->st = 0;

    s->posted = 1;

    s->val = 0x00000000;

    s->load_val = 0x00000000;

    s->capture_val[0] = 0x00000000;

    s->capture_val[1] = 0x00000000;

    s->match_val = 0x00000000;

    omap_gp_timer_update(s);

}

static uint32_t omap_gp_timer_readw(void *opaque, target_phys_addr_t addr)

{

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;

    switch (addr) {

    case 0x00:        /* TIDR */

        return 0x21;

    case 0x10:        /* TIOCP_CFG */

        return s->config;

    case 0x14:        /* TISTAT */

        /* ??? When's this bit reset? */

        return 1;                                                /* RESETDONE */

    case 0x18:        /* TISR */

        return s->status;

    case 0x1c:        /* TIER */

        return s->it_ena;

    case 0x20:        /* TWER */

        return s->wu_ena;

    case 0x24:        /* TCLR */

        return (s->inout << 14) |

                (s->capt2 << 13) |

                (s->pt << 12) |

                (s->trigger << 10) |

                (s->capture << 8) |

                (s->scpwm << 7) |

                (s->ce << 6) |

                (s->pre << 5) |

                (s->ptv << 2) |

                (s->ar << 1) |

                (s->st << 0);

    case 0x28:        /* TCRR */

        return omap_gp_timer_read(s);

    case 0x2c:        /* TLDR */

        return s->load_val;

    case 0x30:        /* TTGR */

        return 0xffffffff;

    case 0x34:        /* TWPS */

        return 0x00000000;        /* No posted writes pending.  */

    case 0x38:        /* TMAR */

        return s->match_val;

    case 0x3c:        /* TCAR1 */

        return s->capture_val[0];

    case 0x40:        /* TSICR */

        return s->posted << 2;

    case 0x44:        /* TCAR2 */

        return s->capture_val[1];

    }

    OMAP_BAD_REG(addr);

    return 0;

}

static uint32_t omap_gp_timer_readh(void *opaque, target_phys_addr_t addr)

{

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;

    uint32_t ret;

    if (addr & 2)

        return s->readh;

    else {

        ret = omap_gp_timer_readw(opaque, addr);

        s->readh = ret >> 16;

        return ret & 0xffff;

    }

}

static CPUReadMemoryFunc *omap_gp_timer_readfn[] = {

    omap_badwidth_read32,

    omap_gp_timer_readh,

    omap_gp_timer_readw,

};

static void omap_gp_timer_write(void *opaque, target_phys_addr_t addr,

                uint32_t value)

{

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;

    switch (addr) {

    case 0x00:        /* TIDR */

    case 0x14:        /* TISTAT */

    case 0x34:        /* TWPS */

    case 0x3c:        /* TCAR1 */

    case 0x44:        /* TCAR2 */

        OMAP_RO_REG(addr);

        break;

    case 0x10:        /* TIOCP_CFG */

        s->config = value & 0x33d;

        if (((value >> 3) & 3) == 3)                                /* IDLEMODE */

            fprintf(stderr, "%s: illegal IDLEMODE value in TIOCP_CFG\n",

                            __FUNCTION__);

        if (value & 2)                                                /* SOFTRESET */

            omap_gp_timer_reset(s);

        break;

    case 0x18:        /* TISR */

        if (value & GPT_TCAR_IT)

            s->capt_num = 0;

        if (s->status && !(s->status &= ~value))

            qemu_irq_lower(s->irq);

        break;

    case 0x1c:        /* TIER */

        s->it_ena = value & 7;

        break;

    case 0x20:        /* TWER */

        s->wu_ena = value & 7;

        break;

    case 0x24:        /* TCLR */

        omap_gp_timer_sync(s);

        s->inout = (value >> 14) & 1;

        s->capt2 = (value >> 13) & 1;

        s->pt = (value >> 12) & 1;

        s->trigger = (value >> 10) & 3;

        if (s->capture == gpt_capture_none &&

                        ((value >> 8) & 3) != gpt_capture_none)

            s->capt_num = 0;

        s->capture = (value >> 8) & 3;

        s->scpwm = (value >> 7) & 1;

        s->ce = (value >> 6) & 1;

        s->pre = (value >> 5) & 1;

        s->ptv = (value >> 2) & 7;

        s->ar = (value >> 1) & 1;

        s->st = (value >> 0) & 1;

        if (s->inout && s->trigger != gpt_trigger_none)

            fprintf(stderr, "%s: GP timer pin must be an output "

                            "for this trigger mode\n", __FUNCTION__);

        if (!s->inout && s->capture != gpt_capture_none)

            fprintf(stderr, "%s: GP timer pin must be an input "

                            "for this capture mode\n", __FUNCTION__);

        if (s->trigger == gpt_trigger_none)

            omap_gp_timer_out(s, s->scpwm);

        /* TODO: make sure this doesn't overflow 32-bits */

        s->ticks_per_sec = ticks_per_sec << (s->pre ? s->ptv + 1 : 0);

        omap_gp_timer_update(s);

        break;

    case 0x28:        /* TCRR */

        s->time = qemu_get_clock(vm_clock);

        s->val = value;

        omap_gp_timer_update(s);

        break;

    case 0x2c:        /* TLDR */

        s->load_val = value;

        break;

    case 0x30:        /* TTGR */

        s->time = qemu_get_clock(vm_clock);

        s->val = s->load_val;

        omap_gp_timer_update(s);

        break;

    case 0x38:        /* TMAR */

        omap_gp_timer_sync(s);

        s->match_val = value;

        omap_gp_timer_update(s);

        break;

    case 0x40:        /* TSICR */

        s->posted = (value >> 2) & 1;

        if (value & 2)        /* How much exactly are we supposed to reset? */

            omap_gp_timer_reset(s);

        break;

    default:

        OMAP_BAD_REG(addr);

    }

}

static void omap_gp_timer_writeh(void *opaque, target_phys_addr_t addr,

                uint32_t value)

{

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;

    if (addr & 2)

        return omap_gp_timer_write(opaque, addr, (value << 16) | s->writeh);

    else

        s->writeh = (uint16_t) value;

}

static CPUWriteMemoryFunc *omap_gp_timer_writefn[] = {

    omap_badwidth_write32,

    omap_gp_timer_writeh,

    omap_gp_timer_write,

};

struct omap_gp_timer_s *omap_gp_timer_init(struct omap_target_agent_s *ta,

                qemu_irq irq, omap_clk fclk, omap_clk iclk)

{

    int iomemtype;

    struct omap_gp_timer_s *s = (struct omap_gp_timer_s *)

            qemu_mallocz(sizeof(struct omap_gp_timer_s));

    s->ta = ta;

    s->irq = irq;

    s->clk = fclk;

    s->timer = qemu_new_timer(vm_clock, omap_gp_timer_tick, s);

    s->match = qemu_new_timer(vm_clock, omap_gp_timer_match, s);

    s->in = qemu_allocate_irqs(omap_gp_timer_input, s, 1)[0];

    omap_gp_timer_reset(s);

    omap_gp_timer_clk_setup(s);

    iomemtype = l4_register_io_memory(0, omap_gp_timer_readfn,

                    omap_gp_timer_writefn, s);

    omap_l4_attach(ta, 0, iomemtype);

    return s;

}

/* 32-kHz Sync Timer of the OMAP2 */

static uint32_t omap_synctimer_read(struct omap_synctimer_s *s) {

    return muldiv64(qemu_get_clock(vm_clock), 0x8000, ticks_per_sec);

}

static void omap_synctimer_reset(struct omap_synctimer_s *s)

{

    s->val = omap_synctimer_read(s);

}

static uint32_t omap_synctimer_readw(void *opaque, target_phys_addr_t addr)

{

    struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;

    switch (addr) {

    case 0x00:        /* 32KSYNCNT_REV */

        return 0x21;

    case 0x10:        /* CR */

        return omap_synctimer_read(s) - s->val;

    }

    OMAP_BAD_REG(addr);

    return 0;

}

static uint32_t omap_synctimer_readh(void *opaque, target_phys_addr_t addr)

{

    struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;

    uint32_t ret;

    if (addr & 2)

        return s->readh;

    else {

        ret = omap_synctimer_readw(opaque, addr);

        s->readh = ret >> 16;

        return ret & 0xffff;

    }

}

static CPUReadMemoryFunc *omap_synctimer_readfn[] = {

    omap_badwidth_read32,

    omap_synctimer_readh,

    omap_synctimer_readw,

};

static void omap_synctimer_write(void *opaque, target_phys_addr_t addr,

                uint32_t value)

{

    OMAP_BAD_REG(addr);

}

static CPUWriteMemoryFunc *omap_synctimer_writefn[] = {

    omap_badwidth_write32,

    omap_synctimer_write,

    omap_synctimer_write,

};

void omap_synctimer_init(struct omap_target_agent_s *ta,

                struct omap_mpu_state_s *mpu, omap_clk fclk, omap_clk iclk)

{

    struct omap_synctimer_s *s = &mpu->synctimer;

    omap_synctimer_reset(s);

    omap_l4_attach(ta, 0, l4_register_io_memory(0,

                      omap_synctimer_readfn, omap_synctimer_writefn, s));

}

/* General-Purpose Interface of OMAP2 */

struct omap2_gpio_s {

    qemu_irq irq[2];

    qemu_irq wkup;

    qemu_irq *in;

    qemu_irq handler[32];

    uint8_t config[2];

    uint32_t inputs;

    uint32_t outputs;

    uint32_t dir;

    uint32_t level[2];

    uint32_t edge[2];

    uint32_t mask[2];

    uint32_t wumask;

    uint32_t ints[2];

    uint32_t debounce;

    uint8_t delay;

};

static inline void omap_gpio_module_int_update(struct omap2_gpio_s *s,

                int line)

{

    qemu_set_irq(s->irq[line], s->ints[line] & s->mask[line]);

}

static void omap_gpio_module_wake(struct omap2_gpio_s *s, int line)

{

    if (!(s->config[0] & (1 << 2)))                        /* ENAWAKEUP */

        return;

    if (!(s->config[0] & (3 << 3)))                        /* Force Idle */

        return;

    if (!(s->wumask & (1 << line)))

        return;

    qemu_irq_raise(s->wkup);

}

static inline void omap_gpio_module_out_update(struct omap2_gpio_s *s,

                uint32_t diff)

{

    int ln;

    s->outputs ^= diff;

    diff &= ~s->dir;

    while ((ln = ffs(diff))) {

        ln --;

        qemu_set_irq(s->handler[ln], (s->outputs >> ln) & 1);

        diff &= ~(1 << ln);

    }

}

static void omap_gpio_module_level_update(struct omap2_gpio_s *s, int line)

{

    s->ints[line] |= s->dir &

            ((s->inputs & s->level[1]) | (~s->inputs & s->level[0]));

    omap_gpio_module_int_update(s, line);

}

static inline void omap_gpio_module_int(struct omap2_gpio_s *s, int line)

{

    s->ints[0] |= 1 << line;

    omap_gpio_module_int_update(s, 0);

    s->ints[1] |= 1 << line;

    omap_gpio_module_int_update(s, 1);

    omap_gpio_module_wake(s, line);

}

static void omap_gpio_module_set(void *opaque, int line, int level)

{

    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;

    if (level) {

        if (s->dir & (1 << line) & ((~s->inputs & s->edge[0]) | s->level[1]))

            omap_gpio_module_int(s, line);

        s->inputs |= 1 << line;

    } else {

        if (s->dir & (1 << line) & ((s->inputs & s->edge[1]) | s->level[0]))

            omap_gpio_module_int(s, line);

        s->inputs &= ~(1 << line);

    }

}

static void omap_gpio_module_reset(struct omap2_gpio_s *s)

{

    s->config[0] = 0;

    s->config[1] = 2;

    s->ints[0] = 0;

    s->ints[1] = 0;

    s->mask[0] = 0;

    s->mask[1] = 0;

    s->wumask = 0;

    s->dir = ~0;

    s->level[0] = 0;

    s->level[1] = 0;

    s->edge[0] = 0;

    s->edge[1] = 0;

    s->debounce = 0;

    s->delay = 0;

}

static uint32_t omap_gpio_module_read(void *opaque, target_phys_addr_t addr)

{

    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;

    switch (addr) {

    case 0x00:        /* GPIO_REVISION */

        return 0x18;

    case 0x10:        /* GPIO_SYSCONFIG */

        return s->config[0];

    case 0x14:        /* GPIO_SYSSTATUS */

        return 0x01;

    case 0x18:        /* GPIO_IRQSTATUS1 */

        return s->ints[0];

    case 0x1c:        /* GPIO_IRQENABLE1 */

    case 0x60:        /* GPIO_CLEARIRQENABLE1 */

    case 0x64:        /* GPIO_SETIRQENABLE1 */

        return s->mask[0];

    case 0x20:        /* GPIO_WAKEUPENABLE */

    case 0x80:        /* GPIO_CLEARWKUENA */

    case 0x84:        /* GPIO_SETWKUENA */

        return s->wumask;

    case 0x28:        /* GPIO_IRQSTATUS2 */

        return s->ints[1];

    case 0x2c:        /* GPIO_IRQENABLE2 */

    case 0x70:        /* GPIO_CLEARIRQENABLE2 */

    case 0x74:        /* GPIO_SETIREQNEABLE2 */

        return s->mask[1];

    case 0x30:        /* GPIO_CTRL */

        return s->config[1];

    case 0x34:        /* GPIO_OE */

        return s->dir;

    case 0x38:        /* GPIO_DATAIN */

        return s->inputs;

    case 0x3c:        /* GPIO_DATAOUT */

    case 0x90:        /* GPIO_CLEARDATAOUT */

    case 0x94:        /* GPIO_SETDATAOUT */

        return s->outputs;

    case 0x40:        /* GPIO_LEVELDETECT0 */

        return s->level[0];

    case 0x44:        /* GPIO_LEVELDETECT1 */

        return s->level[1];

    case 0x48:        /* GPIO_RISINGDETECT */

        return s->edge[0];

    case 0x4c:        /* GPIO_FALLINGDETECT */

        return s->edge[1];

    case 0x50:        /* GPIO_DEBOUNCENABLE */

        return s->debounce;

    case 0x54:        /* GPIO_DEBOUNCINGTIME */

        return s->delay;

    }

    OMAP_BAD_REG(addr);

    return 0;

}

static void omap_gpio_module_write(void *opaque, target_phys_addr_t addr,

                uint32_t value)

{

    struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;

    uint32_t diff;

    int ln;

    switch (addr) {

    case 0x00:        /* GPIO_REVISION */

    case 0x14:        /* GPIO_SYSSTATUS */

    case 0x38:        /* GPIO_DATAIN */

        OMAP_RO_REG(addr);

        break;

    case 0x10:        /* GPIO_SYSCONFIG */

        if (((value >> 3) & 3) == 3)

            fprintf(stderr, "%s: bad IDLEMODE value\n", __FUNCTION__);

        if (value & 2)

            omap_gpio_module_reset(s);

        s->config[0] = value & 0x1d;

        break;

    case 0x18:        /* GPIO_IRQSTATUS1 */

        if (s->ints[0] & value) {

            s->ints[0] &= ~value;

            omap_gpio_module_level_update(s, 0);

        }

        break;

    case 0x1c:        /* GPIO_IRQENABLE1 */

        s->mask[0] = value;

        omap_gpio_module_int_update(s, 0);

        break;

    case 0x20:        /* GPIO_WAKEUPENABLE */

        s->wumask = value;

        break;

    case 0x28:        /* GPIO_IRQSTATUS2 */

        if (s->ints[1] & value) {

            s->ints[1] &= ~value;

            omap_gpio_module_level_update(s, 1);

        }

        break;

    case 0x2c:        /* GPIO_IRQENABLE2 */

        s->mask[1] = value;

        omap_gpio_module_int_update(s, 1);

        break;

    case 0x30:        /* GPIO_CTRL */

        s->config[1] = value & 7;

        break;

    case 0x34:        /* GPIO_OE */

        diff = s->outputs & (s->dir ^ value);

        s->dir = value;

        value = s->outputs & ~s->dir;

        while ((ln = ffs(diff))) {

            diff &= ~(1 <<-- ln);

            qemu_set_irq(s->handler[ln], (value >> ln) & 1);

        }

        omap_gpio_module_level_update(s, 0);

        omap_gpio_module_level_update(s, 1);

        break;

    case 0x3c:        /* GPIO_DATAOUT */

        omap_gpio_module_out_update(s, s->outputs ^ value);

        break;

    case 0x40:        /* GPIO_LEVELDETECT0 */

        s->level[0] = value;

        omap_gpio_module_level_update(s, 0);

        omap_gpio_module_level_update(s, 1);

        break;

    case 0x44:        /* GPIO_LEVELDETECT1 */

        s->level[1] = value;

        omap_gpio_module_level_update(s, 0);

        omap_gpio_module_level_update(s, 1);

        break;

    case 0x48:        /* GPIO_RISINGDETECT */

        s->edge[0] = value;

        break;

    case 0x4c:        /* GPIO_FALLINGDETECT */

        s->edge[1] = value;

        break;

    case 0x50:        /* GPIO_DEBOUNCENABLE */

        s->debounce = value;

        break;

    case 0x54:        /* GPIO_DEBOUNCINGTIME */

        s->delay = value;

        break;

    case 0x60:        /* GPIO_CLEARIRQENABLE1 */

        s->mask[0] &= ~value;

        omap_gpio_module_int_update(s, 0);

        break;

    case 0x64:        /* GPIO_SETIRQENABLE1 */

        s->mask[0] |= value;

        omap_gpio_module_int_update(s, 0);

        break;

    case 0x70:        /* GPIO_CLEARIRQENABLE2 */

        s->mask[1] &= ~value;

        omap_gpio_module_int_update(s, 1);

        break;

    case 0x74:        /* GPIO_SETIREQNEABLE2 */

        s->mask[1] |= value;

        omap_gpio_module_int_update(s, 1);

        break;

    case 0x80:        /* GPIO_CLEARWKUENA */

        s->wumask &= ~value;

        break;

    case 0x84:        /* GPIO_SETWKUENA */

        s->wumask |= value;

        break;

    case 0x90:        /* GPIO_CLEARDATAOUT */

        omap_gpio_module_out_update(s, s->outputs & value);

        break;

    case 0x94:        /* GPIO_SETDATAOUT */

        omap_gpio_module_out_update(s, ~s->outputs & value);

        break;

    default:

        OMAP_BAD_REG(addr);

        return;

    }

}

static uint32_t omap_gpio_module_readp(void *opaque, target_phys_addr_t addr)

{

    return omap_gpio_module_readp(opaque, addr) >> ((addr & 3) << 3);

}