Whitebox
/
u-boot
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

new: FSL and MSR support

Browse Source
master
Michal Simek 18 years ago
parent 144876a380
commit f7e2e0eb06
2 changed files with 302 additions and 0 deletions
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Show Stats Download Patch File Download Diff File
  1. 265
      common/cmd_mfsl.c
  2. 37
      include/asm-microblaze/asm.h

265
common/cmd_mfsl.c
Unescape View File

@ -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 */

37
include/asm-microblaze/asm.h
Unescape View File

@ -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));
Write Preview
Loading…
Cancel
Save