[mirror_ubuntu-zesty-kernel.git] / arch / m32r / kernel / io_usrv.c

/*
 *  linux/arch/m32r/kernel/io_usrv.c
 *
 *  Typical I/O routines for uServer board.
 *
 *  Copyright (c) 2001-2005  Hiroyuki Kondo, Hirokazu Takata,
 *                           Hitoshi Yamamoto, Takeo Takahashi
 *
 *  This file is subject to the terms and conditions of the GNU General
 *  Public License.  See the file "COPYING" in the main directory of this
 *  archive for more details.
 *
 */

#include <linux/config.h>
#include <asm/m32r.h>
#include <asm/page.h>
#include <asm/io.h>

#include <linux/types.h>
#include "../drivers/m32r_cfc.h"

extern void pcc_ioread_byte(int, unsigned long, void *, size_t, size_t, int);
extern void pcc_ioread_word(int, unsigned long, void *, size_t, size_t, int);
extern void pcc_iowrite_byte(int, unsigned long, void *, size_t, size_t, int);
extern void pcc_iowrite_word(int, unsigned long, void *, size_t, size_t, int);
#define CFC_IOSTART	CFC_IOPORT_BASE
#define CFC_IOEND	(CFC_IOSTART + (M32R_PCC_MAPSIZE * M32R_MAX_PCC) - 1)

#if defined(CONFIG_SERIAL_8250) || defined(CONFIG_SERIAL_8250_MODULE)
#define UART0_REGSTART		0x04c20000
#define UART1_REGSTART		0x04c20100
#define UART_IOMAP_SIZE		8
#define UART0_IOSTART		0x3f8
#define UART0_IOEND		(UART0_IOSTART + UART_IOMAP_SIZE - 1)
#define UART1_IOSTART		0x2f8
#define UART1_IOEND		(UART1_IOSTART + UART_IOMAP_SIZE - 1)
#endif	/* CONFIG_SERIAL_8250 || CONFIG_SERIAL_8250_MODULE */

#define PORT2ADDR(port)	_port2addr(port)

static inline void *_port2addr(unsigned long port)
{
#if defined(CONFIG_SERIAL_8250) || defined(CONFIG_SERIAL_8250_MODULE)
	if (port >= UART0_IOSTART && port <= UART0_IOEND)
		port = ((port - UART0_IOSTART) << 1) + UART0_REGSTART;
	else if (port >= UART1_IOSTART && port <= UART1_IOEND)
		port = ((port - UART1_IOSTART) << 1) + UART1_REGSTART;
#endif	/* CONFIG_SERIAL_8250 || CONFIG_SERIAL_8250_MODULE */
	return (void *)(port | (NONCACHE_OFFSET));
}

static inline void delay(void)
{
	__asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
}

unsigned char _inb(unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
		unsigned char b;
		pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
		return b;
	} else
		return *(volatile unsigned char *)PORT2ADDR(port);
}

unsigned short _inw(unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
		unsigned short w;
		pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
		return w;
	} else
		return *(volatile unsigned short *)PORT2ADDR(port);
}

unsigned long _inl(unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
		unsigned long l;
		pcc_ioread_word(0, port, &l, sizeof(l), 1, 0);
		return l;
	} else
		return *(volatile unsigned long *)PORT2ADDR(port);
}

unsigned char _inb_p(unsigned long port)
{
	unsigned char v = _inb(port);
	delay();
	return v;
}

unsigned short _inw_p(unsigned long port)
{
	unsigned short v = _inw(port);
	delay();
	return v;
}

unsigned long _inl_p(unsigned long port)
{
	unsigned long v = _inl(port);
	delay();
	return v;
}

void _outb(unsigned char b, unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
	else
		*(volatile unsigned char *)PORT2ADDR(port) = b;
}

void _outw(unsigned short w, unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
	else
		*(volatile unsigned short *)PORT2ADDR(port) = w;
}

void _outl(unsigned long l, unsigned long port)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_iowrite_word(0, port, &l, sizeof(l), 1, 0);
	else
		*(volatile unsigned long *)PORT2ADDR(port) = l;
}

void _outb_p(unsigned char b, unsigned long port)
{
	_outb(b, port);
	delay();
}

void _outw_p(unsigned short w, unsigned long port)
{
	_outw(w, port);
	delay();
}

void _outl_p(unsigned long l, unsigned long port)
{
	_outl(l, port);
	delay();
}

void _insb(unsigned int port, void * addr, unsigned long count)
{
	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_ioread_byte(0, port, addr, sizeof(unsigned char), count, 1);
	else {
		unsigned char *buf = addr;
		unsigned char *portp = PORT2ADDR(port);
		while (count--)
			*buf++ = *(volatile unsigned char *)portp;
	}
}

void _insw(unsigned int port, void * addr, unsigned long count)
{
	unsigned short *buf = addr;
	unsigned short *portp;

	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_ioread_word(0, port, addr, sizeof(unsigned short), count,
			1);
	else {
		portp = PORT2ADDR(port);
		while (count--)
			*buf++ = *(volatile unsigned short *)portp;
	}
}

void _insl(unsigned int port, void * addr, unsigned long count)
{
	unsigned long *buf = addr;
	unsigned long *portp;

	portp = PORT2ADDR(port);
	while (count--)
		*buf++ = *(volatile unsigned long *)portp;
}

void _outsb(unsigned int port, const void * addr, unsigned long count)
{
	const unsigned char *buf = addr;
	unsigned char *portp;

	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_iowrite_byte(0, port, (void *)addr, sizeof(unsigned char),
			count, 1);
	else {
		portp = PORT2ADDR(port);
		while (count--)
			*(volatile unsigned char *)portp = *buf++;
	}
}

void _outsw(unsigned int port, const void * addr, unsigned long count)
{
	const unsigned short *buf = addr;
	unsigned short *portp;

	if (port >= CFC_IOSTART && port <= CFC_IOEND)
		pcc_iowrite_word(0, port, (void *)addr, sizeof(unsigned short),
			count, 1);
	else {
		portp = PORT2ADDR(port);
		while (count--)
			*(volatile unsigned short *)portp = *buf++;
	}
}

void _outsl(unsigned int port, const void * addr, unsigned long count)
{
	const unsigned long *buf = addr;
	unsigned char *portp;

	portp = PORT2ADDR(port);
	while (count--)
		*(volatile unsigned long *)portp = *buf++;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/arch/m32r/kernel/io_usrv.c
	3	*
	4	* Typical I/O routines for uServer board.
	5	*
23680863 HT	6	* Copyright (c) 2001-2005 Hiroyuki Kondo, Hirokazu Takata,
23680863 HT	7	* Hitoshi Yamamoto, Takeo Takahashi
1da177e4 LT	8	*
	9	* This file is subject to the terms and conditions of the GNU General
	10	* Public License. See the file "COPYING" in the main directory of this
	11	* archive for more details.
	12	*
	13	*/
	14
	15	#include <linux/config.h>
	16	#include <asm/m32r.h>
	17	#include <asm/page.h>
	18	#include <asm/io.h>
	19
	20	#include <linux/types.h>
	21	#include "../drivers/m32r_cfc.h"
	22
	23	extern void pcc_ioread_byte(int, unsigned long, void *, size_t, size_t, int);
	24	extern void pcc_ioread_word(int, unsigned long, void *, size_t, size_t, int);
	25	extern void pcc_iowrite_byte(int, unsigned long, void *, size_t, size_t, int);
	26	extern void pcc_iowrite_word(int, unsigned long, void *, size_t, size_t, int);
	27	#define CFC_IOSTART CFC_IOPORT_BASE
	28	#define CFC_IOEND (CFC_IOSTART + (M32R_PCC_MAPSIZE * M32R_MAX_PCC) - 1)
	29
	30	#if defined(CONFIG_SERIAL_8250) \|\| defined(CONFIG_SERIAL_8250_MODULE)
	31	#define UART0_REGSTART 0x04c20000
	32	#define UART1_REGSTART 0x04c20100
	33	#define UART_IOMAP_SIZE 8
	34	#define UART0_IOSTART 0x3f8
	35	#define UART0_IOEND (UART0_IOSTART + UART_IOMAP_SIZE - 1)
	36	#define UART1_IOSTART 0x2f8
	37	#define UART1_IOEND (UART1_IOSTART + UART_IOMAP_SIZE - 1)
	38	#endif /* CONFIG_SERIAL_8250 \|\| CONFIG_SERIAL_8250_MODULE */
	39
	40	#define PORT2ADDR(port) _port2addr(port)
	41
23680863	42	static inline void *_port2addr(unsigned long port)
1da177e4 LT	43	{
	44	#if defined(CONFIG_SERIAL_8250) \|\| defined(CONFIG_SERIAL_8250_MODULE)
	45	if (port >= UART0_IOSTART && port <= UART0_IOEND)
	46	port = ((port - UART0_IOSTART) << 1) + UART0_REGSTART;
	47	else if (port >= UART1_IOSTART && port <= UART1_IOEND)
	48	port = ((port - UART1_IOSTART) << 1) + UART1_REGSTART;
	49	#endif /* CONFIG_SERIAL_8250 \|\| CONFIG_SERIAL_8250_MODULE */
1343f776	50	return (void *)(port \| (NONCACHE_OFFSET));
1da177e4 LT	51	}
1da177e4 LT	52
23680863	53	static inline void delay(void)
1da177e4 LT	54	{
	55	__asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
	56	}
	57
	58	unsigned char _inb(unsigned long port)
	59	{
	60	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
	61	unsigned char b;
	62	pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
	63	return b;
	64	} else
	65	return (volatile unsigned char )PORT2ADDR(port);
	66	}
	67
	68	unsigned short _inw(unsigned long port)
	69	{
	70	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
	71	unsigned short w;
	72	pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
	73	return w;
	74	} else
	75	return (volatile unsigned short )PORT2ADDR(port);
	76	}
	77
	78	unsigned long _inl(unsigned long port)
	79	{
	80	if (port >= CFC_IOSTART && port <= CFC_IOEND) {
	81	unsigned long l;
	82	pcc_ioread_word(0, port, &l, sizeof(l), 1, 0);
	83	return l;
	84	} else
	85	return (volatile unsigned long )PORT2ADDR(port);
	86	}
	87
	88	unsigned char _inb_p(unsigned long port)
	89	{
23680863 HT	90	unsigned char v = _inb(port);
	91	delay();
	92	return v;
1da177e4 LT	93	}
	94
	95	unsigned short _inw_p(unsigned long port)
	96	{
23680863 HT	97	unsigned short v = _inw(port);
	98	delay();
	99	return v;
1da177e4 LT	100	}
	101
	102	unsigned long _inl_p(unsigned long port)
	103	{
23680863	104	unsigned long v = _inl(port);
1da177e4	105	delay();
1da177e4 LT	106	return v;
	107	}
	108
	109	void _outb(unsigned char b, unsigned long port)
	110	{
	111	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	112	pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
	113	else
	114	(volatile unsigned char )PORT2ADDR(port) = b;
	115	}
	116
	117	void _outw(unsigned short w, unsigned long port)
	118	{
	119	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	120	pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
	121	else
	122	(volatile unsigned short )PORT2ADDR(port) = w;
	123	}
	124
	125	void _outl(unsigned long l, unsigned long port)
	126	{
	127	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	128	pcc_iowrite_word(0, port, &l, sizeof(l), 1, 0);
	129	else
	130	(volatile unsigned long )PORT2ADDR(port) = l;
	131	}
	132
	133	void _outb_p(unsigned char b, unsigned long port)
	134	{
23680863	135	_outb(b, port);
1da177e4 LT	136	delay();
	137	}
	138
	139	void _outw_p(unsigned short w, unsigned long port)
	140	{
23680863	141	_outw(w, port);
1da177e4 LT	142	delay();
	143	}
	144
	145	void _outl_p(unsigned long l, unsigned long port)
	146	{
23680863	147	_outl(l, port);
1da177e4 LT	148	delay();
	149	}
	150
	151	void _insb(unsigned int port, void * addr, unsigned long count)
	152	{
	153	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	154	pcc_ioread_byte(0, port, addr, sizeof(unsigned char), count, 1);
	155	else {
	156	unsigned char *buf = addr;
	157	unsigned char *portp = PORT2ADDR(port);
	158	while (count--)
	159	buf++ = (volatile unsigned char *)portp;
	160	}
	161	}
	162
	163	void _insw(unsigned int port, void * addr, unsigned long count)
	164	{
	165	unsigned short *buf = addr;
	166	unsigned short *portp;
	167
	168	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	169	pcc_ioread_word(0, port, addr, sizeof(unsigned short), count,
	170	1);
	171	else {
	172	portp = PORT2ADDR(port);
	173	while (count--)
	174	buf++ = (volatile unsigned short *)portp;
	175	}
	176	}
	177
	178	void _insl(unsigned int port, void * addr, unsigned long count)
	179	{
	180	unsigned long *buf = addr;
	181	unsigned long *portp;
	182
	183	portp = PORT2ADDR(port);
	184	while (count--)
	185	buf++ = (volatile unsigned long *)portp;
	186	}
	187
	188	void _outsb(unsigned int port, const void * addr, unsigned long count)
	189	{
	190	const unsigned char *buf = addr;
	191	unsigned char *portp;
	192
	193	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	194	pcc_iowrite_byte(0, port, (void *)addr, sizeof(unsigned char),
	195	count, 1);
	196	else {
	197	portp = PORT2ADDR(port);
	198	while (count--)
	199	(volatile unsigned char )portp = *buf++;
	200	}
	201	}
	202
	203	void _outsw(unsigned int port, const void * addr, unsigned long count)
	204	{
	205	const unsigned short *buf = addr;
	206	unsigned short *portp;
	207
	208	if (port >= CFC_IOSTART && port <= CFC_IOEND)
	209	pcc_iowrite_word(0, port, (void *)addr, sizeof(unsigned short),
	210	count, 1);
	211	else {
212	portp = PORT2ADDR(port);
213	while (count--)
214	(volatile unsigned short )portp = *buf++;
215	}
216	}
217
218	void _outsl(unsigned int port, const void * addr, unsigned long count)
219	{
220	const unsigned long *buf = addr;
221	unsigned char *portp;
222
223	portp = PORT2ADDR(port);
224	while (count--)
225	(volatile unsigned long )portp = *buf++;
226	}