common/cmd_mfsl.c

/*
 * (C) Copyright 2007 Michal Simek
 *
 * Michal  SIMEK <monstr@monstr.eu>
 *
 * 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
 */

/*
 * Microblaze FSL support
 */

#include <common.h>
#include <config.h>
#include <command.h>
#include <asm/asm.h>

#if (CONFIG_COMMANDS & CFG_CMD_MFSL)

int do_frd (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	unsigned int fslnum;
	unsigned int num;
	unsigned int blocking;

	if (argc < 2) {
		printf ("Usage:\n%s\n", cmdtp->usage);
		return 1;
	}

	fslnum = (unsigned int)simple_strtoul (argv[1], NULL, 16);
	blocking = (unsigned int)simple_strtoul (argv[2], NULL, 16);
	if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER) {
		puts ("Bad number of FSL\n");
		printf ("Usage:\n%s\n", cmdtp->usage);
		return 1;
	}

	switch (fslnum) {
#if (XILINX_FSL_NUMBER > 0)
	case 0:
		if (blocking) {
			GET (num, 0);
		} else {
			NGET (num, 0);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 1)
	case 1:
		if (blocking) {
			GET (num, 1);
		} else {
			NGET (num, 1);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 2)
	case 2:
		if (blocking) {
			GET (num, 2);
		} else {
			NGET (num, 2);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 3)
	case 3:
		if (blocking) {
			GET (num, 3);
		} else {
			NGET (num, 3);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 4)
	case 4:
		if (blocking) {
			GET (num, 4);
		} else {
			NGET (num, 4);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 5)
	case 5:
		if (blocking) {
			GET (num, 5);
		} else {
			NGET (num, 5);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 6)
	case 6:
		if (blocking) {
			GET (num, 6);
		} else {
			NGET (num, 6);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 7)
	case 7:
		if (blocking) {
			GET (num, 7);
		} else {
			NGET (num, 7);
		}
		break;
#endif
	default:
		return 1;
	}

	printf ("%01x: 0x%08lx - %s read\n", fslnum, num,
		blocking ? "blocking" : "non blocking");
	return 0;
}

int do_fwr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	unsigned int fslnum;
	unsigned int num;
	unsigned int blocking;

	if (argc < 3) {
		printf ("Usage:\n%s\n", cmdtp->usage);
		return 1;
	}

	fslnum = (unsigned int)simple_strtoul (argv[1], NULL, 16);
	num = (unsigned int)simple_strtoul (argv[2], NULL, 16);
	blocking = (unsigned int)simple_strtoul (argv[3], NULL, 16);
	if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER) {
		printf ("Bad number of FSL\nUsage:\n%s\n", cmdtp->usage);
		return 1;
	}

	switch (fslnum) {
#if (XILINX_FSL_NUMBER > 0)
	case 0:
		if (blocking) {
			PUT (num, 0);
		} else {
			NPUT (num, 0);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 1)
	case 1:
		if (blocking) {
			PUT (num, 1);
		} else {
			NPUT (num, 1);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 2)
	case 2:
		if (blocking) {
			PUT (num, 2);
		} else {
			NPUT (num, 2);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 3)
	case 3:
		if (blocking) {
			PUT (num, 3);
		} else {
			NPUT (num, 3);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 4)
	case 4:
		if (blocking) {
			PUT (num, 4);
		} else {
			NPUT (num, 4);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 5)
	case 5:
		if (blocking) {
			PUT (num, 5);
		} else {
			NPUT (num, 5);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 6)
	case 6:
		if (blocking) {
			PUT (num, 6);
		} else {
			NPUT (num, 6);
		}
		break;
#endif
#if (XILINX_FSL_NUMBER > 7)
	case 7:
		if (blocking) {
			PUT (num, 7);
		} else {
			NPUT (num, 7);
		}
		break;
#endif
	default:
		return 1;
	}

	printf ("%01x: 0x%08lx - %s write\n", fslnum, num,
		blocking ? "blocking" : "non blocking");
	return 0;

}

int do_rmsr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	unsigned int val = 0;

	val = (unsigned int)simple_strtoul (argv[1], NULL, 16);
	if (argc < 1) {
		printf ("Usage:\n%s\n", cmdtp->usage);
		return 1;
	}
	if (argc > 1) {
		MTS (val);
		MFS (val);
	} else {
		MFS (val);
	}
	printf ("rmsr: 0x%08lx\n", val);
	return 0;
}

/***************************************************/

U_BOOT_CMD (frd, 3, 1, do_frd,
	    "frd     - read data from FSL\n",
	    "- [fslnum [0|x]],  (0 - non blocking|x - blocking).\n");

U_BOOT_CMD (fwr, 4, 1, do_fwr,
	    "fwr     - write data to FSL\n",
	    "- [fslnum data [0|x]],  (0 - non blocking|x - blocking).\n");

U_BOOT_CMD (rmsr, 3, 1, do_rmsr,
	    "rmsr    - read MSR register\n", "- read MSR register.\n");

#endif				/* CONFIG_MICROBLAZE & CFG_CMD_MFSL */