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