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
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
|
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/bootmem.h>
#include <linux/slab.h>
#include <linux/stat.h>
#include <linux/uaccess.h>
#include <linux/proc_fs.h>
#include <mach/sec_debug.h>
#include <plat/map-base.h>
#include <plat/map-s5p.h>
#include <asm/mach/map.h>
/*
* Example usage: sec_log=256K@0x45000000
* In above case, log_buf size is 256KB and its base address is
* 0x45000000 physically. Actually, *(int *)(base - 8) is log_magic and
* *(int *)(base - 4) is log_ptr. So we reserve (size + 8) bytes from
* (base - 8).
*/
#define LOG_MAGIC 0x4d474f4c /* "LOGM" */
/* These variables are also protected by logbuf_lock */
static unsigned *sec_log_ptr;
static char *sec_log_buf;
static unsigned sec_log_size;
#ifdef CONFIG_SEC_LOG_LAST_KMSG
static char *last_kmsg_buffer;
static unsigned last_kmsg_size;
static void __init sec_log_save_old(void);
#else
static inline void sec_log_save_old(void)
{
}
#endif
extern void register_log_char_hook(void (*f) (char c));
#ifdef CONFIG_SEC_LOG_NONCACHED
static struct map_desc log_buf_iodesc[] __initdata = {
{
.virtual = (unsigned long)S3C_VA_KLOG_BUF,
.type = MT_DEVICE
}
};
#endif
static inline void emit_sec_log_char(char c)
{
if (sec_log_buf && sec_log_ptr) {
sec_log_buf[*sec_log_ptr & (sec_log_size - 1)] = c;
(*sec_log_ptr)++;
}
}
static int __init sec_log_setup(char *str)
{
unsigned size = memparse(str, &str);
unsigned long base = 0;
unsigned *sec_log_mag;
/* If we encounter any problem parsing str ... */
if (!size || size != roundup_pow_of_two(size) || *str != '@'
|| kstrtoul(str + 1, 0, &base))
goto out;
if (reserve_bootmem(base - 8, size + 8, BOOTMEM_EXCLUSIVE)) {
pr_err("%s: failed reserving size %d + 8 "
"at base 0x%lx - 8\n", __func__, size, base);
goto out;
}
#ifdef CONFIG_SEC_LOG_NONCACHED
log_buf_iodesc[0].pfn = __phys_to_pfn((unsigned long)base - 0x100000);
log_buf_iodesc[0].length = (unsigned long)(size + 0x100000);
iotable_init(log_buf_iodesc, ARRAY_SIZE(log_buf_iodesc));
sec_log_mag = (S3C_VA_KLOG_BUF + 0x100000) - 8;
sec_log_ptr = (S3C_VA_KLOG_BUF + 0x100000) - 4;
sec_log_buf = S3C_VA_KLOG_BUF + 0x100000;
#else
sec_log_mag = phys_to_virt(base) - 8;
sec_log_ptr = phys_to_virt(base) - 4;
sec_log_buf = phys_to_virt(base);
#endif
sec_log_size = size;
pr_info("%s: *sec_log_mag:%x *sec_log_ptr:%x "
"sec_log_buf:%p sec_log_size:%d\n",
__func__, *sec_log_mag, *sec_log_ptr, sec_log_buf,
sec_log_size);
if (*sec_log_mag != LOG_MAGIC) {
pr_info("%s: no old log found\n", __func__);
*sec_log_ptr = 0;
*sec_log_mag = LOG_MAGIC;
} else
sec_log_save_old();
register_log_char_hook(emit_sec_log_char);
sec_getlog_supply_kloginfo(phys_to_virt(base));
out:
return 0;
}
__setup("sec_log=", sec_log_setup);
#ifdef CONFIG_SEC_LOG_LAST_KMSG
static void __init sec_log_save_old(void)
{
/* provide previous log as last_kmsg */
last_kmsg_size =
min((unsigned)(1 << CONFIG_LOG_BUF_SHIFT), *sec_log_ptr);
last_kmsg_buffer = (char *)alloc_bootmem(last_kmsg_size);
if (last_kmsg_size && last_kmsg_buffer) {
unsigned i;
for (i = 0; i < last_kmsg_size; i++)
last_kmsg_buffer[i] =
sec_log_buf[(*sec_log_ptr - last_kmsg_size +
i) & (sec_log_size - 1)];
pr_info("%s: saved old log at %d@%p\n",
__func__, last_kmsg_size, last_kmsg_buffer);
} else
pr_err("%s: failed saving old log %d@%p\n",
__func__, last_kmsg_size, last_kmsg_buffer);
}
static ssize_t sec_log_read_old(struct file *file, char __user *buf,
size_t len, loff_t *offset)
{
loff_t pos = *offset;
ssize_t count;
if (pos >= last_kmsg_size)
return 0;
count = min(len, (size_t) (last_kmsg_size - pos));
if (copy_to_user(buf, last_kmsg_buffer + pos, count))
return -EFAULT;
*offset += count;
return count;
}
static const struct file_operations last_kmsg_file_ops = {
.owner = THIS_MODULE,
.read = sec_log_read_old,
};
static int __init sec_log_late_init(void)
{
struct proc_dir_entry *entry;
if (last_kmsg_buffer == NULL)
return 0;
entry = create_proc_entry("last_kmsg", S_IFREG | S_IRUGO, NULL);
if (!entry) {
pr_err("%s: failed to create proc entry\n", __func__);
return 0;
}
entry->proc_fops = &last_kmsg_file_ops;
entry->size = last_kmsg_size;
return 0;
}
late_initcall(sec_log_late_init);
#endif
|
