Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 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> |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 12 | #include <asm/arch/psc_defs.h> |
| 13 | #include <asm/arch/hardware.h> |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 14 | |
| 15 | /** |
| 16 | * cpu_to_bus - swap bytes of the 32-bit data if the device is BE |
| 17 | * @ptr - array of data |
| 18 | * @length - lenght of data array |
| 19 | */ |
| 20 | int cpu_to_bus(u32 *ptr, u32 length) |
| 21 | { |
| 22 | u32 i; |
| 23 | |
Khoronzhuk, Ivan | 3d31538 | 2014-07-09 23:44:44 +0300 | [diff] [blame] | 24 | if (!(readl(KS2_DEVSTAT) & 0x1)) |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 25 | for (i = 0; i < length; i++, ptr++) |
| 26 | *ptr = cpu_to_be32(*ptr); |
| 27 | |
| 28 | return 0; |
| 29 | } |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 30 | |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 31 | static void turn_off_all_dsps(int num_dsps) |
| 32 | { |
| 33 | int i; |
| 34 | |
| 35 | for (i = 0; i < num_dsps; i++) { |
| 36 | if (psc_disable_module(i + KS2_LPSC_GEM_0)) |
| 37 | printf("Cannot disable module for #%d DSP", i); |
| 38 | |
Suman Anna | 4ed8b2c | 2016-03-04 10:36:38 -0600 | [diff] [blame] | 39 | if (psc_disable_domain(i + KS2_GEM_0_PWR_DOMAIN)) |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 40 | printf("Cannot disable domain for #%d DSP", i); |
| 41 | } |
| 42 | } |
| 43 | |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 44 | int misc_init_r(void) |
| 45 | { |
| 46 | char *env; |
| 47 | long ks2_debug = 0; |
| 48 | |
| 49 | env = getenv("ks2_debug"); |
| 50 | |
| 51 | if (env) |
| 52 | ks2_debug = simple_strtol(env, NULL, 0); |
| 53 | |
| 54 | if ((ks2_debug & DBG_LEAVE_DSPS_ON) == 0) |
| 55 | turn_off_all_dsps(KS2_NUM_DSPS); |
| 56 | |
| 57 | return 0; |
| 58 | } |