Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 2 | /* |
| 3 | * Keystone EVM : Board initialization |
| 4 | * |
| 5 | * (C) Copyright 2014 |
| 6 | * Texas Instruments Incorporated, <www.ti.com> |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <common.h> |
Simon Glass | 0914011 | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 10 | #include <env.h> |
Simon Glass | 691d719 | 2020-05-10 11:40:02 -0600 | [diff] [blame] | 11 | #include <init.h> |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 12 | #include <asm/io.h> |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 13 | #include <asm/arch/psc_defs.h> |
| 14 | #include <asm/arch/hardware.h> |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 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 | */ |
| 21 | int cpu_to_bus(u32 *ptr, u32 length) |
| 22 | { |
| 23 | u32 i; |
| 24 | |
Khoronzhuk, Ivan | 3d31538 | 2014-07-09 23:44:44 +0300 | [diff] [blame] | 25 | if (!(readl(KS2_DEVSTAT) & 0x1)) |
Hao Zhang | 4984bce | 2014-07-09 19:48:43 +0300 | [diff] [blame] | 26 | for (i = 0; i < length; i++, ptr++) |
| 27 | *ptr = cpu_to_be32(*ptr); |
| 28 | |
| 29 | return 0; |
| 30 | } |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 31 | |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 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 | |
Suman Anna | 4ed8b2c | 2016-03-04 10:36:38 -0600 | [diff] [blame] | 40 | if (psc_disable_domain(i + KS2_GEM_0_PWR_DOMAIN)) |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 41 | printf("Cannot disable domain for #%d DSP", i); |
| 42 | } |
| 43 | } |
| 44 | |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 45 | int misc_init_r(void) |
| 46 | { |
| 47 | char *env; |
| 48 | long ks2_debug = 0; |
| 49 | |
Simon Glass | 00caae6 | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 50 | env = env_get("ks2_debug"); |
Hao Zhang | 7b26c1f | 2014-07-09 19:48:44 +0300 | [diff] [blame] | 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 | } |