[people/ms/u-boot.git] / cmd / portio.c

/*
 * (C) Copyright 2003
 * Marc Singer, elf@buici.com
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

/*
 * 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 * const argv[])
{
	uint addr = out_last_addr;
	uint size = out_last_size;
	uint value = out_last_value;

	if (argc != 3)
		return CMD_RET_USAGE;

	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 * const argv[])
{
	uint addr = in_last_addr;
	uint size = in_last_size;

	if (argc != 2)
		return CMD_RET_USAGE;

	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	*
1a459660	5	* SPDX-License-Identifier: GPL-2.0+
7a8e9bed WD	6	*/
	7
	8	/*
	9	* Port I/O Functions
	10	*
	11	* Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
	12	*/
	13
	14	#include <common.h>
	15	#include <command.h>
7a8e9bed	16
7a8e9bed WD	17	/* Display values from last command.
	18	* Memory modify remembered values are different from display memory.
	19	*/
	20	static uint in_last_addr, in_last_size;
	21	static uint out_last_addr, out_last_size, out_last_value;
	22
	23
54841ab5	24	int do_portio_out (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
7a8e9bed WD	25	{
	26	uint addr = out_last_addr;
	27	uint size = out_last_size;
	28	uint value = out_last_value;
	29
47e26b1b	30	if (argc != 3)
4c12eeb8	31	return CMD_RET_USAGE;
7a8e9bed WD	32
7a8e9bed WD	33	if ((flag & CMD_FLAG_REPEAT) == 0) {
47e26b1b WD	34	/*
47e26b1b WD	35	* New command specified. Check for a size specification.
7a8e9bed WD	36	* Defaults to long if no or incorrect specification.
	37	*/
	38	size = cmd_get_data_size (argv[0], 1);
	39	addr = simple_strtoul (argv[1], NULL, 16);
	40	value = simple_strtoul (argv[2], NULL, 16);
	41	}
	42	#if defined (CONFIG_X86)
	43
	44	{
	45	unsigned short port = addr;
	46
	47	switch (size) {
	48	default:
	49	case 1:
	50	{
	51	unsigned char ch = value;
	52	__asm__ volatile ("out %0, %%dx"::"a" (ch), "d" (port));
	53	}
	54	break;
	55	case 2:
	56	{
	57	unsigned short w = value;
	58	__asm__ volatile ("out %0, %%dx"::"a" (w), "d" (port));
	59	}
	60	break;
	61	case 4:
	62	__asm__ volatile ("out %0, %%dx"::"a" (value), "d" (port));
	63
	64	break;
	65	}
	66	}
	67
	68	#endif /* CONFIG_X86 */
	69
	70	out_last_addr = addr;
	71	out_last_size = size;
	72	out_last_value = value;
	73
	74	return 0;
	75	}
	76
0d498393 WD	77	U_BOOT_CMD(
0d498393 WD	78	out, 3, 1, do_portio_out,
2fb2604d	79	"write datum to IO port",
a89c33db	80	"[.b, .w, .l] port value\n - output to IO port"
b0fce99b WD	81	);
b0fce99b WD	82
54841ab5	83	int do_portio_in (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
7a8e9bed WD	84	{
	85	uint addr = in_last_addr;
	86	uint size = in_last_size;
	87
47e26b1b	88	if (argc != 2)
4c12eeb8	89	return CMD_RET_USAGE;
7a8e9bed WD	90
7a8e9bed WD	91	if ((flag & CMD_FLAG_REPEAT) == 0) {
47e26b1b WD	92	/*
47e26b1b WD	93	* New command specified. Check for a size specification.
7a8e9bed WD	94	* Defaults to long if no or incorrect specification.
	95	*/
	96	size = cmd_get_data_size (argv[0], 1);
	97	addr = simple_strtoul (argv[1], NULL, 16);
	98	}
	99	#if defined (CONFIG_X86)
	100
	101	{
	102	unsigned short port = addr;
	103
	104	switch (size) {
	105	default:
	106	case 1:
	107	{
	108	unsigned char ch;
	109	__asm__ volatile ("in %%dx, %0":"=a" (ch):"d" (port));
	110
	111	printf (" %02x\n", ch);
	112	}
	113	break;
	114	case 2:
	115	{
	116	unsigned short w;
	117	__asm__ volatile ("in %%dx, %0":"=a" (w):"d" (port));
	118
	119	printf (" %04x\n", w);
	120	}
	121	break;
	122	case 4:
	123	{
	124	unsigned long l;
	125	__asm__ volatile ("in %%dx, %0":"=a" (l):"d" (port));
	126
	127	printf (" %08lx\n", l);
	128	}
	129	break;
	130	}
	131	}
	132	#endif /* CONFIG_X86 */
	133
	134	in_last_addr = addr;
	135	in_last_size = size;
	136
	137	return 0;
	138	}
	139
0d498393 WD	140	U_BOOT_CMD(
0d498393 WD	141	in, 2, 1, do_portio_in,
2fb2604d	142	"read data from an IO port",
b0fce99b	143	"[.b, .w, .l] port\n"
a89c33db	144	" - read datum from IO port"
b0fce99b	145	);