hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
/*
 * OMAP3 boot
 *
 * Copyright (C) 2015 Paul Kocialkowski <contact@paulk.fr>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <asm/io.h>
#include <asm/arch/sys_proto.h>
#include <spl.h>
 
static u32 boot_devices[] = {
   BOOT_DEVICE_ONENAND,
   BOOT_DEVICE_NAND,
   BOOT_DEVICE_ONENAND,
   BOOT_DEVICE_MMC2,
   BOOT_DEVICE_ONENAND,
   BOOT_DEVICE_MMC2,
   BOOT_DEVICE_MMC1,
   BOOT_DEVICE_XIP,
   BOOT_DEVICE_XIPWAIT,
   BOOT_DEVICE_MMC2,
   BOOT_DEVICE_XIP,
   BOOT_DEVICE_XIPWAIT,
   BOOT_DEVICE_NAND,
   BOOT_DEVICE_XIP,
   BOOT_DEVICE_XIPWAIT,
   BOOT_DEVICE_NAND,
   BOOT_DEVICE_ONENAND,
   BOOT_DEVICE_MMC2,
   BOOT_DEVICE_MMC1,
   BOOT_DEVICE_XIP,
   BOOT_DEVICE_XIPWAIT,
   BOOT_DEVICE_NAND,
   BOOT_DEVICE_ONENAND,
   BOOT_DEVICE_MMC2,
   BOOT_DEVICE_MMC1,
   BOOT_DEVICE_XIP,
   BOOT_DEVICE_XIPWAIT,
   BOOT_DEVICE_NAND,
   BOOT_DEVICE_MMC2_2,
};
 
u32 omap_sys_boot_device(void)
{
   struct ctrl *ctrl_base = (struct ctrl *)OMAP34XX_CTRL_BASE;
   u32 sys_boot;
 
   /* Grab the first 5 bits of the status register for SYS_BOOT. */
   sys_boot = readl(&ctrl_base->status) & ((1 << 5) - 1);
 
   if (sys_boot >= (sizeof(boot_devices) / sizeof(u32)))
       return BOOT_DEVICE_NONE;
 
   return boot_devices[sys_boot];
}
 
int omap_reboot_mode(char *mode, unsigned int length)
{
   u32 reboot_mode;
   char c;
 
   if (length < 2)
       return -1;
 
   reboot_mode = readl((u32 *)(OMAP34XX_SCRATCHPAD +
       OMAP_REBOOT_REASON_OFFSET));
 
   c = (reboot_mode >> 24) & 0xff;
   if (c != 'B')
       return -1;
 
   c = (reboot_mode >> 16) & 0xff;
   if (c != 'M')
       return -1;
 
   c = reboot_mode & 0xff;
 
   mode[0] = c;
   mode[1] = '\0';
 
   return 0;
}
 
int omap_reboot_mode_clear(void)
{
   writel(0, (u32 *)(OMAP34XX_SCRATCHPAD + OMAP_REBOOT_REASON_OFFSET));
 
   return 0;
}
 
int omap_reboot_mode_store(char *mode)
{
   u32 reboot_mode;
 
   reboot_mode = 'B' << 24 | 'M' << 16 | mode[0];
 
   writel(reboot_mode, (u32 *)(OMAP34XX_SCRATCHPAD +
       OMAP_REBOOT_REASON_OFFSET));
 
   return 0;
}