Subversion Repositories or1k

/*
 * arch/cris/kernel/debug.c
 * Various debug routines:
 * o Logging of interrupt enabling/disabling. /proc/debug_interrupt
 *   gives result and enables logging when read.
 *
 * Copyright (C) 2003 Axis Communications AB
 */
 
#include <linux/config.h>
#include <asm/system.h>
#include <linux/init.h>
#include <linux/proc_fs.h>
#include <asm/svinto.h>
 
#ifdef CONFIG_ETRAX_DEBUG_INTERRUPT
#define LOG_INT_SIZE 8192
#define DEBUG_INT_PROC_FILE "debug_interrupt"
#define LOG_INT_SHOW_MIN_USEC 45000
 
/* These are global and can be used to trig certain events. */
int log_int_pos = 0;
int log_int_size = LOG_INT_SIZE;
int log_int_trig0_pos = 0;
int log_int_trig1_pos = 0;
 
int log_int_enable = 0; /* Enabled every read of /proc/debug_interrupt */
 
struct log_int_struct 
{
  unsigned long pc;
  unsigned long ev_timer_data;
};
 
static struct log_int_struct log_ints[LOG_INT_SIZE];
 
//static unsigned long prev_log_int_t = 0;
static unsigned long prev_logged_ccr = 0;
static unsigned long prev_ei_timer_data = 0;
static unsigned long prev_di_timer_data = 0;
 
#define CCR_EI_BIT 5
enum {
	INT_OLD_MASK = 0x01, INT_OLD_BIT = 0,
	INT_NEW_MASK = 0x02, INT_NEW_BIT = 1,
	INT_EI_CHANGE_MASK = 0x04, INT_EI_CHANGE_BIT = 2,
	INT_ACTION_RESTORE = 0x08, INT_ACTION_RESTORE_BIT = 3,
	INT_ACTION_MISSED = 0x10, INT_ACTION_MISSED_BIT = 4,
	INT_ACTION_LONG = 0x20,  INT_ACTION_LONG_BIT = 5,
 
	INT_OLD_EI = INT_OLD_MASK, INT_OLD_EI_BIT = INT_OLD_BIT,
	INT_NEW_EI = INT_NEW_MASK, INT_NEW_EI_BIT = INT_NEW_BIT,
	INT_EV_DI = INT_OLD_EI | INT_EI_CHANGE_MASK,
	INT_EV_NOP_DI = 0,
	INT_EV_EI = INT_NEW_EI | INT_EI_CHANGE_MASK,
	INT_EV_NOP_EI = INT_OLD_EI | INT_NEW_EI, 
	INT_EV_RESTORE_DI= INT_EV_DI | INT_EI_CHANGE_MASK | INT_ACTION_RESTORE,
	INT_EV_RESTORE_EI= INT_EV_EI | INT_EI_CHANGE_MASK | INT_ACTION_RESTORE,
	INT_EV_RESTORE_NOP_DI = INT_EV_NOP_DI | INT_ACTION_RESTORE,
	INT_EV_RESTORE_NOP_EI = INT_EV_NOP_EI | INT_ACTION_RESTORE,
};
 
void log_int(unsigned long pc, unsigned long curr_ccr, unsigned long next_ccr)
{
	unsigned long t;
	int ev;
	static int no_change_cnt = 0;
 
	/* Just disable interrupts without logging here,
	 * the caller will either do ei, di or restore
	 */
	__asm__ __volatile__ ("di" : : :"memory");
	t = *R_TIMER_DATA;
 
	if (curr_ccr & CCR_EI_MASK) {
		prev_ei_timer_data = t;		
		ev = INT_OLD_EI;
	} else {
		prev_di_timer_data = t;
		if ( (((prev_ei_timer_data >> 8) & 0x000000FF) -
		      ((prev_di_timer_data >> 8) & 0x000000FF)) & ~0x03)
					    ev = INT_ACTION_LONG;
		else
			ev = 0;
	}
	if ((curr_ccr ^ prev_logged_ccr) & CCR_EI_MASK)
		ev |= INT_ACTION_MISSED;
	if (next_ccr & CCR_EI_MASK)
		ev |= INT_NEW_EI;
	if ((curr_ccr ^ next_ccr) & CCR_EI_MASK) {
		ev |= INT_EI_CHANGE_MASK;
		no_change_cnt = 0;
	} else
		no_change_cnt++;
 
	prev_logged_ccr = next_ccr;
 
	if (log_int_enable &&
	    ((ev & (INT_EI_CHANGE_MASK | INT_ACTION_MISSED | INT_ACTION_LONG))
	     ||	(no_change_cnt < 40)) &&
	    log_int_pos < LOG_INT_SIZE) {
		int i;
		i = log_int_pos;
		log_int_pos++;
		log_ints[i].pc = pc;
		log_ints[i].ev_timer_data = (t & 0x00FFFFFF) |
			((ev & 0xFF) << 24);
 
	}
//	__asm__ __volatile__ ("move %0,$ccr" : : "rm" (curr_ccr) : "memory");
}
void log_int_di(void)
{
  unsigned long pc;
  unsigned long flags;
  __asm__ __volatile__ ("move $srp,%0" : "=rm" (pc) : : "memory");
  __asm__ __volatile__ ("move $ccr,%0" : "=rm" (flags) : : "memory");
  log_int(pc, flags, 0);
}
 
void log_int_ei(void)
{
  unsigned long pc;
  unsigned long flags;
  __asm__ __volatile__ ("move $srp,%0" : "=rm" (pc) : : "memory");
  __asm__ __volatile__ ("move $ccr,%0" : "=rm" (flags) : : "memory");
  log_int(pc, flags, CCR_EI_MASK);
}
 
 
static int log_int_read_proc(char *page, char **start, off_t off, int count,
			     int *eof, void *data)
{
	int i, len = 0;
	off_t	begin = 0;	
	int j, t0, t1, t, thigh, tlow, tdi0;
	int di0, ei1;
	len += sprintf(page + len, "trig0: %i trig1: %i\n", log_int_trig0_pos, log_int_trig1_pos);
	for (i = 0; i < log_int_pos-1; i++) {
 
		if (((log_ints[i].ev_timer_data >> 24) & INT_NEW_EI)) {
			di0 = i;
			while (di0 < log_int_pos-1 && (((log_ints[di0].ev_timer_data >> 24) & INT_NEW_EI)))
				di0++;
			ei1 = di0+1;
			while (ei1 < log_int_pos-1 && (((log_ints[ei1].ev_timer_data >> 24) & INT_NEW_EI) == 0))
				ei1++;
			thigh = timer_data_to_ns(log_ints[ei1].ev_timer_data);
			tlow = timer_data_to_ns(log_ints[di0].ev_timer_data);
			tdi0 = timer_data_to_ns(log_ints[di0].ev_timer_data);
 
			t = thigh-tlow;
			j = di0-1;		
			if ((t > LOG_INT_SHOW_MIN_USEC) || (log_int_trig0_pos-30 < j && j < log_int_trig1_pos+30)) {
 
			for (; j <= ei1; j++) {
				t0 = ((log_ints[j+1].ev_timer_data & 0xFF) -
				      (log_ints[j].ev_timer_data & 0xFF));
				t1 = (((log_ints[j+1].ev_timer_data >> 8) & 0xFF) -
				      ((log_ints[j].ev_timer_data >> 8) & 0xFF));
				if (t1 == 0 || t1 == 1) {
					if (t0 < 0)
						t0 += 256;
				} else {
					if (t1 < 0)
						t1 += 256;
				}
				thigh = timer_data_to_ns(log_ints[j+1].ev_timer_data);
				tlow = timer_data_to_ns(log_ints[j].ev_timer_data);
				t = thigh-tlow;
				len += sprintf(page + len, "%4i PC %08lX-%08lX %08lX-%08lX %s high %i in %-6i ns %-7i to %-7i = %-5i ns, from first di %i ns %s\n",
					       j, log_ints[j].pc, log_ints[j+1].pc,
					       log_ints[j].ev_timer_data, log_ints[j+1].ev_timer_data,
					       ((log_ints[j].ev_timer_data >> 24) & INT_NEW_EI)!= 0?"ei":"di", t1, t,
					       tlow, thigh, thigh-tlow, thigh-tdi0,
					       j==log_int_trig0_pos?"TRIG0":(j==log_int_trig1_pos?"TRIG1":""));
				if (len+begin > off+count)
					goto done;
				if (len+begin < off) {
					begin += len;
					len = 0;
				}
			}
 
			len += sprintf(page + len,"\n");
			i = ei1-2;
			}
 
		}
 
	}
	log_int_enable = 1;
	log_int_pos = 0;
	log_int_trig0_pos = 0;
	log_int_trig1_pos = 0;
	*eof = 1;
done:
	if (off >= len+begin)
		return 0;
	*start = page + (off-begin);
	return ((count < begin+len-off) ? count : begin+len-off);	
}
 
static int __init
log_int_init(void)
{
	create_proc_read_entry (DEBUG_INT_PROC_FILE, 0, 0, log_int_read_proc, NULL);
	printk(KERN_INFO "/proc/" DEBUG_INT_PROC_FILE " size %i.\r\n",
	       LOG_INT_SIZE);
	return 0;
}
module_init(log_int_init);
#endif /* CONFIG_ETRAX_DEBUG_INTERRUPT */