/*      $NetBSD: vrled.c,v 1.9 2012/10/27 17:17:56 chs Exp $    */

/*
 * Copyright (c) 2000 SATO Kazumi. 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 AUTHOR 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 <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: vrled.c,v 1.9 2012/10/27 17:17:56 chs Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/reboot.h>

#include <machine/bus.h>
#include <machine/config_hook.h>

#include <hpcmips/vr/vripif.h>
#include <hpcmips/vr/vrledvar.h>
#include <hpcmips/vr/vrledreg.h>


#ifdef VRLEDDEBUG
#ifndef VRLEDDEBUG_CONF
#define VRLEDDEBUG_CONF 0
#endif /* VRLEDDEBUG_CONF */
int vrleddebug = VRLEDDEBUG_CONF;
#define DPRINTF(arg) if (vrleddebug) printf arg;
#define VPRINTF(arg) if (bootverbose||vrleddebug) printf arg;
#else /* VRLEDDEBUG */
#define DPRINTF(arg)
#define VPRINTF(arg) if (bootverbose) printf arg;
#endif /* VRLEDDEBUG */

static int vrledmatch(device_t, cfdata_t, void *);
static void vrledattach(device_t, device_t, void *);

static void vrled_write(struct vrled_softc *, int, unsigned short);
static unsigned short vrled_read(struct vrled_softc *, int);

static void vrled_stop(struct vrled_softc *);
static void vrled_on(struct vrled_softc *);
static void vrled_blink(struct vrled_softc *);
static void vrled_flash(struct vrled_softc *);
static void vrled_change_state(struct vrled_softc *);
static int vrled_event(void *, int, long, void *);

int vrled_intr(void *);

CFATTACH_DECL_NEW(vrled, sizeof(struct vrled_softc),
    vrledmatch, vrledattach, NULL, NULL);

struct vrled_softc *this_led;

static inline void
vrled_write(struct vrled_softc *sc, int port, unsigned short val)
{

        bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
}

static inline unsigned short
vrled_read(struct vrled_softc *sc, int port)
{

        return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
}

static int
vrledmatch(device_t parent, cfdata_t cf, void *aux)
{

        return (1);
}

static void
vrledattach(device_t parent, device_t self, void *aux)
{
        struct vrled_softc *sc = device_private(self);
        struct vrip_attach_args *va = aux;

        bus_space_tag_t iot = va->va_iot;
        bus_space_handle_t ioh;

        if (bus_space_map(iot, va->va_addr, 1, 0, &ioh)) {
                printf(": can't map bus space\n");
                return;
        }

        sc->sc_iot = iot;
        sc->sc_ioh = ioh;

        if (!(sc->sc_handler = 
            vrip_intr_establish(va->va_vc, va->va_unit, 0, IPL_TTY,
                vrled_intr, sc))) {
                printf (": can't map interrupt line.\n");
                return;
        }

        printf("\n");
        /* clear interrupt status */
        vrled_write(sc, LEDINT_REG_W, LEDINT_ALL);

        /* basic setup */
        sc->sc_state_cnt = 1;
        vrled_write(sc, LEDASTC_REG_W, 1); /* 1time */
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP); 
        vrled_stop(sc);

        sc->sc_hook = config_hook(CONFIG_HOOK_SET,
            CONFIG_HOOK_LED, CONFIG_HOOK_SHARE, vrled_event, sc);

        this_led = sc;
}


/*
 * LED interrupt handler.
 *
 */
int
vrled_intr(void *arg)
{
        struct vrled_softc *sc = arg;
        unsigned int intstat;

        intstat = vrled_read(sc, LEDINT_REG_W);
        /* clear interrupt status */
        vrled_write(sc, LEDINT_REG_W, intstat);
        if (intstat&LEDINT_AUTOSTOP) {
                vrled_change_state(sc);
        }
        return (0);
}

/*
 * LED turn OFF
 *
 */
void
vrled_stop(struct vrled_softc *sc)
{
        vrled_write(sc, LEDHTS_REG_W, LEDHTS_DIV16SEC);
        vrled_write(sc, LEDLTS_REG_W, LEDLTS_4SEC);
        vrled_write(sc, LEDASTC_REG_W, 2); /* 2time */
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP); 

        sc->sc_state = LEDOFF;
        sc->sc_next = LEDOFF;
}

/*
 * LED turn ON
 *
 */
void
vrled_on(struct vrled_softc *sc)
{
        vrled_write(sc, LEDHTS_REG_W, LEDHTS_SEC);
        vrled_write(sc, LEDLTS_REG_W, LEDLTS_DIV16SEC);
        vrled_write(sc, LEDASTC_REG_W, 2); /* 2time */
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP|LEDCNT_BLINK);    

        sc->sc_state = LEDON;
        sc->sc_next = LEDON;
}

/*
 * LED blink
 *
 */
void
vrled_blink(struct vrled_softc *sc)
{
        int ledhts;
        int ledlts;

        switch (sc->sc_next) {
        case LED1SB:
                ledhts = LEDHTS_DIV2SEC;
                ledlts = LEDLTS_DIV2SEC;
                break;
        case LED2SB: 
                ledhts = LEDHTS_SEC;
                ledlts = LEDLTS_SEC;
                break;
        default:
                vrled_stop(sc);
                return;
        }

        vrled_write(sc, LEDHTS_REG_W, ledhts);
        vrled_write(sc, LEDLTS_REG_W, ledlts);
        vrled_write(sc, LEDASTC_REG_W, 2); /* 2time */
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP); 
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP|LEDCNT_BLINK);    

        sc->sc_state = sc->sc_next;
}

/*
 * LED flash once
 *
 */
void
vrled_flash(struct vrled_softc *sc)
{
        int ledhts;
        int ledlts;

        switch (sc->sc_next) {
        case LED8DIVF:
                ledhts = LEDHTS_DIV16SEC;
                ledlts = LEDLTS_DIV16SEC;
                break;
        case LED4DIVF:
                ledhts = LEDHTS_DIV8SEC;
                ledlts = LEDLTS_DIV8SEC;
                break;
        case LED2DIVF:
                ledhts = LEDHTS_DIV4SEC;
                ledlts = LEDLTS_DIV4SEC;
                break;
        case LED1SF:
                ledhts = LEDHTS_DIV2SEC;
                ledlts = LEDLTS_DIV2SEC;
                break;
        default:
                vrled_stop(sc);
                return;
        }

        vrled_write(sc, LEDHTS_REG_W, ledhts);
        vrled_write(sc, LEDLTS_REG_W, ledlts);
        vrled_write(sc, LEDASTC_REG_W, 2); /* 2time */
        vrled_write(sc, LEDCNT_REG_W, LEDCNT_AUTOSTOP|LEDCNT_BLINK);    

        sc->sc_state = sc->sc_next;
        sc->sc_next = LEDOFF;
        sc->sc_state_cnt = 1;
}

/*
 * Change LED state
 *
 */
void
vrled_change_state(struct vrled_softc *sc)
{

        switch (sc->sc_next) {
        case LEDOFF:
                vrled_stop(sc);
                break;
        case LEDON:
                vrled_on(sc);
                break;
        case LED1SB:
        case LED2SB: 
                vrled_blink(sc);
                break;
        case LED8DIVF:
        case LED4DIVF:
        case LED2DIVF:
        case LED1SF:
                vrled_flash(sc);
                break;
        default:
                vrled_stop(sc);
                break;
        }
}

/*
 * Set LED state
 *
 */
void
vrled_set_state(struct vrled_softc *sc, vrled_status state)
{

        int ledstate;

        ledstate = vrled_read(sc, LEDCNT_REG_W);
        if (ledstate&LEDCNT_BLINK) { /* currently processing */
                if (sc->sc_next == state)
                        sc->sc_state_cnt++;
                switch (sc->sc_next) {
                case LEDOFF:
                case LEDON:
                        sc->sc_next = state;
                        break;
                case LED8DIVF:
                case LED4DIVF:
                case LED2DIVF:
                case LED1SF:
                        switch (state) {
                        case LEDOFF:
                        case LED8DIVF:
                        case LED4DIVF:
                        case LED2DIVF:
                        case LED1SF:
                                sc->sc_next = state;
                                break;
                        default:
                                break;
                        }
                        break;
                case LED1SB:
                case LED2SB: 
                        switch (state) {
                        case LEDOFF:
                        case LEDON:
                        case LED1SB:
                        case LED2SB:
                                sc->sc_next = state;
                                break;
                        default:
                                break;
                        }
                        break;
                default:
                        sc->sc_next = LEDOFF;
                        break;
                }
                return;
        }
        sc->sc_next = state;
        vrled_change_state(sc);
}

/*
 * LED config hook events 
 *
 */
int
vrled_event(void *ctx, int type, long id, void *msg)
{
        struct vrled_softc *sc = (struct vrled_softc *)ctx;
        int why =*(int *)msg;

        if (type != CONFIG_HOOK_SET 
            || id != CONFIG_HOOK_LED)
                return (1);
        if (msg == NULL)
                return (1); 
                
        switch (why) {
        case CONFIG_HOOK_LED_OFF:
                vrled_set_state(sc, LEDOFF);
                break;
        case CONFIG_HOOK_LED_ON:
                vrled_set_state(sc, LEDON);
                break;
        case CONFIG_HOOK_LED_FLASH:
                vrled_set_state(sc, LED8DIVF);
                break;
        case CONFIG_HOOK_LED_FLASH2:
                vrled_set_state(sc, LED4DIVF);
                break;
        case CONFIG_HOOK_LED_FLASH5:
                vrled_set_state(sc, LED2DIVF);
                break;
        case CONFIG_HOOK_LED_BLINK:
                vrled_set_state(sc, LED1SB);
                break;
        case CONFIG_HOOK_LED_BLINK2:
                vrled_set_state(sc, LED2SB);
                break;
        default:
                vrled_set_state(sc, LEDOFF);
        }
        return (0);
}

/* end */