1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Keystone EVM : Board initialization
4  *
5  * (C) Copyright 2014
6  *     Texas Instruments Incorporated, <www.ti.com>
7  */
8 
9 #include <common.h>
10 #include <env.h>
11 #include <init.h>
12 #include <asm/io.h>
13 #include <asm/arch/psc_defs.h>
14 #include <asm/arch/hardware.h>
15 
16 /**
17  * cpu_to_bus - swap bytes of the 32-bit data if the device is BE
18  * @ptr - array of data
19  * @length - lenght of data array
20  */
cpu_to_bus(u32 * ptr,u32 length)21 int cpu_to_bus(u32 *ptr, u32 length)
22 {
23 	u32 i;
24 
25 	if (!(readl(KS2_DEVSTAT) & 0x1))
26 		for (i = 0; i < length; i++, ptr++)
27 			*ptr = cpu_to_be32(*ptr);
28 
29 	return 0;
30 }
31 
turn_off_all_dsps(int num_dsps)32 static void turn_off_all_dsps(int num_dsps)
33 {
34 	int i;
35 
36 	for (i = 0; i < num_dsps; i++) {
37 		if (psc_disable_module(i + KS2_LPSC_GEM_0))
38 			printf("Cannot disable module for #%d DSP", i);
39 
40 		if (psc_disable_domain(i + KS2_GEM_0_PWR_DOMAIN))
41 			printf("Cannot disable domain for #%d DSP", i);
42 	}
43 }
44 
misc_init_r(void)45 int misc_init_r(void)
46 {
47 	char *env;
48 	long ks2_debug = 0;
49 
50 	env = env_get("ks2_debug");
51 
52 	if (env)
53 		ks2_debug = simple_strtol(env, NULL, 0);
54 
55 	if ((ks2_debug & DBG_LEAVE_DSPS_ON) == 0)
56 		turn_off_all_dsps(KS2_NUM_DSPS);
57 
58 	return 0;
59 }
60