1 /*
2  * Keystone EVM : Board initialization
3  *
4  * (C) Copyright 2014
5  *     Texas Instruments Incorporated, <www.ti.com>
6  *
7  * SPDX-License-Identifier:     GPL-2.0+
8  */
9 
10 #include <common.h>
11 #include <asm/io.h>
12 #include <asm/arch/mon.h>
13 #include <asm/arch/psc_defs.h>
14 #include <asm/arch/hardware.h>
15 #include <asm/arch/hardware.h>
16 
17 /**
18  * cpu_to_bus - swap bytes of the 32-bit data if the device is BE
19  * @ptr - array of data
20  * @length - lenght of data array
21  */
22 int cpu_to_bus(u32 *ptr, u32 length)
23 {
24 	u32 i;
25 
26 	if (!(readl(KS2_DEVSTAT) & 0x1))
27 		for (i = 0; i < length; i++, ptr++)
28 			*ptr = cpu_to_be32(*ptr);
29 
30 	return 0;
31 }
32 
33 static int turn_off_myself(void)
34 {
35 	printf("Turning off ourselves\r\n");
36 	mon_power_off(0);
37 
38 	psc_disable_module(KS2_LPSC_TETRIS);
39 	psc_disable_domain(KS2_TETRIS_PWR_DOMAIN);
40 
41 	asm volatile ("isb\n"
42 		      "dsb\n"
43 		      "wfi\n");
44 
45 	printf("What! Should not see that\n");
46 	return 0;
47 }
48 
49 static void turn_off_all_dsps(int num_dsps)
50 {
51 	int i;
52 
53 	for (i = 0; i < num_dsps; i++) {
54 		if (psc_disable_module(i + KS2_LPSC_GEM_0))
55 			printf("Cannot disable module for #%d DSP", i);
56 
57 		if (psc_disable_domain(i + 8))
58 			printf("Cannot disable domain for #%d DSP", i);
59 	}
60 }
61 
62 int do_killme_cmd(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
63 {
64 	return turn_off_myself();
65 }
66 
67 U_BOOT_CMD(
68 	killme, 1,      0,      do_killme_cmd,
69 	"turn off main ARM core",
70 	"turn off main ARM core. Should not live after that :(\n"
71 );
72 
73 int misc_init_r(void)
74 {
75 	char *env;
76 	long ks2_debug = 0;
77 
78 	env = getenv("ks2_debug");
79 
80 	if (env)
81 		ks2_debug = simple_strtol(env, NULL, 0);
82 
83 	if ((ks2_debug & DBG_LEAVE_DSPS_ON) == 0)
84 		turn_off_all_dsps(KS2_NUM_DSPS);
85 
86 	return 0;
87 }
88