162 lines
3.8 KiB
C
162 lines
3.8 KiB
C
/*
|
|
* File: arch/blackfin/oprofile/op_model_bf533.c
|
|
* Based on:
|
|
* Author: Anton Blanchard <anton@au.ibm.com>
|
|
*
|
|
* Created:
|
|
* Description:
|
|
*
|
|
* Modified:
|
|
* Copyright (C) 2004 Anton Blanchard <anton@au.ibm.com>, IBM
|
|
* Copyright 2004-2006 Analog Devices Inc.
|
|
*
|
|
* Bugs: Enter bugs at http://blackfin.uclinux.org/
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, see the file COPYING, or write
|
|
* to the Free Software Foundation, Inc.,
|
|
* 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <linux/oprofile.h>
|
|
#include <linux/init.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/ptrace.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/io.h>
|
|
#include <asm/system.h>
|
|
#include <asm/processor.h>
|
|
#include <asm/blackfin.h>
|
|
|
|
#include "op_blackfin.h"
|
|
|
|
#define PM_ENABLE 0x01;
|
|
#define PM_CTL1_ENABLE 0x18
|
|
#define PM_CTL0_ENABLE 0xC000
|
|
#define COUNT_EDGE_ONLY 0x3000000
|
|
|
|
static int oprofile_running;
|
|
|
|
static unsigned curr_pfctl, curr_count[2];
|
|
|
|
static int bfin533_reg_setup(struct op_counter_config *ctr)
|
|
{
|
|
unsigned int pfctl = ctr_read();
|
|
unsigned int count[2];
|
|
|
|
/* set Blackfin perf monitor regs with ctr */
|
|
if (ctr[0].enabled) {
|
|
pfctl |= (PM_CTL0_ENABLE | ((char)ctr[0].event << 5));
|
|
count[0] = 0xFFFFFFFF - ctr[0].count;
|
|
curr_count[0] = count[0];
|
|
}
|
|
if (ctr[1].enabled) {
|
|
pfctl |= (PM_CTL1_ENABLE | ((char)ctr[1].event << 16));
|
|
count[1] = 0xFFFFFFFF - ctr[1].count;
|
|
curr_count[1] = count[1];
|
|
}
|
|
|
|
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);
|
|
pfctl |= COUNT_EDGE_ONLY;
|
|
curr_pfctl = pfctl;
|
|
|
|
pr_debug("write 0x%x to pfctl\n", pfctl);
|
|
ctr_write(pfctl);
|
|
count_write(count);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bfin533_start(struct op_counter_config *ctr)
|
|
{
|
|
unsigned int pfctl = ctr_read();
|
|
|
|
pfctl |= PM_ENABLE;
|
|
curr_pfctl = pfctl;
|
|
|
|
ctr_write(pfctl);
|
|
|
|
oprofile_running = 1;
|
|
pr_debug("start oprofile counter \n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void bfin533_stop(void)
|
|
{
|
|
int pfctl;
|
|
|
|
pfctl = ctr_read();
|
|
pfctl &= ~PM_ENABLE;
|
|
/* freeze counters */
|
|
ctr_write(pfctl);
|
|
|
|
oprofile_running = 0;
|
|
pr_debug("stop oprofile counter \n");
|
|
}
|
|
|
|
static int get_kernel(void)
|
|
{
|
|
int ipend, is_kernel;
|
|
|
|
ipend = bfin_read_IPEND();
|
|
|
|
/* test bit 15 */
|
|
is_kernel = ((ipend & 0x8000) != 0);
|
|
|
|
return is_kernel;
|
|
}
|
|
|
|
int pm_overflow_handler(int irq, struct pt_regs *regs)
|
|
{
|
|
int is_kernel;
|
|
int i, cpu;
|
|
unsigned int pc, pfctl;
|
|
unsigned int count[2];
|
|
|
|
pr_debug("get interrupt in %s\n", __FUNCTION__);
|
|
if (oprofile_running == 0) {
|
|
pr_debug("error: entering interrupt when oprofile is stopped.\n\r");
|
|
return -1;
|
|
}
|
|
|
|
is_kernel = get_kernel();
|
|
cpu = smp_processor_id();
|
|
pc = regs->pc;
|
|
pfctl = ctr_read();
|
|
|
|
/* read the two event counter regs */
|
|
count_read(count);
|
|
|
|
/* if the counter overflows, add sample to oprofile buffer */
|
|
for (i = 0; i < 2; ++i) {
|
|
if (oprofile_running) {
|
|
oprofile_add_sample(regs, i);
|
|
}
|
|
}
|
|
|
|
/* reset the perfmon counter */
|
|
ctr_write(curr_pfctl);
|
|
count_write(curr_count);
|
|
return 0;
|
|
}
|
|
|
|
struct op_bfin533_model op_model_bfin533 = {
|
|
.reg_setup = bfin533_reg_setup,
|
|
.start = bfin533_start,
|
|
.stop = bfin533_stop,
|
|
.num_counters = 2,
|
|
.name = "blackfin/bf533"
|
|
};
|