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
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#include "cfe.h"
48#include "ui_command.h"
49
50int ui_init_cpu1cmds(void);
51static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[]);
52extern int cfe_iocb_dispatch(cfe_iocb_t *iocb);
53
54
55int ui_init_cpu1cmds(void)
56{
57    cmd_addcmd("cpu",
58	       ui_cmd_cpu1,
59	       NULL,
60	       "Controls a test program running on another CPU",
61	       "cpu cpunum start|stop",
62	       "-addr=*;Specifies a start address for CPU|"
63	       "-a1=*;Specifies an initial value for the A1 register|"
64	       "-gp=*;Specifies an initial value for the GP register|"
65	       "-sp=*;Specifies an initial value for the SP register");
66
67    return 0;
68}
69
70
71extern void cpu1proc(void);
72
73static int ui_cmd_cpu1(ui_cmdline_t *cmd,int argc,char *argv[])
74{
75    cfe_iocb_t iocb;
76    int res = 0;
77    int cpunum;
78    char *a;
79    char *x;
80
81    a = cmd_getarg(cmd,0);
82    if (!a) return ui_showusage(cmd);
83
84    cpunum = atoi(a);
85    if ((cpunum <= 0) || (cpunum > 3)) return ui_showusage(cmd);
86
87    a = cmd_getarg(cmd,1);
88    if (!a) a = "";
89
90    iocb.iocb_fcode = CFE_CMD_FW_CPUCTL;
91    iocb.iocb_status = 0;
92    iocb.iocb_handle = 0;
93    iocb.iocb_flags = 0;
94    iocb.iocb_psize = sizeof(iocb_cpuctl_t);
95
96    if (strcmp(a,"start") == 0) {
97	iocb.plist.iocb_cpuctl.cpu_number = cpunum;
98	iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_START;
99
100	if (cmd_sw_value(cmd,"-a1",&x)) iocb.plist.iocb_cpuctl.gp_val = (cfe_uint_t) xtoq(x);
101	else iocb.plist.iocb_cpuctl.gp_val = 0xFEEDFACE;
102
103	if (cmd_sw_value(cmd,"-sp",&x)) iocb.plist.iocb_cpuctl.sp_val = (cfe_uint_t) xtoq(x);
104	else iocb.plist.iocb_cpuctl.sp_val = 0x12345678;
105
106	if (cmd_sw_value(cmd,"-addr",&x)) iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) xtoq(x);
107	else {
108	    iocb.plist.iocb_cpuctl.start_addr = (cfe_uint_t) cpu1proc;
109	    }
110
111	xprintf("Starting CPU %d at %p\n",cpunum,iocb.plist.iocb_cpuctl.start_addr);
112	res = cfe_iocb_dispatch(&iocb);
113	}
114    else if (strcmp(a,"stop") == 0) {
115	iocb.plist.iocb_cpuctl.cpu_number = cpunum;
116	iocb.plist.iocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP;
117	iocb.plist.iocb_cpuctl.start_addr = 0;
118	xprintf("Stopping CPU 1\n");
119	res = cfe_iocb_dispatch(&iocb);
120	}
121    else {
122	xprintf("Invalid CPU command: use 'cpu cpunum stop' or 'cpu cpunum start'\n");
123	return -1;
124	}
125
126    printf("Result %d\n",res);
127    return res;
128}
129