[net-next-2.6.git] / drivers / staging / comedi / drivers / addi-data / addi_amcc_S5920.c

/**
@verbatim

Copyright (C) 2004,2005  ADDI-DATA GmbH for the source code of this module.

	ADDI-DATA GmbH
	Dieselstrasse 3
	D-77833 Ottersweier
	Tel: +19(0)7223/9493-0
	Fax: +49(0)7223/9493-92
	http://www.addi-data-com
	info@addi-data.com

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.

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

You should also find the complete GPL in the COPYING file accompanying this source code.

@endverbatim
*/
/*
  +-----------------------------------------------------------------------+
  | (C) ADDI-DATA GmbH          Dieselstraße 3       D-77833 Ottersweier  |
  +-----------------------------------------------------------------------+
  | Tel : +49 (0) 7223/9493-0     | email    : info@addi-data.com         |
  | Fax : +49 (0) 7223/9493-92    | Internet : http://www.addi-data.com   |
  +-------------------------------+---------------------------------------+
  | Project : ADDI HEADER READ WRITER |     Compiler   : Visual C++       |
  | Module name : S5920.cpp           |     Version    : 6.0              |
  +-------------------------------+---------------------------------------+
  | Author : E. LIBS                      Date : 02/05/2002               |
  +-----------------------------------------------------------------------+
  | Description   : DLL with the S5920 PCI Controller functions           |
  +-----------------------------------------------------------------------+
  |                             UPDATE'S                                  |
  +-----------------------------------------------------------------------+
  |   Date   |   Author  |          Description of updates                |
  +----------+-----------+------------------------------------------------+
  | 28/08/02 | LIBS Eric | Add return codes each time a function of the   |
  |          |           | Addi Library is called                         |
  +-----------------------------------------------------------------------+
  | 31/07/03 | KRAUTH J. | Changes for the MSX-Box                        |
  +-----------------------------------------------------------------------+
*/

#include "addi_amcc_S5920.h"

/*+----------------------------------------------------------------------------+*/
/*| Function   Name   : int i_AddiHeaderRW_ReadEeprom                          |*/
/*|                               (int    i_NbOfWordsToRead,                   |*/
/*|                                unsigned int dw_PCIBoardEepromAddress,             |*/
/*|                                unsigned short   w_EepromStartAddress,                |*/
/*|                                unsigned short * pw_DataRead)                          |*/
/*+----------------------------------------------------------------------------+*/
/*| Task              : Read word from the 5920 eeprom.                        |*/
/*+----------------------------------------------------------------------------+*/
/*| Input Parameters  : int    i_NbOfWordsToRead : Nbr. of word to read        |*/
/*|                     unsigned int dw_PCIBoardEepromAddress : Address of the eeprom |*/
/*|                     unsigned short   w_EepromStartAddress : Eeprom strat address     |*/
/*+----------------------------------------------------------------------------+*/
/*| Output Parameters : unsigned short * pw_DataRead : Read data                          |*/
/*+----------------------------------------------------------------------------+*/
/*| Return Value      : -                                                      |*/
/*+----------------------------------------------------------------------------+*/

int i_AddiHeaderRW_ReadEeprom(int i_NbOfWordsToRead,
	unsigned int dw_PCIBoardEepromAddress,
	unsigned short w_EepromStartAddress, unsigned short *pw_DataRead)
{
	unsigned int dw_eeprom_busy = 0;
	int i_Counter = 0;
	int i_WordCounter;
	int i;
	unsigned char pb_ReadByte[1];
	unsigned char b_ReadLowByte = 0;
	unsigned char b_ReadHighByte = 0;
	unsigned char b_SelectedAddressLow = 0;
	unsigned char b_SelectedAddressHigh = 0;
	unsigned short w_ReadWord = 0;

	for (i_WordCounter = 0; i_WordCounter < i_NbOfWordsToRead;
		i_WordCounter++) {
		do {
			dw_eeprom_busy =
				inl(dw_PCIBoardEepromAddress +
				AMCC_OP_REG_MCSR);
			dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
		} while (dw_eeprom_busy == EEPROM_BUSY);

		for (i_Counter = 0; i_Counter < 2; i_Counter++) {
			b_SelectedAddressLow = (w_EepromStartAddress + i_Counter) % 256;	/* Read the low 8 bit part */
			b_SelectedAddressHigh = (w_EepromStartAddress + i_Counter) / 256;	/* Read the high 8 bit part */

			/* Select the load low address mode */
			outb(NVCMD_LOAD_LOW,
				dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
				3);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Load the low address */
			outb(b_SelectedAddressLow,
				dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
				2);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Select the load high address mode */
			outb(NVCMD_LOAD_HIGH,
				dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
				3);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Load the high address */
			outb(b_SelectedAddressHigh,
				dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
				2);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Select the READ mode */
			outb(NVCMD_BEGIN_READ,
				dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
				3);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Read data into the EEPROM */
			*pb_ReadByte =
				inb(dw_PCIBoardEepromAddress +
				AMCC_OP_REG_MCSR + 2);

			/* Wait on busy */
			do {
				dw_eeprom_busy =
					inl(dw_PCIBoardEepromAddress +
					AMCC_OP_REG_MCSR);
				dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
			} while (dw_eeprom_busy == EEPROM_BUSY);

			/* Select the upper address part */
			if (i_Counter == 0)
				b_ReadLowByte = pb_ReadByte[0];
			else
				b_ReadHighByte = pb_ReadByte[0];

			/* Sleep */
			msleep(1);

		}
		w_ReadWord =
			(b_ReadLowByte | (((unsigned short)b_ReadHighByte) *
				256));

		pw_DataRead[i_WordCounter] = w_ReadWord;

		w_EepromStartAddress += 2;	/*  to read the next word */

	}			/*  for (...) i_NbOfWordsToRead */
	return 0;
}
Commit	Line	Data
c995fe94 ADG	1	/**
	2	@verbatim
	3
	4	Copyright (C) 2004,2005 ADDI-DATA GmbH for the source code of this module.
	5
356cdbcb BP	6	ADDI-DATA GmbH
	7	Dieselstrasse 3
	8	D-77833 Ottersweier
	9	Tel: +19(0)7223/9493-0
	10	Fax: +49(0)7223/9493-92
	11	http://www.addi-data-com
	12	info@addi-data.com
c995fe94 ADG	13
	14	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.
	15
	16	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.
	17
	18	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
	19
39cfb97b	20	You should also find the complete GPL in the COPYING file accompanying this source code.
c995fe94 ADG	21
	22	@endverbatim
	23	*/
	24	/*
	25	+-----------------------------------------------------------------------+
	26	\| (C) ADDI-DATA GmbH Dieselstraße 3 D-77833 Ottersweier \|
	27	+-----------------------------------------------------------------------+
	28	\| Tel : +49 (0) 7223/9493-0 \| email : info@addi-data.com \|
	29	\| Fax : +49 (0) 7223/9493-92 \| Internet : http://www.addi-data.com \|
	30	+-------------------------------+---------------------------------------+
	31	\| Project : ADDI HEADER READ WRITER \| Compiler : Visual C++ \|
	32	\| Module name : S5920.cpp \| Version : 6.0 \|
	33	+-------------------------------+---------------------------------------+
	34	\| Author : E. LIBS Date : 02/05/2002 \|
	35	+-----------------------------------------------------------------------+
	36	\| Description : DLL with the S5920 PCI Controller functions \|
	37	+-----------------------------------------------------------------------+
	38	\| UPDATE'S \|
	39	+-----------------------------------------------------------------------+
	40	\| Date \| Author \| Description of updates \|
	41	+----------+-----------+------------------------------------------------+
	42	\| 28/08/02 \| LIBS Eric \| Add return codes each time a function of the \|
	43	\| \| \| Addi Library is called \|
	44	+-----------------------------------------------------------------------+
	45	\| 31/07/03 \| KRAUTH J. \| Changes for the MSX-Box \|
	46	+-----------------------------------------------------------------------+
	47	*/
	48
	49	#include "addi_amcc_S5920.h"
	50
	51	/+----------------------------------------------------------------------------+/
74b894e5 BP	52	/\| Function Name : int i_AddiHeaderRW_ReadEeprom \|/
74b894e5 BP	53	/\| (int i_NbOfWordsToRead, \|/
756e9d7c	54	/\| unsigned int dw_PCIBoardEepromAddress, \|/
babf0ede BP	55	/\| unsigned short w_EepromStartAddress, \|/
babf0ede BP	56	/\| unsigned short pw_DataRead) \|*/
c995fe94 ADG	57	/+----------------------------------------------------------------------------+/
	58	/\| Task : Read word from the 5920 eeprom. \|/
	59	/+----------------------------------------------------------------------------+/
74b894e5	60	/\| Input Parameters : int i_NbOfWordsToRead : Nbr. of word to read \|/
756e9d7c	61	/\| unsigned int dw_PCIBoardEepromAddress : Address of the eeprom \|/
babf0ede	62	/\| unsigned short w_EepromStartAddress : Eeprom strat address \|/
c995fe94	63	/+----------------------------------------------------------------------------+/
babf0ede	64	/\| Output Parameters : unsigned short pw_DataRead : Read data \|*/
c995fe94 ADG	65	/+----------------------------------------------------------------------------+/
	66	/\| Return Value : - \|/
	67	/+----------------------------------------------------------------------------+/
	68
74b894e5	69	int i_AddiHeaderRW_ReadEeprom(int i_NbOfWordsToRead,
756e9d7c	70	unsigned int dw_PCIBoardEepromAddress,
da91b269	71	unsigned short w_EepromStartAddress, unsigned short *pw_DataRead)
c995fe94	72	{
756e9d7c	73	unsigned int dw_eeprom_busy = 0;
74b894e5 BP	74	int i_Counter = 0;
	75	int i_WordCounter;
	76	int i;
1783fbfe BP	77	unsigned char pb_ReadByte[1];
	78	unsigned char b_ReadLowByte = 0;
	79	unsigned char b_ReadHighByte = 0;
	80	unsigned char b_SelectedAddressLow = 0;
	81	unsigned char b_SelectedAddressHigh = 0;
babf0ede	82	unsigned short w_ReadWord = 0;
c995fe94 ADG	83
	84	for (i_WordCounter = 0; i_WordCounter < i_NbOfWordsToRead;
	85	i_WordCounter++) {
	86	do {
	87	dw_eeprom_busy =
	88	inl(dw_PCIBoardEepromAddress +
	89	AMCC_OP_REG_MCSR);
	90	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	91	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94 ADG	92
c995fe94 ADG	93	for (i_Counter = 0; i_Counter < 2; i_Counter++) {
2696fb57 BP	94	b_SelectedAddressLow = (w_EepromStartAddress + i_Counter) % 256; /* Read the low 8 bit part */
2696fb57 BP	95	b_SelectedAddressHigh = (w_EepromStartAddress + i_Counter) / 256; /* Read the high 8 bit part */
c995fe94	96
2696fb57	97	/* Select the load low address mode */
c995fe94 ADG	98	outb(NVCMD_LOAD_LOW,
	99	dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
	100	3);
	101
2696fb57	102	/* Wait on busy */
c995fe94 ADG	103	do {
	104	dw_eeprom_busy =
	105	inl(dw_PCIBoardEepromAddress +
	106	AMCC_OP_REG_MCSR);
	107	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	108	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	109
2696fb57	110	/* Load the low address */
c995fe94 ADG	111	outb(b_SelectedAddressLow,
	112	dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
	113	2);
	114
2696fb57	115	/* Wait on busy */
c995fe94 ADG	116	do {
	117	dw_eeprom_busy =
	118	inl(dw_PCIBoardEepromAddress +
	119	AMCC_OP_REG_MCSR);
	120	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	121	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	122
2696fb57	123	/* Select the load high address mode */
c995fe94 ADG	124	outb(NVCMD_LOAD_HIGH,
	125	dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
	126	3);
	127
2696fb57	128	/* Wait on busy */
c995fe94 ADG	129	do {
	130	dw_eeprom_busy =
	131	inl(dw_PCIBoardEepromAddress +
	132	AMCC_OP_REG_MCSR);
	133	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	134	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	135
2696fb57	136	/* Load the high address */
c995fe94 ADG	137	outb(b_SelectedAddressHigh,
	138	dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
	139	2);
	140
2696fb57	141	/* Wait on busy */
c995fe94 ADG	142	do {
	143	dw_eeprom_busy =
	144	inl(dw_PCIBoardEepromAddress +
	145	AMCC_OP_REG_MCSR);
	146	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	147	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	148
2696fb57	149	/* Select the READ mode */
c995fe94 ADG	150	outb(NVCMD_BEGIN_READ,
	151	dw_PCIBoardEepromAddress + AMCC_OP_REG_MCSR +
	152	3);
	153
2696fb57	154	/* Wait on busy */
c995fe94 ADG	155	do {
	156	dw_eeprom_busy =
	157	inl(dw_PCIBoardEepromAddress +
	158	AMCC_OP_REG_MCSR);
	159	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	160	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	161
2696fb57	162	/* Read data into the EEPROM */
c995fe94 ADG	163	*pb_ReadByte =
	164	inb(dw_PCIBoardEepromAddress +
	165	AMCC_OP_REG_MCSR + 2);
	166
2696fb57	167	/* Wait on busy */
c995fe94 ADG	168	do {
	169	dw_eeprom_busy =
	170	inl(dw_PCIBoardEepromAddress +
	171	AMCC_OP_REG_MCSR);
	172	dw_eeprom_busy = dw_eeprom_busy & EEPROM_BUSY;
ff89514f	173	} while (dw_eeprom_busy == EEPROM_BUSY);
c995fe94	174
2696fb57	175	/* Select the upper address part */
015fadba	176	if (i_Counter == 0)
c995fe94	177	b_ReadLowByte = pb_ReadByte[0];
015fadba	178	else
c995fe94	179	b_ReadHighByte = pb_ReadByte[0];
c995fe94	180
2696fb57	181	/* Sleep */
8605b3aa	182	msleep(1);
c995fe94 ADG	183
	184	}
	185	w_ReadWord =
	186	(b_ReadLowByte \| (((unsigned short)b_ReadHighByte) *
	187	256));
	188
	189	pw_DataRead[i_WordCounter] = w_ReadWord;
	190
2696fb57	191	w_EepromStartAddress += 2; /* to read the next word */
c995fe94	192
2696fb57	193	} /* for (...) i_NbOfWordsToRead */
dae0dc30	194	return 0;
c995fe94	195	}