parent
144876a380
commit
f7e2e0eb06
@ -0,0 +1,265 @@ |
|||||||
|
/*
|
||||||
|
* (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[]) |
||||||
|
{ |
||||||
|
int val = 0; |
||||||
|
|
||||||
|
if (argc < 1) { |
||||||
|
printf ("Usage:\n%s\n", cmdtp->usage); |
||||||
|
return 1; |
||||||
|
} |
||||||
|
RMSR (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, 1, 1, do_rmsr, |
||||||
|
"rmsr - read MSR register\n", "- read MSR register.\n"); |
||||||
|
|
||||||
|
#endif /* CONFIG_MICROBLAZE & CFG_CMD_MFSL */ |
@ -0,0 +1,37 @@ |
|||||||
|
/*
|
||||||
|
* (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 |
||||||
|
*/ |
||||||
|
|
||||||
|
/* FSL macros */ |
||||||
|
#define NGET(val, fslnum) \ |
||||||
|
__asm__ __volatile__ ("nget %0, rfsl" #fslnum :"=r" (val)); |
||||||
|
#define GET(val, fslnum) \ |
||||||
|
__asm__ __volatile__ ("get %0, rfsl" #fslnum :"=r" (val)); |
||||||
|
#define NPUT(val, fslnum) \ |
||||||
|
__asm__ __volatile__ ("nput %0, rfsl" #fslnum ::"r" (val)); |
||||||
|
#define PUT(val, fslnum) \ |
||||||
|
__asm__ __volatile__ ("put %0, rfsl" #fslnum ::"r" (val)); |
||||||
|
|
||||||
|
/* CPU dependent */ |
||||||
|
#define RMSR(val) \ |
||||||
|
__asm__ __volatile__ ("mfs %0,rmsr":"=r" (val)); |
Loading…
Reference in new issue