1/* 2 * File: arch/blackfin/oprofile/op_model_bf533.c 3 * Based on: 4 * Author: Anton Blanchard <anton@au.ibm.com> 5 * 6 * Created: 7 * Description: 8 * 9 * Modified: 10 * Copyright (C) 2004 Anton Blanchard <anton@au.ibm.com>, IBM 11 * Copyright 2004-2006 Analog Devices Inc. 12 * 13 * Bugs: Enter bugs at http://blackfin.uclinux.org/ 14 * 15 * This program is free software; you can redistribute it and/or modify 16 * it under the terms of the GNU General Public License as published by 17 * the Free Software Foundation; either version 2 of the License, or 18 * (at your option) any later version. 19 * 20 * This program is distributed in the hope that it will be useful, 21 * but WITHOUT ANY WARRANTY; without even the implied warranty of 22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 23 * GNU General Public License for more details. 24 * 25 * You should have received a copy of the GNU General Public License 26 * along with this program; if not, see the file COPYING, or write 27 * to the Free Software Foundation, Inc., 28 * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 29 */ 30 31#include <linux/oprofile.h> 32#include <linux/init.h> 33#include <linux/smp.h> 34#include <linux/interrupt.h> 35#include <asm/ptrace.h> 36#include <asm/system.h> 37#include <asm/processor.h> 38#include <asm/blackfin.h> 39#include <asm/irq.h> 40#include <asm/io.h> 41 42#include "op_blackfin.h" 43 44#define PM_ENABLE 0x01; 45#define PM_CTL1_ENABLE 0x18 46#define PM_CTL0_ENABLE 0xC000 47#define COUNT_EDGE_ONLY 0x3000000 48 49static int oprofile_running; 50 51static unsigned curr_pfctl, curr_count[2]; 52 53static int bfin533_reg_setup(struct op_counter_config *ctr) 54{ 55 unsigned int pfctl = ctr_read(); 56 unsigned int count[2]; 57 58 /* set Blackfin perf monitor regs with ctr */ 59 if (ctr[0].enabled) { 60 pfctl |= (PM_CTL0_ENABLE | ((char)ctr[0].event << 5)); 61 count[0] = 0xFFFFFFFF - ctr[0].count; 62 curr_count[0] = count[0]; 63 } 64 if (ctr[1].enabled) { 65 pfctl |= (PM_CTL1_ENABLE | ((char)ctr[1].event << 16)); 66 count[1] = 0xFFFFFFFF - ctr[1].count; 67 curr_count[1] = count[1]; 68 } 69 70 pr_debug("ctr[0].enabled=%d,ctr[1].enabled=%d,ctr[0].event<<5=0x%x,ctr[1].event<<16=0x%x\n", ctr[0].enabled, ctr[1].enabled, ctr[0].event << 5, ctr[1].event << 16); 71 pfctl |= COUNT_EDGE_ONLY; 72 curr_pfctl = pfctl; 73 74 pr_debug("write 0x%x to pfctl\n", pfctl); 75 ctr_write(pfctl); 76 count_write(count); 77 78 return 0; 79} 80 81static int bfin533_start(struct op_counter_config *ctr) 82{ 83 unsigned int pfctl = ctr_read(); 84 85 pfctl |= PM_ENABLE; 86 curr_pfctl = pfctl; 87 88 ctr_write(pfctl); 89 90 oprofile_running = 1; 91 pr_debug("start oprofile counter \n"); 92 93 return 0; 94} 95 96static void bfin533_stop(void) 97{ 98 int pfctl; 99 100 pfctl = ctr_read(); 101 pfctl &= ~PM_ENABLE; 102 /* freeze counters */ 103 ctr_write(pfctl); 104 105 oprofile_running = 0; 106 pr_debug("stop oprofile counter \n"); 107} 108 109static int get_kernel(void) 110{ 111 int ipend, is_kernel; 112 113 ipend = bfin_read_IPEND(); 114 115 /* test bit 15 */ 116 is_kernel = ((ipend & 0x8000) != 0); 117 118 return is_kernel; 119} 120 121int pm_overflow_handler(int irq, struct pt_regs *regs) 122{ 123 int is_kernel; 124 int i, cpu; 125 unsigned int pc, pfctl; 126 unsigned int count[2]; 127 128 pr_debug("get interrupt in %s\n", __FUNCTION__); 129 if (oprofile_running == 0) { 130 pr_debug("error: entering interrupt when oprofile is stopped.\n\r"); 131 return -1; 132 } 133 134 is_kernel = get_kernel(); 135 cpu = smp_processor_id(); 136 pc = regs->pc; 137 pfctl = ctr_read(); 138 139 /* read the two event counter regs */ 140 count_read(count); 141 142 /* if the counter overflows, add sample to oprofile buffer */ 143 for (i = 0; i < 2; ++i) { 144 if (oprofile_running) { 145 oprofile_add_sample(regs, i); 146 } 147 } 148 149 /* reset the perfmon counter */ 150 ctr_write(curr_pfctl); 151 count_write(curr_count); 152 return 0; 153} 154 155struct op_bfin533_model op_model_bfin533 = { 156 .reg_setup = bfin533_reg_setup, 157 .start = bfin533_start, 158 .stop = bfin533_stop, 159 .num_counters = 2, 160 .name = "blackfin/bf533" 161}; 162