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 67int ui_init_cpu1cmds(void); 68static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[]); 69extern int cfe_iocb_dispatch(cfe_iocb_t *iocb); 70 71 72int 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 88extern void cpu1proc(void); 89 90static 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 iocb.plist.iocb_cpuctl.sp_val = 0x12345678; 115 116 if (cmd_sw_value(cmd,"-addr",&x)) iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) xtoq(x); 117 iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) cpu1proc; 118 119 xprintf("Starting CPU 1 at %p\n",iocb.plist.iocb_cpuctl.start_addr); 120 res = cfe_iocb_dispatch(&iocb); 121 } 122 else if (strcmp(a,"stop") == 0) { 123 iocb.plist.iocb_cpuctl.cpu_number = 1; 124 iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP; 125 iocb.plist.iocb_cpuctl.start_addr = 0; 126 xprintf("Stopping CPU 1\n"); 127 res = cfe_iocb_dispatch(&iocb); 128 } 129 else { 130 xprintf("Invalid CPU1 command: use 'cpu1 stop' or 'cpu1 start'\n"); 131 return -1; 132 } 133 134 printf("Result %d\n",res); 135 return res; 136} 137