/*	$NetBSD: psc.c,v 1.11 2019/07/23 15:19:07 rin Exp $	*/

/*-
 * Copyright (c) 1997 David Huang <khym@azeotrope.org>
 * 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. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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.
 *
 */

/*
 * This handles registration/unregistration of PSC (Peripheral
 * Subsystem Controller) interrupts. The PSC is used only on the
 * Centris/Quadra 660av and the Quadra 840av.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: psc.c,v 1.11 2019/07/23 15:19:07 rin Exp $");

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

#include <machine/bus.h>
#include <machine/cpu.h>
#include <machine/psc.h>

static void	psc_kill_dma(void);
int		psc_lev3_intr(void *);
static void	psc_lev3_noint(void *);
int		psc_lev4_intr(void *);
static int	psc_lev4_noint(void *);
int		psc_lev5_intr(void *);
static void	psc_lev5_noint(void *);
int		psc_lev6_intr(void *);
static void	psc_lev6_noint(void *);

static int	stop_read_psc_dma(int, int, uint32_t *);
static int	stop_write_psc_dma(int, int, uint32_t *);

void	(*psc3_ihandler)(void *) = psc_lev3_noint;
void	*psc3_iarg;

int (*psc4_itab[4])(void *) = {
	psc_lev4_noint, /* 0 */
	psc_lev4_noint, /* 1 */
	psc_lev4_noint, /* 2 */
	psc_lev4_noint  /* 3 */
};

void *psc4_iarg[4] = {
	(void *)0, (void *)1, (void *)2, (void *)3
};

void (*psc5_itab[2])(void *) = {
	psc_lev5_noint, /* 0 */
	psc_lev5_noint  /* 1 */
};

void *psc5_iarg[2] = {
	(void *)0, (void *)1
};

void (*psc6_itab[3])(void *) = {
	psc_lev6_noint, /* 0 */
	psc_lev6_noint, /* 1 */
	psc_lev6_noint  /* 2 */
};

void *psc6_iarg[3] = {
	(void *)0, (void *)1, (void *)2
};

/*
 * Make excessively sure that all PSC DMA is shut down.
 */
void
psc_kill_dma(void)
{
	int	i;

	for (i = 0; i < 9; i++) {
		psc_reg2(PSC_CTLBASE + (i << 4)) = 0x8800;
		psc_reg2(PSC_CTLBASE + (i << 4)) = 0x1000;
		psc_reg2(PSC_CMDBASE + (i << 5)) = 0x1100;
		psc_reg2(PSC_CMDBASE + (i << 5) + PSC_SET1) = 0x1100;
	}
}

/*
 * Setup the interrupt vectors and disable most of the PSC interrupts
 */
void
psc_init(void)
{
	int	s, i;

	/*
	 * Only Quadra AVs have a PSC.
	 */
	if (current_mac_model->class == MACH_CLASSAV) {
		s = splhigh();
		psc_kill_dma();
		intr_establish(psc_lev3_intr, NULL, 3);
		intr_establish(psc_lev4_intr, NULL, 4);
		intr_establish(psc_lev5_intr, NULL, 5);
		intr_establish(psc_lev6_intr, NULL, 6);
		for (i = 3; i < 7; i++) {
			/* Clear any flags */
			psc_reg1(PSC_ISR_BASE + 0x10 * i) = 0x0F;
			/* Clear any interrupt enable */
			psc_reg1(PSC_IER_BASE + 0x10 * i) = 0x0F;
		}
		psc_reg1(PSC_LEV4_IER) = 0x86; /* enable SCC */
		splx(s);
	}
}

int
add_psc_lev3_intr(void (*handler)(void *), void *arg)
{
	int s;

	s = splhigh();

	psc3_ihandler = handler;
	psc3_iarg = arg;

	splx(s);

	return 1;
}

int
remove_psc_lev3_intr(void)
{
	return add_psc_lev3_intr(psc_lev3_noint, (void *)0);
}

int
psc_lev3_intr(void *arg)
{
	u_int8_t intbits;

	while ((intbits = psc_reg1(PSC_LEV3_ISR)) != psc_reg1(PSC_LEV3_ISR))
		;
	intbits &= 0x1 & psc_reg1(PSC_LEV3_IER);

	if (intbits)
		psc3_ihandler(psc3_iarg);

	return 0;
}

static void
psc_lev3_noint(void *arg)
{
	printf("psc_lev3_noint\n");
}

int
psc_lev4_intr(void *arg)
{
	u_int8_t intbits, bitnum;
	u_int mask;

	while ((intbits = psc_reg1(PSC_LEV4_ISR)) != psc_reg1(PSC_LEV4_ISR))
		;
	intbits &= 0xf & psc_reg1(PSC_LEV4_IER);

	mask = 1;
	bitnum = 0;
	do {
		if (intbits & mask)
			psc4_itab[bitnum](psc4_iarg[bitnum]);
		mask <<= 1;
	} while (intbits >= mask && ++bitnum);

	return 0;
}

int
add_psc_lev4_intr(int dev, int (*handler)(void *), void *arg)
{
	int s;

	if ((dev < 0) || (dev > 3))
		return 0;

	s = splhigh();

	psc4_itab[dev] = handler;
	psc4_iarg[dev] = arg;

	splx(s);

	return 1;
}

int
remove_psc_lev4_intr(int dev)
{
	return add_psc_lev4_intr(dev, psc_lev4_noint, (void *)dev);
}

int
psc_lev4_noint(void *arg)
{
	printf("psc_lev4_noint: device %d\n", (int)arg);
	return 0;
}

int
psc_lev5_intr(void *arg)
{
	u_int8_t intbits, bitnum;
	u_int mask;

	while ((intbits = psc_reg1(PSC_LEV5_ISR)) != psc_reg1(PSC_LEV5_ISR))
		;
	intbits &= 0x3 & psc_reg1(PSC_LEV5_IER);

	mask = 1;
	bitnum = 0;
	do {
		if (intbits & mask)
			psc5_itab[bitnum](psc5_iarg[bitnum]);
		mask <<= 1;
	} while (intbits >= mask && ++bitnum);

	return 0;
}

int
add_psc_lev5_intr(int dev, void (*handler)(void *), void *arg)
{
	int s;

	if ((dev < 0) || (dev > 1))
		return 0;

	s = splhigh();

	psc5_itab[dev] = handler;
	psc5_iarg[dev] = arg;

	splx(s);

	return 1;
}

int
remove_psc_lev5_intr(int dev)
{
	return add_psc_lev5_intr(dev, psc_lev5_noint, (void *)dev);
}

void
psc_lev5_noint(void *arg)
{
	printf("psc_lev5_noint: device %d\n", (int)arg);
}

int
psc_lev6_intr(void *arg)
{
	u_int8_t intbits, bitnum;
	u_int mask;

	while ((intbits = psc_reg1(PSC_LEV6_ISR)) != psc_reg1(PSC_LEV6_ISR))
		;
	intbits &= 0x7 & psc_reg1(PSC_LEV6_IER);

	mask = 1;
	bitnum = 0;
	do {
		if (intbits & mask)
			psc6_itab[bitnum](psc6_iarg[bitnum]);
		mask <<= 1;
	} while (intbits >= mask && ++bitnum);

	return 0;
}

int
add_psc_lev6_intr(int dev, void (*handler)(void *), void *arg)
{
	int s;

	if ((dev < 0) || (dev > 2))
		return 0;

	s = splhigh();

	psc6_itab[dev] = handler;
	psc6_iarg[dev] = arg;

	splx(s);

	return 1;
}

int
remove_psc_lev6_intr(int dev)
{
	return add_psc_lev6_intr(dev, psc_lev6_noint, (void *)dev);
}

void
psc_lev6_noint(void *arg)
{
	printf("psc_lev6_noint: device %d\n", (int)arg);
}

/*
 * DMA Control routines for esp(4).
 * XXX Need to be merged with DMA engine of mc(4).
 */

int
start_psc_dma(int channel, int *rset, bus_addr_t addr, uint32_t len, int datain)
{
	int chan_ctrl, rset_addr, rset_len, rset_cmd, s;

	s = splhigh(); 

	chan_ctrl = PSC_CTLBASE + (channel << 4);

	pause_psc_dma(channel);

	*rset = (psc_reg2(chan_ctrl) & 1) << 4;

	rset_addr = PSC_ADDRBASE + (0x20 * channel) + *rset;
	rset_len = rset_addr + 4;
	rset_cmd = rset_addr + 8;

	(void)psc_reg2(rset_cmd);
	psc_reg4(rset_len) = len;
	psc_reg4(rset_addr) = addr;

	if (datain)
		psc_reg2(rset_cmd) = 0x8200;
	else
		psc_reg2(rset_cmd) = 0x200;

	psc_reg2(rset_cmd) = 0x100;
	psc_reg2(rset_cmd) = 0x8800;
	psc_reg2(chan_ctrl) = 0x400;

	splx(s);

	return 0;
}

int
pause_psc_dma(int channel)
{
	int chan_ctrl, s;

	s = splhigh();

	chan_ctrl = PSC_CTLBASE + (channel << 4);

	psc_reg2(chan_ctrl) = 0x8400;

	while (!(psc_reg2(chan_ctrl) & 0x4000))
		continue;

	splx(s);

	return 0;
}

int
wait_psc_dma(int channel, int rset, uint32_t *residual)
{
	int rset_addr, rset_len, rset_cmd, s;

	s = splhigh();

	rset_addr = PSC_ADDRBASE + (0x20 * channel) + rset;
	rset_len = rset_addr + 4;
	rset_cmd = rset_addr + 8;

	while (!(psc_reg2(rset_cmd) & 0x100))
		continue;

	while (psc_reg2(rset_cmd) & 0x800)
		continue;

	*residual = psc_reg4(rset_len);

	splx(s);

	if (*residual)
		return -1;
	else
		return 0;
}

int
stop_psc_dma(int channel, int rset, uint32_t *residual, int datain)
{
	int rval, s;

	s = splhigh();

	if (datain)
		rval = stop_read_psc_dma(channel, rset, residual);
	else
		rval = stop_write_psc_dma(channel, rset, residual);

	splx(s);

	return rval;
}

static int
stop_read_psc_dma(int channel, int rset, uint32_t *residual)
{
	int chan_ctrl, rset_addr, rset_len, rset_cmd;

	chan_ctrl = PSC_CTLBASE + (channel << 4);
	rset_addr = PSC_ADDRBASE + (0x20 * channel) + rset;
	rset_len = rset_addr + 4;
	rset_cmd = rset_addr + 8;

	if (psc_reg2(rset_cmd) & 0x400) {
		*residual = 0;
		return 0;
	}

	psc_reg2(chan_ctrl) = 0x8200;

	while (psc_reg2(chan_ctrl) & 0x200)
		continue;

	pause_psc_dma(channel);

	*residual = psc_reg4(rset_len);
	if (*residual == 0)
		return 0;

	do {
		psc_reg4(rset_len) = 0;
	} while (psc_reg4(rset_len));

	return 0;
}

static int
stop_write_psc_dma(int channel, int rset, uint32_t *residual)
{
	int chan_ctrl, rset_addr, rset_len, rset_cmd;

	rset_addr = PSC_ADDRBASE + (0x20 * channel) + rset;
	rset_cmd = rset_addr + 8;

	if (psc_reg2(rset_cmd) & 0x400) {
		*residual = 0;
		return 0;
	}

	chan_ctrl = PSC_CTLBASE + (channel << 4); 
	rset_len = rset_addr + 4;

	pause_psc_dma(channel);

	*residual = psc_reg4(rset_len);

	psc_reg2(chan_ctrl) = 0x8800;

	return 0;
}