[people/ms/u-boot.git] / common / cmd_portio.c

/*
 * (C) Copyright 2003
 * Marc Singer, elf@buici.com
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * 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
 */

/*
 * Port I/O Functions
 *
 * Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
 */

#include <common.h>
#include <command.h>

/* Display values from last command.
 * Memory modify remembered values are different from display memory.
 */
static uint in_last_addr, in_last_size;
static uint out_last_addr, out_last_size, out_last_value;


int do_portio_out (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	uint addr = out_last_addr;
	uint size = out_last_size;
	uint value = out_last_value;

	if (argc != 3) {
		cmd_usage(cmdtp);
		return 1;
	}

	if ((flag & CMD_FLAG_REPEAT) == 0) {
		/* New command specified.  Check for a size specification.
		 * Defaults to long if no or incorrect specification.
		 */
		size = cmd_get_data_size (argv[0], 1);
		addr = simple_strtoul (argv[1], NULL, 16);
		value = simple_strtoul (argv[2], NULL, 16);
	}
#if defined (CONFIG_X86)

	{
		unsigned short port = addr;

		switch (size) {
		default:
		case 1:
		    {
			unsigned char ch = value;
			__asm__ volatile ("out %0, %%dx"::"a" (ch), "d" (port));
		    }
			break;
		case 2:
		    {
			unsigned short w = value;
			__asm__ volatile ("out %0, %%dx"::"a" (w), "d" (port));
		    }
			break;
		case 4:
			__asm__ volatile ("out %0, %%dx"::"a" (value), "d" (port));

			break;
		}
	}

#endif							/* CONFIG_X86 */

	out_last_addr = addr;
	out_last_size = size;
	out_last_value = value;

	return 0;
}

U_BOOT_CMD(
	out,	3,	1,	do_portio_out,
	"write datum to IO port",
	"[.b, .w, .l] port value\n    - output to IO port"
);

int do_portio_in (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	uint addr = in_last_addr;
	uint size = in_last_size;

	if (argc != 2) {
		cmd_usage(cmdtp);
		return 1;
	}

	if ((flag & CMD_FLAG_REPEAT) == 0) {
		/* New command specified.  Check for a size specification.
		 * Defaults to long if no or incorrect specification.
		 */
		size = cmd_get_data_size (argv[0], 1);
		addr = simple_strtoul (argv[1], NULL, 16);
	}
#if defined (CONFIG_X86)

	{
		unsigned short port = addr;

		switch (size) {
		default:
		case 1:
		    {
			unsigned char ch;
			__asm__ volatile ("in %%dx, %0":"=a" (ch):"d" (port));

			printf (" %02x\n", ch);
		    }
			break;
		case 2:
		    {
			unsigned short w;
			__asm__ volatile ("in %%dx, %0":"=a" (w):"d" (port));

			printf (" %04x\n", w);
		    }
			break;
		case 4:
		    {
			unsigned long l;
			__asm__ volatile ("in %%dx, %0":"=a" (l):"d" (port));

			printf (" %08lx\n", l);
		    }
			break;
		}
	}
#endif	/* CONFIG_X86 */

	in_last_addr = addr;
	in_last_size = size;

	return 0;
}

U_BOOT_CMD(
	in,	2,	1,	do_portio_in,
	"read data from an IO port",
	"[.b, .w, .l] port\n"
	"    - read datum from IO port"
);
Commit	Line	Data
7a8e9bed WD	1	/*
	2	* (C) Copyright 2003
	3	* Marc Singer, elf@buici.com
	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*/
	23
	24	/*
	25	* Port I/O Functions
	26	*
	27	* Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
	28	*/
	29
	30	#include <common.h>
	31	#include <command.h>
7a8e9bed	32
7a8e9bed WD	33	/* Display values from last command.
	34	* Memory modify remembered values are different from display memory.
	35	*/
	36	static uint in_last_addr, in_last_size;
	37	static uint out_last_addr, out_last_size, out_last_value;
	38
	39
	40	int do_portio_out (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	41	{
	42	uint addr = out_last_addr;
	43	uint size = out_last_size;
	44	uint value = out_last_value;
	45
	46	if (argc != 3) {
62c3ae7c	47	cmd_usage(cmdtp);
7a8e9bed WD	48	return 1;
	49	}
	50
	51	if ((flag & CMD_FLAG_REPEAT) == 0) {
	52	/* New command specified. Check for a size specification.
	53	* Defaults to long if no or incorrect specification.
	54	*/
	55	size = cmd_get_data_size (argv[0], 1);
	56	addr = simple_strtoul (argv[1], NULL, 16);
	57	value = simple_strtoul (argv[2], NULL, 16);
	58	}
	59	#if defined (CONFIG_X86)
	60
	61	{
	62	unsigned short port = addr;
	63
	64	switch (size) {
	65	default:
	66	case 1:
	67	{
	68	unsigned char ch = value;
	69	__asm__ volatile ("out %0, %%dx"::"a" (ch), "d" (port));
	70	}
	71	break;
	72	case 2:
	73	{
	74	unsigned short w = value;
	75	__asm__ volatile ("out %0, %%dx"::"a" (w), "d" (port));
	76	}
	77	break;
	78	case 4:
	79	__asm__ volatile ("out %0, %%dx"::"a" (value), "d" (port));
	80
	81	break;
	82	}
	83	}
	84
	85	#endif /* CONFIG_X86 */
	86
	87	out_last_addr = addr;
	88	out_last_size = size;
	89	out_last_value = value;
	90
	91	return 0;
	92	}
	93
0d498393 WD	94	U_BOOT_CMD(
0d498393 WD	95	out, 3, 1, do_portio_out,
2fb2604d	96	"write datum to IO port",
a89c33db	97	"[.b, .w, .l] port value\n - output to IO port"
b0fce99b WD	98	);
b0fce99b WD	99
7a8e9bed WD	100	int do_portio_in (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	101	{
	102	uint addr = in_last_addr;
	103	uint size = in_last_size;
	104
	105	if (argc != 2) {
62c3ae7c	106	cmd_usage(cmdtp);
7a8e9bed WD	107	return 1;
	108	}
	109
	110	if ((flag & CMD_FLAG_REPEAT) == 0) {
	111	/* New command specified. Check for a size specification.
	112	* Defaults to long if no or incorrect specification.
	113	*/
	114	size = cmd_get_data_size (argv[0], 1);
	115	addr = simple_strtoul (argv[1], NULL, 16);
	116	}
	117	#if defined (CONFIG_X86)
	118
	119	{
	120	unsigned short port = addr;
	121
	122	switch (size) {
	123	default:
	124	case 1:
	125	{
	126	unsigned char ch;
	127	__asm__ volatile ("in %%dx, %0":"=a" (ch):"d" (port));
	128
	129	printf (" %02x\n", ch);
	130	}
	131	break;
	132	case 2:
	133	{
	134	unsigned short w;
	135	__asm__ volatile ("in %%dx, %0":"=a" (w):"d" (port));
	136
	137	printf (" %04x\n", w);
	138	}
	139	break;
	140	case 4:
	141	{
	142	unsigned long l;
	143	__asm__ volatile ("in %%dx, %0":"=a" (l):"d" (port));
	144
	145	printf (" %08lx\n", l);
	146	}
	147	break;
	148	}
	149	}
	150	#endif /* CONFIG_X86 */
	151
	152	in_last_addr = addr;
	153	in_last_size = size;
	154
	155	return 0;
	156	}
	157
0d498393 WD	158	U_BOOT_CMD(
0d498393 WD	159	in, 2, 1, do_portio_in,
2fb2604d	160	"read data from an IO port",
b0fce99b	161	"[.b, .w, .l] port\n"
a89c33db	162	" - read datum from IO port"
b0fce99b	163	);