android_kernel_samsung_msm8976/drivers/debug/sec_gaf.c

428 lines
14 KiB
C

/*
* sec_gaf.c
*
*/
#include <linux/module.h>
#include <linux/types.h>
#include <linux/sched.h>
#include <linux/fs.h>
#include <linux/mount.h>
#include <asm/pgtable.h>
#include <linux/kernel_stat.h>
#ifndef arch_irq_stat_cpu
#define arch_irq_stat_cpu(cpu) 0
#endif
#ifndef arch_irq_stat
#define arch_irq_stat() 0
#endif
#ifndef arch_idle_time
#define arch_idle_time(cpu) 0
#endif
#define cputime64_add(__a, __b) ((__a) + (__b))
static struct GAForensicINFO {
unsigned short ver;
unsigned int size;
unsigned short task_struct_struct_state;
unsigned short task_struct_struct_comm;
unsigned short task_struct_struct_tasks;
unsigned short task_struct_struct_pid;
unsigned short task_struct_struct_stack;
unsigned short task_struct_struct_mm;
unsigned short mm_struct_struct_start_data;
unsigned short mm_struct_struct_end_data;
unsigned short mm_struct_struct_start_brk;
unsigned short mm_struct_struct_brk;
unsigned short mm_struct_struct_start_stack;
unsigned short mm_struct_struct_arg_start;
unsigned short mm_struct_struct_arg_end;
unsigned short mm_struct_struct_pgd;
unsigned short mm_struct_struct_mmap;
unsigned short vm_area_struct_struct_vm_start;
unsigned short vm_area_struct_struct_vm_end;
unsigned short vm_area_struct_struct_vm_next;
unsigned short vm_area_struct_struct_vm_file;
#ifndef CONFIG_ARM64
unsigned short thread_info_struct_cpu_context;
unsigned short cpu_context_save_struct_sp;
#endif
unsigned short file_struct_f_path;
unsigned short path_struct_mnt;
unsigned short path_struct_dentry;
unsigned short dentry_struct_d_parent;
unsigned short dentry_struct_d_name;
unsigned short qstr_struct_name;
unsigned short vfsmount_struct_mnt_root;
#ifdef CONFIG_ARM64
unsigned long pgdir_shift;
unsigned long ptrs_per_pte;
unsigned long phys_offset;
unsigned long page_offset;
unsigned long page_shift;
unsigned long page_size;
#else
unsigned int pgdir_shift;
unsigned int ptrs_per_pte;
unsigned int phys_offset;
unsigned int page_offset;
unsigned int page_shift;
unsigned int page_size;
#endif
unsigned short task_struct_struct_thread_group;
#ifdef CONFIG_ARM64
unsigned short task_struct_struct_thread;
#endif
unsigned short task_struct_struct_utime;
unsigned short task_struct_struct_stime;
unsigned short list_head_struct_next;
unsigned short list_head_struct_prev;
unsigned short rq_struct_curr;
unsigned short thread_info_struct_cpu;
unsigned short task_struct_struct_prio;
unsigned short task_struct_struct_static_prio;
unsigned short task_struct_struct_normal_prio;
unsigned short task_struct_struct_rt_priority;
unsigned short task_struct_struct_se;
unsigned short sched_entity_struct_exec_start;
unsigned short sched_entity_struct_sum_exec_runtime;
unsigned short sched_entity_struct_prev_sum_exec_runtime;
unsigned short task_struct_struct_sched_info;
unsigned short sched_info_struct_pcount;
unsigned short sched_info_struct_run_delay;
unsigned short sched_info_struct_last_arrival;
unsigned short sched_info_struct_last_queued;
unsigned short task_struct_struct_blocked_on;
unsigned short mutex_waiter_struct_list;
unsigned short mutex_waiter_struct_task;
unsigned short sched_entity_struct_cfs_rq_struct;
unsigned short cfs_rq_struct_rq_struct;
unsigned short gaf_fp;
unsigned short GAFINFOCheckSum;
} GAFINFO = {
.ver = 0x0300, /* by dh3s.choi 2010 12 14 */
.size = sizeof(GAFINFO),
.task_struct_struct_state = offsetof(struct task_struct, state),
.task_struct_struct_comm = offsetof(struct task_struct, comm),
.task_struct_struct_tasks = offsetof(struct task_struct, tasks),
.task_struct_struct_pid = offsetof(struct task_struct, pid),
.task_struct_struct_stack = offsetof(struct task_struct, stack),
.task_struct_struct_mm = offsetof(struct task_struct, mm),
.mm_struct_struct_start_data = offsetof(struct mm_struct, start_data),
.mm_struct_struct_end_data = offsetof(struct mm_struct, end_data),
.mm_struct_struct_start_brk = offsetof(struct mm_struct, start_brk),
.mm_struct_struct_brk = offsetof(struct mm_struct, brk),
.mm_struct_struct_start_stack = offsetof(struct mm_struct, start_stack),
.mm_struct_struct_arg_start = offsetof(struct mm_struct, arg_start),
.mm_struct_struct_arg_end = offsetof(struct mm_struct, arg_end),
.mm_struct_struct_pgd = offsetof(struct mm_struct, pgd),
.mm_struct_struct_mmap = offsetof(struct mm_struct, mmap),
.vm_area_struct_struct_vm_start =
offsetof(struct vm_area_struct, vm_start),
.vm_area_struct_struct_vm_end = offsetof(struct vm_area_struct, vm_end),
.vm_area_struct_struct_vm_next =
offsetof(struct vm_area_struct, vm_next),
.vm_area_struct_struct_vm_file =
offsetof(struct vm_area_struct, vm_file),
#ifndef CONFIG_ARM64
.thread_info_struct_cpu_context =
offsetof(struct thread_info, cpu_context),
.cpu_context_save_struct_sp = offsetof(struct cpu_context_save, sp),
#endif
.file_struct_f_path = offsetof(struct file, f_path),
.path_struct_mnt = offsetof(struct path, mnt),
.path_struct_dentry = offsetof(struct path, dentry),
.dentry_struct_d_parent = offsetof(struct dentry, d_parent),
.dentry_struct_d_name = offsetof(struct dentry, d_name),
.qstr_struct_name = offsetof(struct qstr, name),
.vfsmount_struct_mnt_root = offsetof(struct vfsmount, mnt_root),
.pgdir_shift = PGDIR_SHIFT,
.ptrs_per_pte = PTRS_PER_PTE,
//TEMP .phys_offset = PHYS_OFFSET,
.page_offset = PAGE_OFFSET,
.page_shift = PAGE_SHIFT,
.page_size = PAGE_SIZE,
.task_struct_struct_thread_group =
offsetof(struct task_struct, thread_group),
#ifdef CONFIG_ARM64
.task_struct_struct_thread = offsetof(struct task_struct, thread),
#endif
.task_struct_struct_utime = offsetof(struct task_struct, utime),
.task_struct_struct_stime = offsetof(struct task_struct, stime),
.list_head_struct_next = offsetof(struct list_head, next),
.list_head_struct_prev = offsetof(struct list_head, prev),
.rq_struct_curr = 0,
.thread_info_struct_cpu = offsetof(struct thread_info, cpu),
.task_struct_struct_prio = offsetof(struct task_struct, prio),
.task_struct_struct_static_prio =
offsetof(struct task_struct, static_prio),
.task_struct_struct_normal_prio =
offsetof(struct task_struct, normal_prio),
.task_struct_struct_rt_priority =
offsetof(struct task_struct, rt_priority),
.task_struct_struct_se = offsetof(struct task_struct, se),
.sched_entity_struct_exec_start =
offsetof(struct sched_entity, exec_start),
.sched_entity_struct_sum_exec_runtime =
offsetof(struct sched_entity, sum_exec_runtime),
.sched_entity_struct_prev_sum_exec_runtime =
offsetof(struct sched_entity, prev_sum_exec_runtime),
#if defined(CONFIG_SCHEDSTATS) || defined(CONFIG_TASK_DELAY_ACCT)
.task_struct_struct_sched_info =
offsetof(struct task_struct, sched_info),
.sched_info_struct_pcount = offsetof(struct sched_info, pcount),
.sched_info_struct_run_delay = offsetof(struct sched_info, run_delay),
.sched_info_struct_last_arrival =
offsetof(struct sched_info, last_arrival),
.sched_info_struct_last_queued =
offsetof(struct sched_info, last_queued),
#else
.task_struct_struct_sched_info = 0x1223,
.sched_info_struct_pcount = 0x1224,
.sched_info_struct_run_delay = 0x1225,
.sched_info_struct_last_arrival = 0x1226,
.sched_info_struct_last_queued = 0x1227,
#endif
#ifdef CONFIG_DEBUG_MUTEXES
.task_struct_struct_blocked_on =
offsetof(struct task_struct, blocked_on),
.mutex_waiter_struct_list = offsetof(struct mutex_waiter, list),
.mutex_waiter_struct_task = offsetof(struct mutex_waiter, task),
#else
.task_struct_struct_blocked_on = 0x1228,
.mutex_waiter_struct_list = 0x1229,
.mutex_waiter_struct_task = 0x122a,
#endif
#ifdef CONFIG_FAIR_GROUP_SCHED
.sched_entity_struct_cfs_rq_struct =
offsetof(struct sched_entity, cfs_rq),
#else
.sched_entity_struct_cfs_rq_struct = 0x1223,
#endif
.cfs_rq_struct_rq_struct = 0,
#ifdef CONFIG_FRAME_POINTER
.gaf_fp = 1,
#else
.gaf_fp = 0,
#endif
.GAFINFOCheckSum = 0
};
void sec_gaf_supply_rqinfo(unsigned short curr_offset, unsigned short rq_offset)
{
unsigned short *checksum = &(GAFINFO.GAFINFOCheckSum);
unsigned char *memory = (unsigned char *)&GAFINFO;
unsigned char address;
/*
* Add GAForensic init for preventing symbol removal for optimization.
*/
GAFINFO.rq_struct_curr = curr_offset;
#ifdef CONFIG_FAIR_GROUP_SCHED
GAFINFO.cfs_rq_struct_rq_struct = rq_offset;
#else
GAFINFO.cfs_rq_struct_rq_struct = 0x1224;
#endif
for (*checksum = 0, address = 0;
address < (sizeof(GAFINFO) - sizeof(GAFINFO.GAFINFOCheckSum));
address++) {
if ((*checksum) & 0x8000)
(*checksum) =
(((*checksum) << 1) | 1) ^ memory[address];
else
(*checksum) = ((*checksum) << 1) ^ memory[address];
}
}
EXPORT_SYMBOL(sec_gaf_supply_rqinfo);
void dump_one_task_info(struct task_struct *tsk, bool isMain)
{
char stat_array[3] = {'R', 'S', 'D'};
char stat_ch;
// char *ptr_thread_info = tsk->stack;
stat_ch = tsk->state <= TASK_UNINTERRUPTIBLE ?
stat_array[tsk->state] : '?';
printk(KERN_INFO "%8d %8d %8d %16llu %c (%d) %lx %c %s\n",
tsk->pid, (int)(tsk->utime), (int)(tsk->stime),
tsk->se.exec_start, stat_ch, (int)(tsk->state),
// *(int *)(ptr_thread_info + GAFINFO.thread_info_struct_cpu),
(unsigned long)tsk, isMain ? '*' : ' ', tsk->comm);
if (tsk->state == TASK_RUNNING || tsk->state == TASK_UNINTERRUPTIBLE)
show_stack(tsk, NULL);
}
void dump_all_task_info(void)
{
struct task_struct *frst_tsk;
struct task_struct *curr_tsk;
struct task_struct *frst_thr;
struct task_struct *curr_thr;
printk(KERN_INFO "\n");
printk(KERN_INFO " current proc : %d %s\n", current->pid,
current->comm);
printk(KERN_INFO " ----------------------------------------------\n");
printk(KERN_INFO " pid uTime sTime exec(ns)"
" stat cpu task_struct\n");
printk(KERN_INFO " ----------------------------------------------\n");
/*processes */
frst_tsk = &init_task;
curr_tsk = frst_tsk;
while (curr_tsk != NULL) {
dump_one_task_info(curr_tsk, true);
/*threads*/
if (curr_tsk->thread_group.next != NULL) {
frst_thr = container_of(curr_tsk->thread_group.next,
struct task_struct, thread_group);
curr_thr = frst_thr;
if (frst_thr != curr_tsk) {
while (curr_thr != NULL) {
dump_one_task_info(curr_thr, false);
curr_thr = container_of(
curr_thr->thread_group.next,
struct task_struct, thread_group);
if (curr_thr == curr_tsk)
break;
}
}
}
curr_tsk = container_of(curr_tsk->tasks.next,
struct task_struct, tasks);
if (curr_tsk == frst_tsk)
break;
}
printk(KERN_INFO " ---------------------------------------------------"
"--------------------------------\n");
}
void dump_cpu_stat(void)
{
int i, j;
unsigned long jif;
cputime64_t user, nice, system, idle, iowait, irq, softirq, steal;
cputime64_t guest, guest_nice;
u64 sum = 0;
u64 sum_softirq = 0;
unsigned int per_softirq_sums[NR_SOFTIRQS] = {0};
struct timespec boottime;
unsigned int per_irq_sum;
user = nice = system = idle = iowait =
irq = softirq = steal = 0;
guest = guest_nice = 0;
getboottime(&boottime);
jif = boottime.tv_sec;
for_each_possible_cpu(i) {
user = cputime64_add(user,
kcpustat_cpu(i).cpustat[CPUTIME_USER]);
nice = cputime64_add(nice,
kcpustat_cpu(i).cpustat[CPUTIME_NICE]);
system = cputime64_add(system,
kcpustat_cpu(i).cpustat[CPUTIME_SYSTEM]);
idle = cputime64_add(idle,
kcpustat_cpu(i).cpustat[CPUTIME_IDLE]);
idle = cputime64_add(idle, arch_idle_time(i));
iowait = cputime64_add(iowait,
kcpustat_cpu(i).cpustat[CPUTIME_IOWAIT]);
irq = cputime64_add(irq,
kcpustat_cpu(i).cpustat[CPUTIME_IRQ]);
softirq = cputime64_add(softirq,
kcpustat_cpu(i).cpustat[CPUTIME_SOFTIRQ]);
for_each_irq_nr(j) {
sum += kstat_irqs_cpu(j, i);
}
sum += arch_irq_stat_cpu(i);
for (j = 0; j < NR_SOFTIRQS; j++) {
unsigned int softirq_stat = kstat_softirqs_cpu(j, i);
per_softirq_sums[j] += softirq_stat;
sum_softirq += softirq_stat;
}
}
sum += arch_irq_stat();
printk(KERN_INFO "\n");
printk(KERN_INFO "cpuuser:%llu nice:%llu system:%llu idle:%llu"
"iowait:%llu irq:%llu softirq:%llu %llu %llu"
"%llu\n",
(unsigned long long)cputime64_to_clock_t(user),
(unsigned long long)cputime64_to_clock_t(nice),
(unsigned long long)cputime64_to_clock_t(system),
(unsigned long long)cputime64_to_clock_t(idle),
(unsigned long long)cputime64_to_clock_t(iowait),
(unsigned long long)cputime64_to_clock_t(irq),
(unsigned long long)cputime64_to_clock_t(softirq),
(unsigned long long)0,
(unsigned long long)0,
(unsigned long long)0);
printk(KERN_INFO " ---------------------------------------------------"
"--------------------------------\n");
for_each_online_cpu(i) {
/* Copy values here to work around gcc-2.95.3, gcc-2.96 */
user = kcpustat_cpu(i).cpustat[CPUTIME_USER];
nice = kcpustat_cpu(i).cpustat[CPUTIME_NICE];
system = kcpustat_cpu(i).cpustat[CPUTIME_SYSTEM];
idle = kcpustat_cpu(i).cpustat[CPUTIME_IDLE];
idle = cputime64_add(idle, arch_idle_time(i));
iowait = kcpustat_cpu(i).cpustat[CPUTIME_IOWAIT];
irq = kcpustat_cpu(i).cpustat[CPUTIME_IRQ];
softirq = kcpustat_cpu(i).cpustat[CPUTIME_SOFTIRQ];
printk(KERN_INFO " cpu%d user:%llu nice:%llu system:%llu"
"idle:%llu iowait:%llu irq:%llu softirq:%llu %llu %llu "
"%llu\n",
i,
(unsigned long long)cputime64_to_clock_t(user),
(unsigned long long)cputime64_to_clock_t(nice),
(unsigned long long)cputime64_to_clock_t(system),
(unsigned long long)cputime64_to_clock_t(idle),
(unsigned long long)cputime64_to_clock_t(iowait),
(unsigned long long)cputime64_to_clock_t(irq),
(unsigned long long)cputime64_to_clock_t(softirq),
(unsigned long long)0,
(unsigned long long)0,
(unsigned long long)0);
}
printk(KERN_INFO " ----------------------------------------------"
"------\n");
printk(KERN_INFO "\n");
printk(KERN_INFO " irq : %llu", (unsigned long long)sum);
printk(KERN_INFO " ----------------------------------------------"
"------\n");
/* sum again ? it could be updated? */
for_each_irq_nr(j) {
per_irq_sum = 0;
for_each_possible_cpu(i)
per_irq_sum += kstat_irqs_cpu(j, i);
if (per_irq_sum)
printk(KERN_INFO " irq-%d : %u\n", j, per_irq_sum);
}
printk(KERN_INFO " ----------------------------------------------"
"-------------------------------------\n");
printk(KERN_INFO "\n");
printk(KERN_INFO " softirq : %llu", (unsigned long long)sum_softirq);
printk(KERN_INFO " ----------------------------------------------"
"-------------------------------------\n");
for (i = 0; i < NR_SOFTIRQS; i++)
if (per_softirq_sums[i])
printk(KERN_INFO " softirq-%d : %u", i,
per_softirq_sums[i]);
printk(KERN_INFO " ----------------------------------------------"
"-------------------------------------\n");
return;
}