release/src-rt-6.x.4708/cfe/cfe/arch/mips/board/cswarm/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                "");
  80
  81     return 0;
  82 }
  83
  84
  85 extern void cpu1proc(void);
  86
  87 static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[])
  88 {
  89     cfe_iocb_t iocb;
  90     int res = 0;
  91     char *a;
  92
  93     a = cmd_getarg(cmd,0);
  94     if (!a) a = "";
  95
  96     iocb.iocb_fcode = CFE_CMD_FW_CPUCTL;
  97     iocb.iocb_status = 0;
  98     iocb.iocb_handle = 0;
  99     iocb.iocb_flags = 0;
 100     iocb.iocb_psize = sizeof(iocb_cpuctl_t);
 101
 102     if (strcmp(a,"start") == 0) {
 103         iocb.plist.iocb_cpuctl.cpu_number = 1;
 104         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_START;
 105         iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) cpu1proc;
 106         iocb.plist.iocb_cpuctl.gp_val = 0xFEEDFACE;
 107         iocb.plist.iocb_cpuctl.sp_val = 0x12345678;
 108         iocb.plist.iocb_cpuctl.a1_val = 0xA1A1A1A1;
 109         xprintf("Starting CPU 1 at %p\n",iocb.plist.iocb_cpuctl.start_addr);
 110         res = cfe_iocb_dispatch(&iocb);
 111         }
 112     else if (strcmp(a,"stop") == 0) {
 113         iocb.plist.iocb_cpuctl.cpu_number = 1;
 114         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP;
 115         iocb.plist.iocb_cpuctl.start_addr = 0;
 116         xprintf("Stopping CPU 1\n");
 117         res = cfe_iocb_dispatch(&iocb);
 118         }
 119     else {
 120         xprintf("Invalid CPU1 command: use 'cpu1 stop' or 'cpu1 start'\n");
 121         return -1;
 122         }
 123
 124     printf("Result %d\n",res);
 125     return res;
 126 }