← Back to branch summary

~pmdj/ubuntu/trusty/qemu/2.9+applesmc+fadtv3

« back to all changes in this revision

Viewing changes to roms/u-boot/arch/arm/cpu/armv7/keystone/cmd_mon.c

  • Committer: Phil Dennis-Jordan
  • Date: 2017-07-21 08:03:43 UTC
  • mfrom: (1.1.1)
  • Revision ID: phil@philjordan.eu-20170721080343-2yr2vdj7713czahv
New upstream release 2.9.0.

Show diffs side-by-side

added added

removed removed

Lines of Context:
roms/u-boot/arch/arm/cpu/armv7/keystone/cmd_mon.c
 
1
/*
 
2
 * K2HK: secure kernel command file
 
3
 *
 
4
 * (C) Copyright 2012-2014
 
5
 *     Texas Instruments Incorporated, <www.ti.com>
 
6
 *
 
7
 * SPDX-License-Identifier:     GPL-2.0+
 
8
 */
 
9
 
 
10
#include <common.h>
 
11
#include <command.h>
 
12
asm(".arch_extension sec\n\t");
 
13
 
 
14
static int mon_install(u32 addr, u32 dpsc, u32 freq)
 
15
{
 
16
        int result;
 
17
 
 
18
        __asm__ __volatile__ (
 
19
                "stmfd r13!, {lr}\n"
 
20
                "mov r0, %1\n"
 
21
                "mov r1, %2\n"
 
22
                "mov r2, %3\n"
 
23
                "blx r0\n"
 
24
                "ldmfd r13!, {lr}\n"
 
25
                : "=&r" (result)
 
26
                : "r" (addr), "r" (dpsc), "r" (freq)
 
27
                : "cc", "r0", "r1", "r2", "memory");
 
28
        return result;
 
29
}
 
30
 
 
31
static int do_mon_install(cmd_tbl_t *cmdtp, int flag, int argc,
 
32
                          char * const argv[])
 
33
{
 
34
        u32 addr, dpsc_base = 0x1E80000, freq;
 
35
        int     rcode = 0;
 
36
 
 
37
        if (argc < 2)
 
38
                return CMD_RET_USAGE;
 
39
 
 
40
        freq = clk_get_rate(sys_clk0_6_clk);
 
41
 
 
42
        addr = simple_strtoul(argv[1], NULL, 16);
 
43
 
 
44
        rcode = mon_install(addr, dpsc_base, freq);
 
45
        printf("## installed monitor, freq [%d], status %d\n",
 
46
               freq, rcode);
 
47
 
 
48
        return 0;
 
49
}
 
50
 
 
51
U_BOOT_CMD(mon_install, 2, 0, do_mon_install,
 
52
           "Install boot kernel at 'addr'",
 
53
           ""
 
54
);
 
55
 
 
56
static void core_spin(void)
 
57
{
 
58
        while (1)
 
59
                ; /* forever */;
 
60
}
 
61
 
 
62
int mon_power_on(int core_id, void *ep)
 
63
{
 
64
        int result;
 
65
 
 
66
        asm volatile (
 
67
                "stmfd  r13!, {lr}\n"
 
68
                "mov r1, %1\n"
 
69
                "mov r2, %2\n"
 
70
                "mov r0, #0\n"
 
71
                "smc    #0\n"
 
72
                "ldmfd  r13!, {lr}\n"
 
73
                : "=&r" (result)
 
74
                : "r" (core_id), "r" (ep)
 
75
                : "cc", "r0", "r1", "r2", "memory");
 
76
        return  result;
 
77
}
 
78
 
 
79
int mon_power_off(int core_id)
 
80
{
 
81
        int result;
 
82
 
 
83
        asm volatile (
 
84
                "stmfd  r13!, {lr}\n"
 
85
                "mov r1, %1\n"
 
86
                "mov r0, #1\n"
 
87
                "smc    #1\n"
 
88
                "ldmfd  r13!, {lr}\n"
 
89
                : "=&r" (result)
 
90
                : "r" (core_id)
 
91
                : "cc", "r0", "r1", "memory");
 
92
        return  result;
 
93
}
 
94
 
 
95
int do_mon_power(cmd_tbl_t *cmdtp, int flag, int argc,
 
96
                        char * const argv[])
 
97
{
 
98
        int     rcode = 0, core_id, on;
 
99
        void (*fn)(void);
 
100
 
 
101
        fn = core_spin;
 
102
 
 
103
        if (argc < 3)
 
104
                return CMD_RET_USAGE;
 
105
 
 
106
        core_id = simple_strtoul(argv[1], NULL, 16);
 
107
        on = simple_strtoul(argv[2], NULL, 16);
 
108
 
 
109
        if (on)
 
110
                rcode = mon_power_on(core_id, fn);
 
111
        else
 
112
                rcode = mon_power_off(core_id);
 
113
 
 
114
        if (on) {
 
115
                if (!rcode)
 
116
                        printf("core %d powered on successfully\n", core_id);
 
117
                else
 
118
                        printf("core %d power on failure\n", core_id);
 
119
        } else {
 
120
                printf("core %d powered off successfully\n", core_id);
 
121
        }
 
122
 
 
123
        return 0;
 
124
}
 
125
 
 
126
U_BOOT_CMD(mon_power, 3, 0, do_mon_power,
 
127
           "Power On/Off secondary core",
 
128
           "mon_power <coreid> <oper>\n"
 
129
           "- coreid (1-3) and oper (1 - ON, 0 - OFF)\n"
 
130
           ""
 
131
);