release/src-rt-6.x.4708/cfe/cfe/arch/mips/board/pt1125/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
  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 as
  24     *     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. Neither the "Broadcom
  28     *     Corporation" name nor any trademark or logo of Broadcom
  29     *     Corporation may be used to endorse or promote products
  30     *     derived from this software without the prior written
  31     *     permission of Broadcom Corporation.
  32     *
  33     *  3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR
  34     *     IMPLIED WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED
  35     *     WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR
  36     *     PURPOSE, OR NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT
  37     *     SHALL BROADCOM BE LIABLE FOR ANY DAMAGES WHATSOEVER, AND IN
  38     *     PARTICULAR, BROADCOM SHALL NOT BE LIABLE FOR DIRECT, INDIRECT,
  39     *     INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  40     *     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
  41     *     GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  42     *     BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
  43     *     OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  44     *     TORT (INCLUDING NEGLIGENCE OR OTHERWISE), EVEN IF ADVISED OF
  45     *     THE POSSIBILITY OF SUCH DAMAGE.
  46     ********************************************************************* */
  47
  48
  49 #include "lib_types.h"
  50 #include "lib_string.h"
  51 #include "lib_queue.h"
  52 #include "lib_malloc.h"
  53 #include "lib_printf.h"
  54
  55 #include "cfe_iocb.h"
  56 #include "cfe_device.h"
  57 #include "cfe_console.h"
  58 #include "cfe_devfuncs.h"
  59 #include "cfe_timer.h"
  60
  61 #include "cfe_error.h"
  62
  63 #include "ui_command.h"
  64 #include "cfe.h"
  65
  66 #include "bsp_config.h"
  67
  68 int ui_init_cpu1cmds(void);
  69 static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[]);
  70 extern int cfe_iocb_dispatch(cfe_iocb_t *iocb);
  71
  72
  73 int ui_init_cpu1cmds(void)
  74 {
  75     cmd_addcmd("cpu1",
  76                ui_cmd_cpu1,
  77                NULL,
  78                "Controls a test program running on CPU1",
  79                "cpu1 start|stop",
  80                "");
  81
  82     return 0;
  83 }
  84
  85
  86 extern void cpu1proc(void);
  87
  88 static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[])
  89 {
  90     cfe_iocb_t iocb;
  91     int res = 0;
  92     char *a;
  93
  94     a = cmd_getarg(cmd,0);
  95     if (!a) a = "";
  96
  97     iocb.iocb_fcode = CFE_CMD_FW_CPUCTL;
  98     iocb.iocb_status = 0;
  99     iocb.iocb_handle = 0;
 100     iocb.iocb_flags = 0;
 101     iocb.iocb_psize = sizeof(iocb_cpuctl_t);
 102
 103     if (strcmp(a,"start") == 0) {
 104         iocb.plist.iocb_cpuctl.cpu_number = 1;
 105         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_START;
 106         iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) cpu1proc;
 107         iocb.plist.iocb_cpuctl.gp_val = 0xFEEDFACE;
 108         iocb.plist.iocb_cpuctl.sp_val = 0x12345678;
 109         iocb.plist.iocb_cpuctl.a1_val = 0xA1A1A1A1;
 110         xprintf("Starting CPU 1 at %p\n",iocb.plist.iocb_cpuctl.start_addr);
 111         res = cfe_iocb_dispatch(&iocb);
 112         }
 113     else if (strcmp(a,"stop") == 0) {
 114         iocb.plist.iocb_cpuctl.cpu_number = 1;
 115         iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP;
 116         iocb.plist.iocb_cpuctl.start_addr = 0;
 117         xprintf("Stopping CPU 1\n");
 118         res = cfe_iocb_dispatch(&iocb);
 119         }
 120     else {
 121         xprintf("Invalid CPU1 command: use 'cpu1 stop' or 'cpu1 start'\n");
 122         return -1;
 123         }
 124
 125     printf("Result %d\n",res);
 126     return res;
 127 }