mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-10-30 19:48:19 +00:00 
			
		
		
		
	It is a pain to have to specify the value 16 in each call. Add a new hextoul() function and update the code to use it. Add a proper comment to simple_strtoul() while we are here. Signed-off-by: Simon Glass <sjg@chromium.org>
		
			
				
	
	
		
			388 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			388 lines
		
	
	
		
			6.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * (C) Copyright 2007 Michal Simek
 | |
|  *
 | |
|  * Michal  SIMEK <monstr@monstr.eu>
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * Microblaze FSL support
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <config.h>
 | |
| #include <command.h>
 | |
| #include <asm/asm.h>
 | |
| 
 | |
| int do_frd(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
 | |
| {
 | |
| 	unsigned int fslnum;
 | |
| 	unsigned int num;
 | |
| 	unsigned int blocking;
 | |
| 
 | |
| 	if (argc < 2)
 | |
| 		return CMD_RET_USAGE;
 | |
| 
 | |
| 	fslnum = (unsigned int)hextoul(argv[1], NULL);
 | |
| 	blocking = (unsigned int)hextoul(argv[2], NULL);
 | |
| 	if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER) {
 | |
| 		puts ("Bad number of FSL\n");
 | |
| 		return CMD_RET_USAGE;
 | |
| 	}
 | |
| 
 | |
| 	switch (fslnum) {
 | |
| #if (XILINX_FSL_NUMBER > 0)
 | |
| 	case 0:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 0);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 0);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 0);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 0);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 1)
 | |
| 	case 1:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 1);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 1);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 1);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 1);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 2)
 | |
| 	case 2:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 2);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 2);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 2);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 2);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 3)
 | |
| 	case 3:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 3);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 3);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 3);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 3);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 4)
 | |
| 	case 4:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 4);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 4);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 4);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 4);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 5)
 | |
| 	case 5:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 5);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 5);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 5);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 5);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 6)
 | |
| 	case 6:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 6);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 6);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 6);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 6);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 7)
 | |
| 	case 7:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NGET (num, 7);
 | |
| 			break;
 | |
| 		case 1:	NCGET (num, 7);
 | |
| 			break;
 | |
| 		case 2:	GET (num, 7);
 | |
| 			break;
 | |
| 		case 3:	CGET (num, 7);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| 	default:
 | |
| 		return 1;
 | |
| 	}
 | |
| 
 | |
| 	printf ("%01x: 0x%08x - %s %s read\n", fslnum, num,
 | |
| 		blocking < 2  ? "non blocking" : "blocking",
 | |
| 		((blocking == 1) || (blocking == 3)) ? "control" : "data" );
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int do_fwr(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
 | |
| {
 | |
| 	unsigned int fslnum;
 | |
| 	unsigned int num;
 | |
| 	unsigned int blocking;
 | |
| 
 | |
| 	if (argc < 3)
 | |
| 		return CMD_RET_USAGE;
 | |
| 
 | |
| 	fslnum = (unsigned int)hextoul(argv[1], NULL);
 | |
| 	num = (unsigned int)hextoul(argv[2], NULL);
 | |
| 	blocking = (unsigned int)hextoul(argv[3], NULL);
 | |
| 	if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER)
 | |
| 		return CMD_RET_USAGE;
 | |
| 
 | |
| 	switch (fslnum) {
 | |
| #if (XILINX_FSL_NUMBER > 0)
 | |
| 	case 0:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 0);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 0);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 0);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 0);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 1)
 | |
| 	case 1:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 1);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 1);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 1);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 1);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 2)
 | |
| 	case 2:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 2);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 2);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 2);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 2);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 3)
 | |
| 	case 3:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 3);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 3);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 3);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 3);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 4)
 | |
| 	case 4:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 4);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 4);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 4);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 4);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 5)
 | |
| 	case 5:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 5);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 5);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 5);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 5);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 6)
 | |
| 	case 6:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 6);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 6);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 6);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 6);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| #if (XILINX_FSL_NUMBER > 7)
 | |
| 	case 7:
 | |
| 		switch (blocking) {
 | |
| 		case 0:	NPUT (num, 7);
 | |
| 			break;
 | |
| 		case 1:	NCPUT (num, 7);
 | |
| 			break;
 | |
| 		case 2:	PUT (num, 7);
 | |
| 			break;
 | |
| 		case 3:	CPUT (num, 7);
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 2;
 | |
| 		}
 | |
| 		break;
 | |
| #endif
 | |
| 	default:
 | |
| 		return 1;
 | |
| 	}
 | |
| 
 | |
| 	printf ("%01x: 0x%08x - %s %s write\n", fslnum, num,
 | |
| 		blocking < 2  ? "non blocking" : "blocking",
 | |
| 		((blocking == 1) || (blocking == 3)) ? "control" : "data" );
 | |
| 	return 0;
 | |
| 
 | |
| }
 | |
| 
 | |
| int do_rspr(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
 | |
| {
 | |
| 	unsigned int reg = 0;
 | |
| 	unsigned int val = 0;
 | |
| 
 | |
| 	if (argc < 2)
 | |
| 		return CMD_RET_USAGE;
 | |
| 
 | |
| 	reg = (unsigned int)hextoul(argv[1], NULL);
 | |
| 	val = (unsigned int)hextoul(argv[2], NULL);
 | |
| 	switch (reg) {
 | |
| 	case 0x1:
 | |
| 		if (argc > 2) {
 | |
| 			MTS (val, rmsr);
 | |
| 			NOP;
 | |
| 			MFS (val, rmsr);
 | |
| 		} else {
 | |
| 			MFS (val, rmsr);
 | |
| 		}
 | |
| 		puts ("MSR");
 | |
| 		break;
 | |
| 	case 0x3:
 | |
| 		MFS (val, rear);
 | |
| 		puts ("EAR");
 | |
| 		break;
 | |
| 	case 0x5:
 | |
| 		MFS (val, resr);
 | |
| 		puts ("ESR");
 | |
| 		break;
 | |
| 	default:
 | |
| 		puts ("Unsupported register\n");
 | |
| 		return 1;
 | |
| 	}
 | |
| 	printf (": 0x%08x\n", val);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /***************************************************/
 | |
| 
 | |
| U_BOOT_CMD (frd, 3, 1, do_frd,
 | |
| 		"read data from FSL",
 | |
| 		"- [fslnum [0|1|2|3]]\n"
 | |
| 		" 0 - non blocking data read\n"
 | |
| 		" 1 - non blocking control read\n"
 | |
| 		" 2 - blocking data read\n"
 | |
| 		" 3 - blocking control read");
 | |
| 
 | |
| U_BOOT_CMD (fwr, 4, 1, do_fwr,
 | |
| 		"write data to FSL",
 | |
| 		"- [fslnum [0|1|2|3]]\n"
 | |
| 		" 0 - non blocking data write\n"
 | |
| 		" 1 - non blocking control write\n"
 | |
| 		" 2 - blocking data write\n"
 | |
| 		" 3 - blocking control write");
 | |
| 
 | |
| U_BOOT_CMD (rspr, 3, 1, do_rspr,
 | |
| 		"read/write special purpose register",
 | |
| 		"- reg_num [write value] read/write special purpose register\n"
 | |
| 		" 1 - MSR - Machine status register\n"
 | |
| 		" 3 - EAR - Exception address register\n"
 | |
| 		" 5 - ESR - Exception status register");
 |