release/src-rt-6.x.4708/cfe/cfe/arch/mips/board/sentosa/src/cpu1cmds.c

   1 /*  *********************************************************************
   2     *  Broadcom Common Firmware Environment (CFE)
   3     *
   4     *  CPU1 Test commands                       File: cpu1cmds.c
   5     *
   6     *  A temporary sandbox for misc test routines and commands.
   7     *
   8     *  Author:  Mitch Lichtenberg (mpl@broadcom.com)
   9     *
  10     *********************************************************************
  11     *
  12     *  Copyright 2000,2001,2002,2003
  13     *  Broadcom Corporation. All rights reserved.
  14     *
  15     *  This software is furnished under license and may be used and
  16     *  copied only in accordance with the following terms and
  17     *  conditions.  Subject to these conditions, you may download,
  18     *  copy, install, use, modify and distribute modified or unmodified
  19     *  copies of this software in source and/or binary form.  No title
  20     *  or ownership is transferred hereby.
  21     *
  22     *  1) Any source code used, modified or distributed must reproduce
  23     *     and retain this copyright notice and list of conditions
  24     *     as they appear in the source file.
  25     *
  26     *  2) No right is granted to use any trade name, trademark, or
  27     *     logo of Broadcom Corporation.  The "Broadcom Corporation"
  28     *     name may not be used to endorse or promote products derived
  29     *     from this software without the prior written permission of
  30     *     Broadcom Corporation.
  31     *
  32     *  3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR
  33     *     IMPLIED WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED
  34     *     WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR
  35     *     PURPOSE, OR NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT
  36     *     SHALL BROADCOM BE LIABLE FOR ANY DAMAGES WHATSOEVER, AND IN
  37     *     PARTICULAR, BROADCOM SHALL NOT BE LIABLE FOR DIRECT, INDIRECT,
  38     *     INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  39     *     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
  40     *     GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  41     *     BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
  42     *     OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  43     *     TORT (INCLUDING NEGLIGENCE OR OTHERWISE), EVEN IF ADVISED OF
  44     *     THE POSSIBILITY OF SUCH DAMAGE.
  45     ********************************************************************* */
  46
  47
  48 #include "lib_types.h"
  49 #include "lib_string.h"
  50 #include "lib_queue.h"
  51 #include "lib_malloc.h"
  52 #include "lib_printf.h"
  53
  54 #include "cfe_iocb.h"
  55 #include "cfe_device.h"
  56 #include "cfe_console.h"
  57 #include "cfe_devfuncs.h"
  58 #include "cfe_timer.h"
  59
  60 #include "cfe_error.h"
  61
  62 #include "ui_command.h"
  63 #include "cfe.h"
  64
  65 #include "bsp_config.h"
  66
  67 int ui_init_cpu1cmds(void);
  68 static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[]);
  69 extern int cfe_iocb_dispatch(cfe_iocb_t *iocb);
  70
  71
  72 int ui_init_cpu1cmds(void)
  73 {
  74     cmd_addcmd("cpu1",
  75                ui_cmd_cpu1,
  76                NULL,
  77                "Controls a test program running on CPU1",
  78                "cpu1 start|stop",
  79                "-addr=*;Specifies a start address for CPU1|"
  80                "-a1=*;Specifies an initial value for the A1 register|"
  81                "-gp=*;Specifies an initial value for the GP register|"
  82                "-sp=*;Specifies an initial value for the SP register");
  83
  84     return 0;
  85 }
  86
  87
  88 extern void cpu1proc(void);
  89
  90 static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[])
  91 {
  92     cfe_iocb_t iocb;
  93     int res = 0;
  94     char *a;
  95     char *x;
  96
  97     a = cmd_getarg(cmd,0);
  98     if (!a) a = "";
  99
 100     iocb.iocb_fcode = CFE_CMD_FW_CPUCTL;
 101     iocb.iocb_status = 0;
 102     iocb.iocb_handle = 0;
 103     iocb.iocb_flags = 0;
 104     iocb.iocb_psize = sizeof(iocb_cpuctl_t);
 105
 106     if (strcmp(a,"start") == 0) {
 107         iocb.plist.iocb_cpuctl.cpu_number = 1;
 108         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_START;
 109
 110         if (cmd_sw_value(cmd,"-a1",&x)) iocb.plist.iocb_cpuctl.gp_val = (cfe_uint_t) xtoq(x);
 111         else iocb.plist.iocb_cpuctl.gp_val = 0xFEEDFACE;
 112
 113         if (cmd_sw_value(cmd,"-sp",&x)) iocb.plist.iocb_cpuctl.sp_val = (cfe_uint_t) xtoq(x);
 114         else iocb.plist.iocb_cpuctl.sp_val = 0x12345678;
 115
 116         //iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) cpu1proc;
 117         if (cmd_sw_value(cmd,"-addr",&x)) iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) xtoq(x);
 118         else {
 119             xprintf("You must specify the -addr switch to specify a start address.\n");
 120             return -1;
 121             }
 122
 123         xprintf("Starting CPU 1 at %p\n",iocb.plist.iocb_cpuctl.start_addr);
 124         res = cfe_iocb_dispatch(&iocb);
 125         }
 126     else if (strcmp(a,"stop") == 0) {
 127         iocb.plist.iocb_cpuctl.cpu_number = 1;
 128         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP;
 129         iocb.plist.iocb_cpuctl.start_addr = 0;
 130         xprintf("Stopping CPU 1\n");
 131         res = cfe_iocb_dispatch(&iocb);
 132         }
 133     else {
 134         xprintf("Invalid CPU1 command: use 'cpu1 stop' or 'cpu1 start'\n");
 135         return -1;
 136         }
 137
 138     printf("Result %d\n",res);
 139     return res;
 140 }