blob: beb8a767c44a7bcd0dc13f8c54393d391f37c77e [file] [log] [blame]
Hao Zhang4984bce2014-07-09 19:48:43 +03001/*
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 Zhang7b26c1f2014-07-09 19:48:44 +030012#include <asm/arch/psc_defs.h>
13#include <asm/arch/hardware.h>
Hao Zhang4984bce2014-07-09 19:48:43 +030014
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 */
20int cpu_to_bus(u32 *ptr, u32 length)
21{
22 u32 i;
23
Khoronzhuk, Ivan3d315382014-07-09 23:44:44 +030024 if (!(readl(KS2_DEVSTAT) & 0x1))
Hao Zhang4984bce2014-07-09 19:48:43 +030025 for (i = 0; i < length; i++, ptr++)
26 *ptr = cpu_to_be32(*ptr);
27
28 return 0;
29}
Hao Zhang7b26c1f2014-07-09 19:48:44 +030030
Hao Zhang7b26c1f2014-07-09 19:48:44 +030031static 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 Anna4ed8b2c2016-03-04 10:36:38 -060039 if (psc_disable_domain(i + KS2_GEM_0_PWR_DOMAIN))
Hao Zhang7b26c1f2014-07-09 19:48:44 +030040 printf("Cannot disable domain for #%d DSP", i);
41 }
42}
43
Hao Zhang7b26c1f2014-07-09 19:48:44 +030044int 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}