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