source: drsdaq/VME/struck/sis1100/V2.02/dev/pci/sis3100rem_irq.c@ 23

/* $ZEL: sis3100rem_irq.c,v 1.3 2004/05/27 23:10:45 wuestner Exp $ */

/*
 * Copyright (c) 2001-2004
 *      Peter Wuestner.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions, and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include "sis1100_sc.h"

static int
sis3100_irq_acknowledge(struct sis1100_softc* sc, int level)
{
    int vector;
    u_int32_t error;

    SEM_LOCK(sc->sem_hw);
    if (level&1)
        sis1100writereg(sc, t_hdr, 0x0c010802);
    else
        sis1100writereg(sc, t_hdr, 0x03010802);
    sis1100writereg(sc, t_am, (1<<14)|0x3f);
    sis1100writereg(sc, t_adl, level<<1);
    error=sis1100readreg(sc, prot_error);

    if (error) {
        pERROR(sc, "3100: error in Iack level %d: 0x%x", level, error);
        vector=-1;
    } else {
        vector=sis1100readreg(sc, tc_dal)&0xff;
    }
    SEM_UNLOCK(sc->sem_hw);
    return vector;
}

void
sis3100rem_irq_handler(struct sis1100_softc* sc)
{
    DECLARE_SPINLOCKFLAGS(s)
    int i;

    SPIN_LOCK_IRQSAVE(sc->lock_doorbell, s);
    sc->new_irqs|=sc->doorbell&~sc->pending_irqs;
    sc->doorbell=0;
    SPIN_UNLOCK_IRQRESTORE(sc->lock_doorbell, s);
    sc->pending_irqs|=sc->new_irqs;

    SEM_LOCK(sc->sem_fdata_list);
    /* block IRQs in VME controller*/
    if (sc->new_irqs & SIS3100_VME_IRQS) {
        sis3100writeremreg(sc, vme_irq_sc, (sc->new_irqs&SIS3100_VME_IRQS)<<16, 1);
    }
    /* obtain irq vectors from VME */
    for (i=7; i>0; i--) {
        if (sc->new_irqs & (1<<i)) {
            sc->irq_vects[i].vector=sis3100_irq_acknowledge(sc, i);
            sc->irq_vects[i].valid=1;
            /*printk(KERN_INFO "vme_irq_handler: level %d vector=0x%08x\n",
                i, sc->irq_info[i].vector);*/
        }
    }
    /* block and clear FRONT-IRQs in VME controller*/
    if (sc->new_irqs & SIS3100_EXT_IRQS) {
        sis3100writeremreg(sc, in_latch_irq, (sc->new_irqs&SIS3100_EXT_IRQS)<<8, 1);
        sis3100writeremreg(sc, in_latch_irq, (sc->new_irqs&SIS3100_EXT_IRQS)<<16, 1);
    }

    sis3100writeremreg(sc, vme_irq_sc, 1<<15, 1);
    /*sis3100writereg(sc, in_latch_irq, 1<<15, 1);*/
    SEM_UNLOCK(sc->sem_fdata_list);
}

void
sis3100rem_enable_irqs(struct sis1100_softc* sc,
        struct sis1100_fdata* fd, u_int32_t mask)
{
    if (mask & SIS3100_VME_IRQS) {
        mask&=SIS3100_VME_IRQS;
        sis3100writeremreg(sc, vme_irq_sc, mask, 0);
    }
    /* enable VME-FRONT-IRQs and SIS3100_DSP_IRQ */
    if (mask & SIS3100_EXT_IRQS) {
        mask&=SIS3100_EXT_IRQS;
        sis3100writeremreg(sc, in_latch_irq, mask<<16, 0);
        sis3100writeremreg(sc, in_latch_irq, mask>>8, 0);
    }
}

void
sis3100rem_disable_irqs(struct sis1100_softc* sc,
        struct sis1100_fdata* fd, u_int32_t mask)
{
    if (mask & SIS3100_VME_IRQS) {
        mask&=SIS3100_VME_IRQS;
        mask<<=16;
        sis3100writeremreg(sc, vme_irq_sc, mask, 0);
    }
    if (mask & SIS3100_EXT_IRQS) {
        mask&=SIS3100_EXT_IRQS;
        mask<<=8;
        sis3100writeremreg(sc, in_latch_irq, mask, 0);
    }
}

void
sis3100rem_get_vector(struct sis1100_softc* sc, int irqs,
                        struct sis1100_irq_get* data)
{
        if (irqs & SIS3100_VME_IRQS) {
                int bit;
                /* find highest bit set */
                for (bit=7; bit>0; bit--) {
                        if (((1<<bit) & irqs) && sc->irq_vects[bit].valid) {
                                data->level=bit;
                                data->vector=sc->irq_vects[bit].vector;
                                sc->irq_vects[bit].valid=0;
                                break;
                        }
                }
        } else {
                data->vector=-1;
                data->level=0;
        }
}

void
sis3100rem_irq_ack(struct sis1100_softc* sc, int irqs)
{
    if (irqs & SIS3100_VME_IRQS)
        sis3100writeremreg(sc, vme_irq_sc, irqs & SIS3100_VME_IRQS, 0);

    if (irqs & SIS3100_EXT_IRQS)
        sis3100writeremreg(sc, in_latch_irq, (irqs&SIS3100_EXT_IRQS)>>8, 0);
}