NetBSD/sys/arch/arm32/shark/hat.c

/*	$NetBSD: hat.c,v 1.3 1998/05/01 21:18:40 cgd Exp $	*/

/*
 * Copyright 1997
 * Digital Equipment Corporation. All rights reserved.
 *
 * This software is furnished under license and may be used and
 * copied only in accordance with the following terms and conditions.
 * Subject to these conditions, you may download, copy, install,
 * use, modify and distribute this software in source and/or binary
 * form. No title or ownership is transferred hereby.
 *
 * 1) Any source code used, modified or distributed must reproduce
 *    and retain this copyright notice and list of conditions as
 *    they appear in the source file.
 *
 * 2) No right is granted to use any trade name, trademark, or logo of
 *    Digital Equipment Corporation. Neither the "Digital Equipment
 *    Corporation" name nor any trademark or logo of Digital Equipment
 *    Corporation may be used to endorse or promote products derived
 *    from this software without the prior written permission of
 *    Digital Equipment Corporation.
 *
 * 3) This software is provided "AS-IS" and any express or implied
 *    warranties, including but not limited to, any implied warranties
 *    of merchantability, fitness for a particular purpose, or
 *    non-infringement are disclaimed. In no event shall DIGITAL be
 *    liable for any damages whatsoever, and in particular, DIGITAL
 *    shall not be liable for special, indirect, consequential, or
 *    incidental damages or damages for lost profits, loss of
 *    revenue or loss of use, whether such damages arise in contract,
 *    negligence, tort, under statute, in equity, at law or otherwise,
 *    even if advised of the possibility of such damage.
 */

/*
 * hat.c
 *
 * implementation of high-availability timer on SHARK
 *
 * Created      : 19/05/97
 */
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/time.h>
#include <sys/kernel.h>
#include <sys/device.h>

#include <machine/cpu.h>
#include <machine/irqhandler.h>
#include <machine/pio.h>
#include <machine/cpufunc.h>

#include <dev/isa/isareg.h>
#include <dev/isa/isavar.h>

#include <arm32/isa/timerreg.h>
#include <arm32/isa/isadmavar.h>
#include <arm32/shark/fiq.h>
#include <arm32/shark/sequoia.h>

extern int fiq_getregs         __P((fiqhandler_t *));
extern int fiq_setregs         __P((fiqhandler_t *));

static int hatOn = 0;

/* interface to high-availability timer */

static void hatClkCount(int count);
static void hatEnableSWTCH();

static void (*hatWedgeFn)(int);

int hatClkOff(void)
{
        fiqhandler_t fiqhandler;
	u_int16_t    seqReg;

	if (!hatOn) return -1;
	hatOn = 0;
	hatWedgeFn = NULL;

        /* disable the SWTCH pin */

	sequoiaRead(PMC_PMCMCR2_REG, &seqReg);
        sequoiaWrite(PMC_PMCMCR2_REG, seqReg  | (PMCMCR2_M_SWTCHEN));
        
        /* turn off timer 2 */
        outb(ATSR_REG1_REG, 
	     inb(ATSR_REG1_REG) & ~((REG1_M_TMR2EN) | (REG1_M_SPKREN)));

	fiq_getregs(&fiqhandler);

	/* get rid of the C routine and stack */
	fiqhandler.fh_r9  = 0;
	fiqhandler.fh_r13 = 0;

	fiq_setregs(&fiqhandler);
	isa_dmathaw();

	return 0;
}


int hatClkOn(int count, void (*hatFn)(int), int arg,
	     unsigned char *stack, void (*wedgeFn)(int))
{
        fiqhandler_t fiqhandler;
	u_int16_t    seqReg;

	if (hatOn) return -1;

	hatWedgeFn = wedgeFn;

	isa_dmafreeze();

	fiq_getregs(&fiqhandler);

	/* set the C routine and stack */
	fiqhandler.fh_r9  = (u_int)hatFn;
	fiqhandler.fh_r10 = (u_int)arg;
	fiqhandler.fh_r13 = (u_int)stack;

	fiq_setregs(&fiqhandler);

	/* no debounce on SWTCH */
	sequoiaRead(PMC_DBCR_REG, &seqReg);
	sequoiaWrite(PMC_DBCR_REG, seqReg | DBCR_M_DBDIS0);

	hatEnableSWTCH(); /* enable the SWTCH -> PMI logic */

        /* turn on timer 2 */
        outb(ATSR_REG1_REG, 
	     inb(ATSR_REG1_REG) | (REG1_M_TMR2EN) | (REG1_M_SPKREN));

	/* start timer 2 running */
	hatClkCount(count);

        /* enable the SWTCH pin */
	sequoiaRead(PMC_PMCMCR2_REG, &seqReg);
        sequoiaWrite(PMC_PMCMCR2_REG, seqReg | (PMCMCR2_M_SWTCHEN));

	hatOn = 1;
	return 0;
}


int hatClkAdjust(int count)
{
	if (!hatOn) return -1;

	hatClkCount(count);
	hatEnableSWTCH();

	return 0;
}

static void 
hatEnableSWTCH()
{
    u_int16_t    seqReg;

    /* SWTCH input causes PMI, not automatic switch to standby mode! */
    /* clearing bit 9 is bad news.  seems to enable PMI from secondary
       activity timeout! */
    /* first setting, then clearing this bit seems to unwedge the edge
       detect logic in the sequoia */

    sequoiaRead(PMC_PMIMCR_REG, &seqReg);
    sequoiaWrite(PMC_PMIMCR_REG, seqReg |  (PMIMCR_M_IMSKSWSTBY));
    sequoiaWrite(PMC_PMIMCR_REG, seqReg & ~(PMIMCR_M_IMSKSWSTBY));
}

void hatUnwedge()
{
  static int   lastFiqsHappened = -1;
  extern int   fiqs_happened;

  if (!hatOn) return;

  if (lastFiqsHappened == fiqs_happened) {
    hatEnableSWTCH();
    if (hatWedgeFn) (*hatWedgeFn)(fiqs_happened);
  } else {
    lastFiqsHappened = fiqs_happened;
  }
}

static void hatClkCount(int count)
{
        u_int savedints;
  
        savedints = disable_interrupts(I32_bit);

	outb(TIMER_MODE, TIMER_SEL2|TIMER_RATEGEN|TIMER_16BIT);
	outb(TIMER_CNTR2, count % 256);
	outb(TIMER_CNTR2, count / 256);

	restore_interrupts(savedints);
}