common/cmd_mfsl.c

   1 /*
   2  * (C) Copyright 2007 Michal Simek
   3  *
   4  * Michal  SIMEK <monstr@monstr.eu>
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of
  12  * the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 /*
  26  * Microblaze FSL support
  27  */
  28
  29 #include <common.h>
  30 #include <config.h>
  31 #include <command.h>
  32 #include <asm/asm.h>
  33
  34 int do_frd (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
  35 {
  36         unsigned int fslnum;
  37         unsigned int num;
  38         unsigned int blocking;
  39
  40         if (argc < 2) {
  41                 cmd_usage(cmdtp);
  42                 return 1;
  43         }
  44
  45         fslnum = (unsigned int)simple_strtoul (argv[1], NULL, 16);
  46         blocking = (unsigned int)simple_strtoul (argv[2], NULL, 16);
  47         if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER) {
  48                 puts ("Bad number of FSL\n");
  49                 cmd_usage(cmdtp);
  50                 return 1;
  51         }
  52
  53         switch (fslnum) {
  54 #if (XILINX_FSL_NUMBER > 0)
  55         case 0:
  56                 switch (blocking) {
  57                 case 0: NGET (num, 0);
  58                         break;
  59                 case 1: NCGET (num, 0);
  60                         break;
  61                 case 2: GET (num, 0);
  62                         break;
  63                 case 3: CGET (num, 0);
  64                         break;
  65                 default:
  66                         return 2;
  67                 }
  68                 break;
  69 #endif
  70 #if (XILINX_FSL_NUMBER > 1)
  71         case 1:
  72                 switch (blocking) {
  73                 case 0: NGET (num, 1);
  74                         break;
  75                 case 1: NCGET (num, 1);
  76                         break;
  77                 case 2: GET (num, 1);
  78                         break;
  79                 case 3: CGET (num, 1);
  80                         break;
  81                 default:
  82                         return 2;
  83                 }
  84                 break;
  85 #endif
  86 #if (XILINX_FSL_NUMBER > 2)
  87         case 2:
  88                 switch (blocking) {
  89                 case 0: NGET (num, 2);
  90                         break;
  91                 case 1: NCGET (num, 2);
  92                         break;
  93                 case 2: GET (num, 2);
  94                         break;
  95                 case 3: CGET (num, 2);
  96                         break;
  97                 default:
  98                         return 2;
  99                 }
 100                 break;
 101 #endif
 102 #if (XILINX_FSL_NUMBER > 3)
 103         case 3:
 104                 switch (blocking) {
 105                 case 0: NGET (num, 3);
 106                         break;
 107                 case 1: NCGET (num, 3);
 108                         break;
 109                 case 2: GET (num, 3);
 110                         break;
 111                 case 3: CGET (num, 3);
 112                         break;
 113                 default:
 114                         return 2;
 115                 }
 116                 break;
 117 #endif
 118 #if (XILINX_FSL_NUMBER > 4)
 119         case 4:
 120                 switch (blocking) {
 121                 case 0: NGET (num, 4);
 122                         break;
 123                 case 1: NCGET (num, 4);
 124                         break;
 125                 case 2: GET (num, 4);
 126                         break;
 127                 case 3: CGET (num, 4);
 128                         break;
 129                 default:
 130                         return 2;
 131                 }
 132                 break;
 133 #endif
 134 #if (XILINX_FSL_NUMBER > 5)
 135         case 5:
 136                 switch (blocking) {
 137                 case 0: NGET (num, 5);
 138                         break;
 139                 case 1: NCGET (num, 5);
 140                         break;
 141                 case 2: GET (num, 5);
 142                         break;
 143                 case 3: CGET (num, 5);
 144                         break;
 145                 default:
 146                         return 2;
 147                 }
 148                 break;
 149 #endif
 150 #if (XILINX_FSL_NUMBER > 6)
 151         case 6:
 152                 switch (blocking) {
 153                 case 0: NGET (num, 6);
 154                         break;
 155                 case 1: NCGET (num, 6);
 156                         break;
 157                 case 2: GET (num, 6);
 158                         break;
 159                 case 3: CGET (num, 6);
 160                         break;
 161                 default:
 162                         return 2;
 163                 }
 164                 break;
 165 #endif
 166 #if (XILINX_FSL_NUMBER > 7)
 167         case 7:
 168                 switch (blocking) {
 169                 case 0: NGET (num, 7);
 170                         break;
 171                 case 1: NCGET (num, 7);
 172                         break;
 173                 case 2: GET (num, 7);
 174                         break;
 175                 case 3: CGET (num, 7);
 176                         break;
 177                 default:
 178                         return 2;
 179                 }
 180                 break;
 181 #endif
 182         default:
 183                 return 1;
 184         }
 185
 186         printf ("%01x: 0x%08x - %s %s read\n", fslnum, num,
 187                 blocking < 2  ? "non blocking" : "blocking",
 188                 ((blocking == 1) || (blocking == 3)) ? "control" : "data" );
 189         return 0;
 190 }
 191
 192 int do_fwr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 193 {
 194         unsigned int fslnum;
 195         unsigned int num;
 196         unsigned int blocking;
 197
 198         if (argc < 3) {
 199                 cmd_usage(cmdtp);
 200                 return 1;
 201         }
 202
 203         fslnum = (unsigned int)simple_strtoul (argv[1], NULL, 16);
 204         num = (unsigned int)simple_strtoul (argv[2], NULL, 16);
 205         blocking = (unsigned int)simple_strtoul (argv[3], NULL, 16);
 206         if (fslnum < 0 || fslnum >= XILINX_FSL_NUMBER) {
 207                 cmd_usage(cmdtp);
 208                 return 1;
 209         }
 210
 211         switch (fslnum) {
 212 #if (XILINX_FSL_NUMBER > 0)
 213         case 0:
 214                 switch (blocking) {
 215                 case 0: NPUT (num, 0);
 216                         break;
 217                 case 1: NCPUT (num, 0);
 218                         break;
 219                 case 2: PUT (num, 0);
 220                         break;
 221                 case 3: CPUT (num, 0);
 222                         break;
 223                 default:
 224                         return 2;
 225                 }
 226                 break;
 227 #endif
 228 #if (XILINX_FSL_NUMBER > 1)
 229         case 1:
 230                 switch (blocking) {
 231                 case 0: NPUT (num, 1);
 232                         break;
 233                 case 1: NCPUT (num, 1);
 234                         break;
 235                 case 2: PUT (num, 1);
 236                         break;
 237                 case 3: CPUT (num, 1);
 238                         break;
 239                 default:
 240                         return 2;
 241                 }
 242                 break;
 243 #endif
 244 #if (XILINX_FSL_NUMBER > 2)
 245         case 2:
 246                 switch (blocking) {
 247                 case 0: NPUT (num, 2);
 248                         break;
 249                 case 1: NCPUT (num, 2);
 250                         break;
 251                 case 2: PUT (num, 2);
 252                         break;
 253                 case 3: CPUT (num, 2);
 254                         break;
 255                 default:
 256                         return 2;
 257                 }
 258                 break;
 259 #endif
 260 #if (XILINX_FSL_NUMBER > 3)
 261         case 3:
 262                 switch (blocking) {
 263                 case 0: NPUT (num, 3);
 264                         break;
 265                 case 1: NCPUT (num, 3);
 266                         break;
 267                 case 2: PUT (num, 3);
 268                         break;
 269                 case 3: CPUT (num, 3);
 270                         break;
 271                 default:
 272                         return 2;
 273                 }
 274                 break;
 275 #endif
 276 #if (XILINX_FSL_NUMBER > 4)
 277         case 4:
 278                 switch (blocking) {
 279                 case 0: NPUT (num, 4);
 280                         break;
 281                 case 1: NCPUT (num, 4);
 282                         break;
 283                 case 2: PUT (num, 4);
 284                         break;
 285                 case 3: CPUT (num, 4);
 286                         break;
 287                 default:
 288                         return 2;
 289                 }
 290                 break;
 291 #endif
 292 #if (XILINX_FSL_NUMBER > 5)
 293         case 5:
 294                 switch (blocking) {
 295                 case 0: NPUT (num, 5);
 296                         break;
 297                 case 1: NCPUT (num, 5);
 298                         break;
 299                 case 2: PUT (num, 5);
 300                         break;
 301                 case 3: CPUT (num, 5);
 302                         break;
 303                 default:
 304                         return 2;
 305                 }
 306                 break;
 307 #endif
 308 #if (XILINX_FSL_NUMBER > 6)
 309         case 6:
 310                 switch (blocking) {
 311                 case 0: NPUT (num, 6);
 312                         break;
 313                 case 1: NCPUT (num, 6);
 314                         break;
 315                 case 2: PUT (num, 6);
 316                         break;
 317                 case 3: CPUT (num, 6);
 318                         break;
 319                 default:
 320                         return 2;
 321                 }
 322                 break;
 323 #endif
 324 #if (XILINX_FSL_NUMBER > 7)
 325         case 7:
 326                 switch (blocking) {
 327                 case 0: NPUT (num, 7);
 328                         break;
 329                 case 1: NCPUT (num, 7);
 330                         break;
 331                 case 2: PUT (num, 7);
 332                         break;
 333                 case 3: CPUT (num, 7);
 334                         break;
 335                 default:
 336                         return 2;
 337                 }
 338                 break;
 339 #endif
 340         default:
 341                 return 1;
 342         }
 343
 344         printf ("%01x: 0x%08x - %s %s write\n", fslnum, num,
 345                 blocking < 2  ? "non blocking" : "blocking",
 346                 ((blocking == 1) || (blocking == 3)) ? "control" : "data" );
 347         return 0;
 348
 349 }
 350
 351 int do_rspr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 352 {
 353         unsigned int reg = 0;
 354         unsigned int val = 0;
 355
 356         if (argc < 2) {
 357                 cmd_usage(cmdtp);
 358                 return 1;
 359         }
 360         reg = (unsigned int)simple_strtoul (argv[1], NULL, 16);
 361         val = (unsigned int)simple_strtoul (argv[2], NULL, 16);
 362         switch (reg) {
 363         case 0x1:
 364                 if (argc > 2) {
 365                         MTS (val, rmsr);
 366                         NOP;
 367                         MFS (val, rmsr);
 368                 } else {
 369                         MFS (val, rmsr);
 370                 }
 371                 puts ("MSR");
 372                 break;
 373         case 0x3:
 374                 MFS (val, rear);
 375                 puts ("EAR");
 376                 break;
 377         case 0x5:
 378                 MFS (val, resr);
 379                 puts ("ESR");
 380                 break;
 381         default:
 382                 puts ("Unsupported register\n");
 383                 return 1;
 384         }
 385         printf (": 0x%08x\n", val);
 386         return 0;
 387 }
 388
 389 /***************************************************/
 390
 391 U_BOOT_CMD (frd, 3, 1, do_frd,
 392                 "read data from FSL",
 393                 "- [fslnum [0|1|2|3]]\n"
 394                 " 0 - non blocking data read\n"
 395                 " 1 - non blocking control read\n"
 396                 " 2 - blocking data read\n"
 397                 " 3 - blocking control read");
 398
 399 U_BOOT_CMD (fwr, 4, 1, do_fwr,
 400                 "write data to FSL",
 401                 "- [fslnum [0|1|2|3]]\n"
 402                 " 0 - non blocking data write\n"
 403                 " 1 - non blocking control write\n"
 404                 " 2 - blocking data write\n"
 405                 " 3 - blocking control write");
 406
 407 U_BOOT_CMD (rspr, 3, 1, do_rspr,
 408                 "read/write special purpose register",
 409                 "- reg_num [write value] read/write special purpose register\n"
 410                 " 1 - MSR - Machine status register\n"
 411                 " 3 - EAR - Exception address register\n"
 412                 " 5 - ESR - Exception status register");