kernel_optimize_test/arch/m68k/mac/debug.c

/*
 * linux/arch/m68k/mac/debug.c
 *
 * Shamelessly stolen (SCC code and general framework) from:
 *
 * linux/arch/m68k/atari/debug.c
 *
 * Atari debugging and serial console stuff
 *
 * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file COPYING in the main directory of this archive
 * for more details.
 */

#include <linux/types.h>
#include <linux/sched.h>
#include <linux/tty.h>
#include <linux/console.h>
#include <linux/init.h>
#include <linux/delay.h>

#define BOOTINFO_COMPAT_1_0
#include <asm/setup.h>
#include <asm/bootinfo.h>
#include <asm/machw.h>
#include <asm/macints.h>

extern unsigned long mac_videobase;
extern unsigned long mac_videodepth;
extern unsigned long mac_rowbytes;

extern void mac_serial_print(const char *);

#define DEBUG_HEADS
#undef DEBUG_SCREEN
#define DEBUG_SERIAL

/*
 * These two auxiliary debug functions should go away ASAP. Only usage:
 * before the console output is up (after head.S come some other crucial
 * setup routines :-) it permits writing 'data' to the screen as bit patterns
 * (good luck reading those). Helped to figure that the bootinfo contained
 * garbage data on the amount and size of memory chunks ...
 *
 * The 'pos' argument now simply means 'linefeed after print' ...
 */

#ifdef DEBUG_SCREEN
static int peng, line;
#endif

void mac_debugging_short(int pos, short num)
{
#ifdef DEBUG_SCREEN
	unsigned char *pengoffset;
	unsigned char *pptr;
	int i;
#endif

#ifdef DEBUG_SERIAL
	printk("debug: %d !\n", num);
#endif

#ifdef DEBUG_SCREEN
	if (!MACH_IS_MAC) {
		/* printk("debug: %d !\n", num); */
		return;
	}

	/* calculate current offset */
	pengoffset = (unsigned char *)mac_videobase +
		(150+line*2) * mac_rowbytes + 80 * peng;

	pptr = pengoffset;

	for (i = 0; i < 8 * sizeof(short); i++) { /* # of bits */
		/*        value        mask for bit i, reverse order */
		*pptr++ = (num & (1 << (8*sizeof(short)-i-1)) ? 0xFF : 0x00);
	}

	peng++;

	if (pos) {
		line++;
		peng = 0;
	}
#endif
}

void mac_debugging_long(int pos, long addr)
{
#ifdef DEBUG_SCREEN
	unsigned char *pengoffset;
	unsigned char *pptr;
	int i;
#endif

#ifdef DEBUG_SERIAL
	printk("debug: #%ld !\n", addr);
#endif

#ifdef DEBUG_SCREEN
	if (!MACH_IS_MAC) {
		/* printk("debug: #%ld !\n", addr); */
		return;
	}

	pengoffset=(unsigned char *)(mac_videobase+(150+line*2)*mac_rowbytes)
		    +80*peng;

	pptr = pengoffset;

	for (i = 0; i < 8 * sizeof(long); i++) { /* # of bits */
		*pptr++ = (addr & (1 << (8*sizeof(long)-i-1)) ? 0xFF : 0x00);
	}

	peng++;

	if (pos) {
		line++;
		peng = 0;
	}
#endif
}

#ifdef DEBUG_SERIAL
/*
 * TODO: serial debug code
 */

struct mac_SCC {
	u_char cha_b_ctrl;
	u_char char_dummy1;
	u_char cha_a_ctrl;
	u_char char_dummy2;
	u_char cha_b_data;
	u_char char_dummy3;
	u_char cha_a_data;
};

# define scc (*((volatile struct mac_SCC*)mac_bi_data.sccbase))

/* Flag that serial port is already initialized and used */
int mac_SCC_init_done;
/* Can be set somewhere, if a SCC master reset has already be done and should
 * not be repeated; used by kgdb */
int mac_SCC_reset_done;

static int scc_port = -1;

static struct console mac_console_driver = {
	.name	= "debug",
	.flags	= CON_PRINTBUFFER,
	.index	= -1,
};

/*
 * Crude hack to get console output to the screen before the framebuffer
 * is initialized (happens a lot later in 2.1!).
 * We just use the console routines declared in head.S, this will interfere
 * with regular framebuffer console output and should be used exclusively
 * to debug kernel problems manifesting before framebuffer init (aka WSOD)
 *
 * To keep this hack from interfering with the regular console driver, either
 * deregister this driver before/on framebuffer console init, or silence this
 * function after the fbcon driver is running (will lose console messages!?).
 * To debug real early bugs, need to write a 'mac_register_console_hack()'
 * that is called from start_kernel() before setup_arch() and just registers
 * this driver if Mac.
 */

void mac_debug_console_write(struct console *co, const char *str,
			     unsigned int count)
{
	mac_serial_print(str);
}



/* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/

#define uSEC 1

static inline void mac_sccb_out(char c)
{
	int i;

	do {
		for (i = uSEC; i > 0; --i)
			barrier();
	} while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
	for (i = uSEC; i > 0; --i)
		barrier();
	scc.cha_b_data = c;
}

static inline void mac_scca_out(char c)
{
	int i;

	do {
		for (i = uSEC; i > 0; --i)
			barrier();
	} while (!(scc.cha_a_ctrl & 0x04)); /* wait for tx buf empty */
	for (i = uSEC; i > 0; --i)
		barrier();
	scc.cha_a_data = c;
}

void mac_sccb_console_write(struct console *co, const char *str,
			    unsigned int count)
{
	while (count--) {
		if (*str == '\n')
			mac_sccb_out('\r');
		mac_sccb_out(*str++);
	}
}

void mac_scca_console_write(struct console *co, const char *str,
			    unsigned int count)
{
	while (count--) {
		if (*str == '\n')
			mac_scca_out('\r');
		mac_scca_out(*str++);
	}
}


/* The following two functions do a quick'n'dirty initialization of the MFP or
 * SCC serial ports. They're used by the debugging interface, kgdb, and the
 * serial console code. */
#define SCCB_WRITE(reg,val)				\
	do {						\
		int i;					\
		scc.cha_b_ctrl = (reg);			\
		for (i = uSEC; i > 0; --i)		\
			barrier();			\
		scc.cha_b_ctrl = (val);			\
		for (i = uSEC; i > 0; --i)		\
			barrier();			\
	} while(0)

#define SCCA_WRITE(reg,val)				\
	do {						\
		int i;					\
		scc.cha_a_ctrl = (reg);			\
		for (i = uSEC; i > 0; --i)		\
			barrier();			\
		scc.cha_a_ctrl = (val);			\
		for (i = uSEC; i > 0; --i)		\
			barrier();			\
	} while(0)

/* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
 * delay of ~ 60us. */
/* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/
#define LONG_DELAY()					\
	do {						\
		int i;					\
		for (i = 60*uSEC; i > 0; --i)		\
		    barrier();				\
	} while(0)

#ifndef CONFIG_SERIAL_CONSOLE
static void __init mac_init_scc_port(int cflag, int port)
#else
void mac_init_scc_port(int cflag, int port)
#endif
{
	extern int mac_SCC_reset_done;

	/*
	 * baud rates: 1200, 1800, 2400, 4800, 9600, 19.2k, 38.4k, 57.6k, 115.2k
	 */

	static int clksrc_table[9] =
		/* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
		{ 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
	static int clkmode_table[9] =
		/* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
		{ 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
	static int div_table[9] =
		/* reg12 (BRG low) */
		{ 94, 62, 46, 22, 10, 4, 1, 0, 0 };

	int baud = cflag & CBAUD;
	int clksrc, clkmode, div, reg3, reg5;

	if (cflag & CBAUDEX)
		baud += B38400;
	if (baud < B1200 || baud > B38400+2)
		baud = B9600; /* use default 9600bps for non-implemented rates */
	baud -= B1200; /* tables starts at 1200bps */

	clksrc  = clksrc_table[baud];
	clkmode = clkmode_table[baud];
	div     = div_table[baud];

	reg3 = (((cflag & CSIZE) == CS8) ? 0xc0 : 0x40);
	reg5 = (((cflag & CSIZE) == CS8) ? 0x60 : 0x20) | 0x82 /* assert DTR/RTS */;

	if (port == 1) {
		(void)scc.cha_b_ctrl;	/* reset reg pointer */
		SCCB_WRITE(9, 0xc0);	/* reset */
		LONG_DELAY();		/* extra delay after WR9 access */
		SCCB_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
			   0x04 /* 1 stopbit */ |
			   clkmode);
		SCCB_WRITE(3, reg3);
		SCCB_WRITE(5, reg5);
		SCCB_WRITE(9, 0);	/* no interrupts */
		LONG_DELAY();		/* extra delay after WR9 access */
		SCCB_WRITE(10, 0);	/* NRZ mode */
		SCCB_WRITE(11, clksrc);	/* main clock source */
		SCCB_WRITE(12, div);	/* BRG value */
		SCCB_WRITE(13, 0);	/* BRG high byte */
		SCCB_WRITE(14, 1);
		SCCB_WRITE(3, reg3 | 1);
		SCCB_WRITE(5, reg5 | 8);
	} else if (port == 0) {
		(void)scc.cha_a_ctrl;	/* reset reg pointer */
		SCCA_WRITE(9, 0xc0);	/* reset */
		LONG_DELAY();		/* extra delay after WR9 access */
		SCCA_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
			  0x04 /* 1 stopbit */ |
			  clkmode);
		SCCA_WRITE(3, reg3);
		SCCA_WRITE(5, reg5);
		SCCA_WRITE(9, 0);	/* no interrupts */
		LONG_DELAY();		/* extra delay after WR9 access */
		SCCA_WRITE(10, 0);	/* NRZ mode */
		SCCA_WRITE(11, clksrc);	/* main clock source */
		SCCA_WRITE(12, div);	/* BRG value */
		SCCA_WRITE(13, 0);	/* BRG high byte */
		SCCA_WRITE(14, 1);
		SCCA_WRITE(3, reg3 | 1);
		SCCA_WRITE(5, reg5 | 8);
	}

	mac_SCC_reset_done = 1;
	mac_SCC_init_done = 1;
}
#endif /* DEBUG_SERIAL */

void mac_init_scca_port(int cflag)
{
	mac_init_scc_port(cflag, 0);
}

void mac_init_sccb_port(int cflag)
{
	mac_init_scc_port(cflag, 1);
}

static int __init mac_debug_setup(char *arg)
{
	if (!MACH_IS_MAC)
		return 0;

#ifdef DEBUG_SERIAL
	if (!strcmp(arg, "ser") || !strcmp(arg, "ser1")) {
		/* Mac modem port */
		mac_init_scc_port(B9600|CS8, 0);
		mac_console_driver.write = mac_scca_console_write;
		scc_port = 0;
	} else if (!strcmp(arg, "ser2")) {
		/* Mac printer port */
		mac_init_scc_port(B9600|CS8, 1);
		mac_console_driver.write = mac_sccb_console_write;
		scc_port = 1;
	}
#endif
#ifdef DEBUG_HEADS
	if (!strcmp(arg, "scn") || !strcmp(arg, "con")) {
		/* display, using head.S console routines */
		mac_console_driver.write = mac_debug_console_write;
	}
#endif
	if (mac_console_driver.write)
		register_console(&mac_console_driver);
	return 0;
}

early_param("debug", mac_debug_setup);