smapi.c

/*
*
* smapi.c -- SMAPI interface routines
*
*
* Written By: Mike Sullivan IBM Corporation
*
* Copyright (C) 1999 IBM Corporation
*
* 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 of the License, or
* (at your option) any later version.
*
* 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.
*
* NO WARRANTY
* THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
* CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
* LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
* MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
* solely responsible for determining the appropriateness of using and
* distributing the Program and assumes all risks associated with its
* exercise of rights under this Agreement, including but not limited to
* the risks and costs of program errors, damage to or loss of data,
* programs or equipment, and unavailability or interruption of operations.
*
* DISCLAIMER OF LIABILITY
* NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), 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 OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
* HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
*
* 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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*
*
* 10/23/2000 - Alpha Release
*	First release to the public
*/

#define pr_fmt(fmt) "smapi: " fmt

#include <linux/kernel.h>
#include <linux/mc146818rtc.h>	/* CMOS defines */
#include "smapi.h"
#include "mwavedd.h"

static unsigned short g_usSmapiPort = 0;


static int smapi_request(unsigned short inBX, unsigned short inCX,
			 unsigned short inDI, unsigned short inSI,
			 unsigned short *outAX, unsigned short *outBX,
			 unsigned short *outCX, unsigned short *outDX,
			 unsigned short *outDI, unsigned short *outSI)
{
	unsigned short myoutAX = 2, *pmyoutAX = &myoutAX;
	unsigned short myoutBX = 3, *pmyoutBX = &myoutBX;
	unsigned short myoutCX = 4, *pmyoutCX = &myoutCX;
	unsigned short myoutDX = 5, *pmyoutDX = &myoutDX;
	unsigned short myoutDI = 6, *pmyoutDI = &myoutDI;
	unsigned short myoutSI = 7, *pmyoutSI = &myoutSI;
	unsigned short usSmapiOK = -EIO, *pusSmapiOK = &usSmapiOK;
	unsigned int inBXCX = (inBX << 16) | inCX;
	unsigned int inDISI = (inDI << 16) | inSI;

	__asm__ __volatile__("movw  $0x5380,%%ax\n\t"
			    "movl  %7,%%ebx\n\t"
			    "shrl  $16, %%ebx\n\t"
			    "movw  %7,%%cx\n\t"
			    "movl  %8,%%edi\n\t"
			    "shrl  $16,%%edi\n\t"
			    "movw  %8,%%si\n\t"
			    "movw  %9,%%dx\n\t"
			    "out   %%al,%%dx\n\t"
			    "out   %%al,$0x4F\n\t"
			    "cmpb  $0x53,%%ah\n\t"
			    "je    2f\n\t"
			    "1:\n\t"
			    "orb   %%ah,%%ah\n\t"
			    "jnz   2f\n\t"
			    "movw  %%ax,%0\n\t"
			    "movw  %%bx,%1\n\t"
			    "movw  %%cx,%2\n\t"
			    "movw  %%dx,%3\n\t"
			    "movw  %%di,%4\n\t"
			    "movw  %%si,%5\n\t"
			    "movw  $1,%6\n\t"
			    "2:\n\t":"=m"(*(unsigned short *) pmyoutAX),
			    "=m"(*(unsigned short *) pmyoutBX),
			    "=m"(*(unsigned short *) pmyoutCX),
			    "=m"(*(unsigned short *) pmyoutDX),
			    "=m"(*(unsigned short *) pmyoutDI),
			    "=m"(*(unsigned short *) pmyoutSI),
			    "=m"(*(unsigned short *) pusSmapiOK)
			    :"m"(inBXCX), "m"(inDISI), "m"(g_usSmapiPort)
			    :"%eax", "%ebx", "%ecx", "%edx", "%edi",
			    "%esi");

	*outAX = myoutAX;
	*outBX = myoutBX;
	*outCX = myoutCX;
	*outDX = myoutDX;
	*outDI = myoutDI;
	*outSI = myoutSI;

	return usSmapiOK == 1 ? 0 : -EIO;
}


int smapi_query_DSP_cfg(struct smapi_dsp_settings *pSettings)
{
	int bRC;
	unsigned short usAX, usBX, usCX, usDX, usDI, usSI;
	static const unsigned short ausDspBases[] = {
		0x0030, 0x4E30, 0x8E30, 0xCE30,
		0x0130, 0x0350, 0x0070, 0x0DB0 };
	static const unsigned short ausUartBases[] = {
		0x03F8, 0x02F8, 0x03E8, 0x02E8 };

	bRC = smapi_request(0x1802, 0x0000, 0, 0,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) {
		pr_err("%s: Error: Could not get DSP Settings. Aborting.\n", __func__);
		return bRC;
	}

	pSettings->bDSPPresent = ((usBX & 0x0100) != 0);
	pSettings->bDSPEnabled = ((usCX & 0x0001) != 0);
	pSettings->usDspIRQ = usSI & 0x00FF;
	pSettings->usDspDMA = (usSI & 0xFF00) >> 8;
	if ((usDI & 0x00FF) < ARRAY_SIZE(ausDspBases)) {
		pSettings->usDspBaseIO = ausDspBases[usDI & 0x00FF];
	} else {
		pSettings->usDspBaseIO = 0;
	}

	/* check for illegal values */
	if ( pSettings->usDspBaseIO == 0 ) 
		pr_err("%s: Worry: DSP base I/O address is 0\n", __func__);
	if ( pSettings->usDspIRQ == 0 )
		pr_err("%s: Worry: DSP IRQ line is 0\n", __func__);

	bRC = smapi_request(0x1804, 0x0000, 0, 0,
	   	&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) {
		pr_err("%s: Error: Could not get DSP modem settings. Aborting.\n", __func__);
		return bRC;
	} 

	pSettings->bModemEnabled = ((usCX & 0x0001) != 0);
	pSettings->usUartIRQ = usSI & 0x000F;
	if (((usSI & 0xFF00) >> 8) < ARRAY_SIZE(ausUartBases)) {
		pSettings->usUartBaseIO = ausUartBases[(usSI & 0xFF00) >> 8];
	} else {
		pSettings->usUartBaseIO = 0;
	}

	/* check for illegal values */
	if ( pSettings->usUartBaseIO == 0 ) 
		pr_err("%s: Worry: UART base I/O address is 0\n", __func__);
	if ( pSettings->usUartIRQ == 0 )
		pr_err("%s: Worry: UART IRQ line is 0\n", __func__);

	return bRC;
}


int smapi_set_DSP_cfg(void)
{
	int bRC = -EIO;
	int i;
	unsigned short usAX, usBX, usCX, usDX, usDI, usSI;
	static const unsigned short ausDspBases[] = {
		0x0030, 0x4E30, 0x8E30, 0xCE30,
		0x0130, 0x0350, 0x0070, 0x0DB0 };
	static const unsigned short ausUartBases[] = {
		0x03F8, 0x02F8, 0x03E8, 0x02E8 };
	static const unsigned short ausDspIrqs[] = {
		5, 7, 10, 11, 15 };
	static const unsigned short ausUartIrqs[] = {
		3, 4 };

	unsigned short dspio_index = 0, uartio_index = 0;

	if (mwave_3780i_io) {
		for (i = 0; i < ARRAY_SIZE(ausDspBases); i++) {
			if (mwave_3780i_io == ausDspBases[i])
				break;
		}
		if (i == ARRAY_SIZE(ausDspBases)) {
			pr_err("%s: Error: Invalid mwave_3780i_io address %x. Aborting.\n",
			       __func__, mwave_3780i_io);
			return bRC;
		}
		dspio_index = i;
	}

	if (mwave_3780i_irq) {
		for (i = 0; i < ARRAY_SIZE(ausDspIrqs); i++) {
			if (mwave_3780i_irq == ausDspIrqs[i])
				break;
		}
		if (i == ARRAY_SIZE(ausDspIrqs)) {
			pr_err("%s: Error: Invalid mwave_3780i_irq %x. Aborting.\n", __func__,
			       mwave_3780i_irq);
			return bRC;
		}
	}

	if (mwave_uart_io) {
		for (i = 0; i < ARRAY_SIZE(ausUartBases); i++) {
			if (mwave_uart_io == ausUartBases[i])
				break;
		}
		if (i == ARRAY_SIZE(ausUartBases)) {
			pr_err("%s: Error: Invalid mwave_uart_io address %x. Aborting.\n", __func__,
			       mwave_uart_io);
			return bRC;
		}
		uartio_index = i;
	}


	if (mwave_uart_irq) {
		for (i = 0; i < ARRAY_SIZE(ausUartIrqs); i++) {
			if (mwave_uart_irq == ausUartIrqs[i])
				break;
		}
		if (i == ARRAY_SIZE(ausUartIrqs)) {
			pr_err("%s: Error: Invalid mwave_uart_irq %x. Aborting.\n", __func__,
			       mwave_uart_irq);
			return bRC;
		}
	}

	if (mwave_uart_irq || mwave_uart_io) {

		/* Check serial port A */
		bRC = smapi_request(0x1402, 0x0000, 0, 0,
			&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
		if (bRC) goto exit_smapi_request_error;
		/* bRC == 0 */
		if (usBX & 0x0100) {	/* serial port A is present */
			if (usCX & 1) {	/* serial port is enabled */
				if ((usSI & 0xFF) == mwave_uart_irq) {
					pr_err("%s: Serial port A irq %x conflicts with mwave_uart_irq %x\n",
					       __func__, usSI & 0xFF, mwave_uart_irq);
					goto exit_conflict;
				} else {
					if ((usSI >> 8) == uartio_index) {
						pr_err("%s: Serial port A base I/O address %x conflicts with mwave uart I/O %x\n",
						       __func__, ausUartBases[usSI >> 8],
						       ausUartBases[uartio_index]);
						goto exit_conflict;
					}
				}
			}
		}

		/* Check serial port B */
		bRC = smapi_request(0x1404, 0x0000, 0, 0,
			&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
		if (bRC) goto exit_smapi_request_error;
		/* bRC == 0 */
		if (usBX & 0x0100) {	/* serial port B is present */
			if (usCX & 1) {	/* serial port is enabled */
				if ((usSI & 0xFF) == mwave_uart_irq) {
					pr_err("%s: Serial port B irq %x conflicts with mwave_uart_irq %x\n",
					       __func__, usSI & 0xFF, mwave_uart_irq);
					goto exit_conflict;
				} else {
					if ((usSI >> 8) == uartio_index) {
						pr_err("%s: Serial port B base I/O address %x conflicts with mwave uart I/O %x\n",
						       __func__, ausUartBases[usSI >> 8],
						       ausUartBases[uartio_index]);
						goto exit_conflict;
					}
				}
			}
		}

		/* Check IR port */
		bRC = smapi_request(0x1700, 0x0000, 0, 0,
			&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
		if (bRC) goto exit_smapi_request_error;
		bRC = smapi_request(0x1704, 0x0000, 0, 0,
			&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
		if (bRC) goto exit_smapi_request_error;
		/* bRC == 0 */
		if ((usCX & 0xff) != 0xff) { /* IR port not disabled */
			if ((usCX & 0xff) == mwave_uart_irq) {
				pr_err("%s: IR port irq %x conflicts with mwave_uart_irq %x\n",
				       __func__, usCX & 0xff, mwave_uart_irq);
				goto exit_conflict;
			} else {
				if ((usSI & 0xff) == uartio_index) {
					pr_err("%s: IR port base I/O address %x conflicts with mwave uart I/O %x\n",
					       __func__, ausUartBases[usSI & 0xff],
					       ausUartBases[uartio_index]);
					goto exit_conflict;
				}
			}
		}
	}

	bRC = smapi_request(0x1802, 0x0000, 0, 0,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

	if (mwave_3780i_io) {
		usDI = dspio_index;
	}
	if (mwave_3780i_irq) {
		usSI = (usSI & 0xff00) | mwave_3780i_irq;
	}

	bRC = smapi_request(0x1803, 0x0101, usDI, usSI,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

	bRC = smapi_request(0x1804, 0x0000, 0, 0,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

	if (mwave_uart_io) {
		usSI = (usSI & 0x00ff) | (uartio_index << 8);
	}
	if (mwave_uart_irq) {
		usSI = (usSI & 0xff00) | mwave_uart_irq;
	}
	bRC = smapi_request(0x1805, 0x0101, 0, usSI,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

	bRC = smapi_request(0x1802, 0x0000, 0, 0,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

	bRC = smapi_request(0x1804, 0x0000, 0, 0,
		&usAX, &usBX, &usCX, &usDX, &usDI, &usSI);
	if (bRC) goto exit_smapi_request_error;

/* normal exit: */
	return 0;

exit_conflict:
	/* Message has already been printed */
	return -EIO;

exit_smapi_request_error:
	pr_err("%s: exit on smapi_request error bRC %x\n", __func__, bRC);
	return bRC;
}


int smapi_set_DSP_power_state(bool bOn)
{
	unsigned short usAX, usBX, usCX, usDX, usDI, usSI;
	unsigned short usPowerFunction;

	usPowerFunction = (bOn) ? 1 : 0;

	return smapi_request(0x4901, 0x0000, 0, usPowerFunction, &usAX, &usBX, &usCX, &usDX, &usDI,
			     &usSI);
}

int smapi_init(void)
{
	int retval = -EIO;
	unsigned short usSmapiID = 0;
	unsigned long flags;

	spin_lock_irqsave(&rtc_lock, flags);
	usSmapiID = CMOS_READ(0x7C);
	usSmapiID |= (CMOS_READ(0x7D) << 8);
	spin_unlock_irqrestore(&rtc_lock, flags);

	if (usSmapiID == 0x5349) {
		spin_lock_irqsave(&rtc_lock, flags);
		g_usSmapiPort = CMOS_READ(0x7E);
		g_usSmapiPort |= (CMOS_READ(0x7F) << 8);
		spin_unlock_irqrestore(&rtc_lock, flags);
		if (g_usSmapiPort == 0) {
			pr_err("%s: ERROR unable to read from SMAPI port\n", __func__);
		} else {
			retval = 0;
			//SmapiQuerySystemID();
		}
	} else {
		pr_err("%s: ERROR invalid usSmapiID\n", __func__);
		retval = -ENXIO;
	}

	return retval;
}