static irqreturn_t px_pmu_isr(unsigned int pid, unsigned int tid, struct pt_regs * const regs, unsigned int cpu, unsigned long long ts) { u32 pmcr_value; u32 flag_value; unsigned int i; bool buffer_full = false; bool found = false; PXD32_Hotspot_Sample_V2 sample_rec; /* disable the counters */ pmcr_value = A9_Read_PMCR(); pmcr_value &= ~0x1; //pmcr_value |= 0x6; A9_Write_PMCR(pmcr_value); /* clear the overflow flag */ flag_value = A9_Read_OVSR(); A9_Write_OVSR(0xffffffff); /* add for PXA988 platform, Need to init CTI irq line */ #ifdef PX_SOC_PXA988 pxa988_ack_ctiint_func = (pxa988_ack_ctiint_t)kallsyms_lookup_name_func("pxa988_ack_ctiint"); pxa988_ack_ctiint_func(); //printk(KERN_EMERG "%s:%d, kallsyms_lookup_name_func is : 0x%x, pxa988_ack_ctiint_func is : 0x%x\n", __FILE__, __LINE__, (unsigned long)kallsyms_lookup_name_func, (unsigned long)pxa988_ack_ctiint_func); #endif if (flag_value == 0) { return IRQ_NONE; } sample_rec.pc = regs->ARM_pc; sample_rec.pid = pid; sample_rec.tid = tid; memcpy(sample_rec.timestamp, &ts, sizeof(sample_rec.timestamp)); if ((flag_value & 0x80000000) && es[COUNTER_A9_PMU_CCNT].enabled) { found = true; sample_rec.registerId = COUNTER_A9_PMU_CCNT; /* ccnt overflow */ if (es[sample_rec.registerId].calibration == false) { /* write sample record in non-calibration mode */ buffer_full |= write_sample(cpu, &sample_rec); } else { /* calculate the overflow count in calibration mode */ es[sample_rec.registerId].overflow++; } A9_WritePMUCounter(sample_rec.registerId, es[sample_rec.registerId].reset_value); } for (i=0; i<A9_PMN_NUM; i++) { if (flag_value & (0x1 << i)) { found = true; switch (i) { case 0: sample_rec.registerId = COUNTER_A9_PMU_PMN0; break; case 1: sample_rec.registerId = COUNTER_A9_PMU_PMN1; break; case 2: sample_rec.registerId = COUNTER_A9_PMU_PMN2; break; case 3: sample_rec.registerId = COUNTER_A9_PMU_PMN3; break; case 4: sample_rec.registerId = COUNTER_A9_PMU_PMN4; break; case 5: sample_rec.registerId = COUNTER_A9_PMU_PMN5; break; default: break; } if (es[sample_rec.registerId].calibration == false) { /* write sample record in non-calibration mode */ buffer_full |= write_sample(cpu, &sample_rec); } else { /* calculate the overflow count in calibration mode */ es[sample_rec.registerId].overflow++; } A9_WritePMUCounter(sample_rec.registerId, es[sample_rec.registerId].reset_value); } } if (!buffer_full) { /* enable the counters */ pmcr_value |= 0x1; pmcr_value &= ~0x6; A9_Write_PMCR(pmcr_value); } return IRQ_HANDLED; }
static int __init px_tp_init(void) { int ret; unsigned int func_address = 0; /* register pmu device */ ret = misc_register(&px_tp_d); if (ret) { printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_TP_DRV_NAME, ret); goto init_err_0; } #if 0 /* register counter monitor thread collector DSA device */ ret = misc_register(&pxtp_dsa_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_TP_DSA_DRV_NAME, ret); goto init_err_1; } /* register tp event buffer device */ ret = misc_register(&pxtp_event_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_TP_EVENT_DRV_NAME, ret); goto init_err_2; } /* register tp module buffer device */ ret = misc_register(&pxtp_module_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_TP_MODULE_DRV_NAME, ret); goto init_err_3; } #endif #ifdef SYS_CALL_TABLE_ADDRESS //system_call_table =(void**) SYS_CALL_TABLE_ADDRESS; #endif #if defined(LINUX_VERSION_CODE) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) kallsyms_lookup_name_func = (void*)kallsyms_lookup_name; #else if (param_kallsyms_lookup_name_addr != 0) { kallsyms_lookup_name_func = (void*) param_kallsyms_lookup_name_addr; } #endif if (kallsyms_lookup_name_func == NULL) { printk(KERN_ALERT "[CPA] *ERROR* Can't find kallsyms_lookup_name address\n"); ret = -EFAULT; goto init_err_4; } system_call_table = (void **)kallsyms_lookup_name_func("sys_call_table"); if (system_call_table == NULL) { printk(KERN_ALERT "[CPA] *ERROR* Can't find sys_call_table address\n"); ret = -EFAULT; goto init_err_4; } func_address = (unsigned int)kallsyms_lookup_name_func("access_process_vm"); if (func_address == 0) { printk(KERN_ALERT "[CPA] *ERROR* Can't find access_process_vm address\n"); ret = -EFAULT; goto init_err_4; } set_access_process_vm_address(func_address); set_address_access_process_vm(func_address); func_address = (unsigned int)kallsyms_lookup_name_func("register_undef_hook"); if (func_address == 0) { printk(KERN_ALERT "[CPA] *ERROR* Can't find register_undef_hook address\n"); ret = -EFAULT; goto init_err_4; } set_address_register_undef_hook(func_address); func_address = (unsigned int)kallsyms_lookup_name_func("unregister_undef_hook"); if (func_address == 0) { printk(KERN_ALERT "[CPA] *ERROR* Can't find unregister_undef_hook address\n"); ret = -EFAULT; goto init_err_4; } set_address_unregister_undef_hook(func_address); #if 0 if (allocate_dsa() != 0){ printk(KERN_ERR "[CPA] Unable to create dsa in kernel\n"); ret = -EFAULT; goto init_err_4; } #endif init_dsa(); return 0; init_err_4: #if 0 misc_deregister(&pxtp_module_d); init_err_3: misc_deregister(&pxtp_event_d); init_err_2: misc_deregister(&pxtp_dsa_d); init_err_1: #endif misc_deregister(&px_tp_d); init_err_0: return ret; }
static int __init px_hotspot_init(void) { int ret; unsigned int address; /* register pmu device */ ret = misc_register(&px_hotspot_d); if (ret) { printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_HS_DRV_NAME, ret); goto init_err_0; } #if 0 /* register counter monitor thread collector DSA device */ ret = misc_register(&pxhs_dsa_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_HS_DSA_DRV_NAME, ret); goto init_err_1; } /* register hotspot sample buffer device */ ret = misc_register(&pxhs_sample_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_HS_SAMPLE_DRV_NAME, ret); goto init_err_2; } /* register hotspot module buffer device */ ret = misc_register(&pxhs_module_d); if (ret != 0){ printk(KERN_ERR "[CPA] Unable to register \"%s\" misc device: ret = %d\n", PX_HS_MODULE_DRV_NAME, ret); goto init_err_3; } #endif #ifdef SYS_CALL_TABLE_ADDRESS //system_call_table_hs =(void**) SYS_CALL_TABLE_ADDRESS; #endif #if defined(LINUX_VERSION_CODE) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) kallsyms_lookup_name_func = (void*)kallsyms_lookup_name; #else if (param_kallsyms_lookup_name_addr != 0) { kallsyms_lookup_name_func = (kallsyms_lookup_name_func_t) param_kallsyms_lookup_name_addr; } #endif if (kallsyms_lookup_name_func == NULL) { printk(KERN_ALERT "[CPA] *ERROR* Can't find kallsyms_lookup_name address\n"); ret = -EFAULT; goto init_err_4; } system_call_table_hs = (void **)kallsyms_lookup_name_func("sys_call_table"); if (system_call_table_hs == NULL) { printk(KERN_ALERT "[CPA] *ERROR* Can't find sys_call_table address\n"); ret = -EFAULT; goto init_err_4; } address = kallsyms_lookup_name_func("access_process_vm"); if (address == 0) { printk(KERN_ALERT "[CPA] *ERROR* Can't find access_process_vm address\n"); ret = -EFAULT; goto init_err_4; } set_access_process_vm_address(address); #if 0 if (allocate_dsa() != 0){ printk(KERN_ERR "[CPA] Unable to create dsa in kernel\n"); ret = -EFAULT; goto init_err_4; } init_dsa(); #endif init_func_for_cpu(); return 0; init_err_4: #if 0 misc_deregister(&pxhs_module_d); init_err_3: misc_deregister(&pxhs_sample_d); init_err_2: misc_deregister(&pxhs_dsa_d); init_err_1: #endif misc_deregister(&px_hotspot_d); init_err_0: return ret; }