forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
387 lines
6.7 KiB
387 lines
6.7 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* (C) Copyright 2007 Michal Simek |
|
* |
|
* Michal SIMEK <[email protected]> |
|
*/ |
|
|
|
/* |
|
* Microblaze FSL support |
|
*/ |
|
|
|
#include <common.h> |
|
#include <config.h> |
|
#include <command.h> |
|
#include <asm/asm.h> |
|
|
|
int do_frd (cmd_tbl_t * 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)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"); |
|
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 (cmd_tbl_t * 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)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) |
|
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 (cmd_tbl_t * 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)simple_strtoul (argv[1], NULL, 16); |
|
val = (unsigned int)simple_strtoul (argv[2], NULL, 16); |
|
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");
|
|
|