[u-boot.git] / board / trab / trab.c

/*
 * (C) Copyright 2002
 * Gary Jennejohn, DENX Software Engineering, <[email protected]>
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * 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, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

/* #define DEBUG */

#include <common.h>
#include <malloc.h>
#include <s3c2400.h>
#include <command.h>

DECLARE_GLOBAL_DATA_PTR;

#ifdef CONFIG_SYS_BRIGHTNESS
static void spi_init(void);
static void wait_transmit_done(void);
static void tsc2000_write(unsigned int page, unsigned int reg,
						  unsigned int data);
static void tsc2000_set_brightness(void);
#endif
#ifdef CONFIG_MODEM_SUPPORT
static int key_pressed(void);
extern void disable_putc(void);
extern int do_mdm_init; /* defined in common/main.c */

/*
 * We need a delay of at least 500 us after turning on the VFD clock
 * before we can read any useful information for the CPLD controlling
 * the keyboard switches. Let's play safe and wait 5 ms. The problem
 * is that timers are not available yet, so we use a manually timed
 * loop.
 */
#define KBD_MDELAY	5000
static void udelay_no_timer (int usec)
{
	int i;
	int delay = usec * 3;

	for (i = 0; i < delay; i ++) gd->bd->bi_arch_number = MACH_TYPE_TRAB;
}
#endif /* CONFIG_MODEM_SUPPORT */

/*
 * Miscellaneous platform dependent initialisations
 */

int board_init ()
{
#if defined(CONFIG_VFD)
	extern int vfd_init_clocks(void);
#endif
	S3C24X0_CLOCK_POWER * const clk_power = S3C24X0_GetBase_CLOCK_POWER();
	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();

	/* memory and cpu-speed are setup before relocation */
#ifdef CONFIG_TRAB_50MHZ
	/* change the clock to be 50 MHz 1:1:1 */
	/* MDIV:0x5c PDIV:4 SDIV:2 */
	clk_power->MPLLCON = 0x5c042;
	clk_power->CLKDIVN = 0;
#else
	/* change the clock to be 133 MHz 1:2:4 */
	/* MDIV:0x7d PDIV:4 SDIV:1 */
	clk_power->MPLLCON = 0x7d041;
	clk_power->CLKDIVN = 3;
#endif

	/* set up the I/O ports */
	gpio->PACON = 0x3ffff;
	gpio->PBCON = 0xaaaaaaaa;
	gpio->PBUP  = 0xffff;
	/* INPUT nCTS0 nRTS0 TXD[1] TXD[0] RXD[1] RXD[0]	*/
	/*  00,    10,      10,      10,      10,      10,      10	*/
	gpio->PFCON = (2<<0) | (2<<2) | (2<<4) | (2<<6) | (2<<8) | (2<<10);
#ifdef CONFIG_HWFLOW
	/* do not pull up RXD0, RXD1, TXD0, TXD1, CTS0, RTS0 */
	gpio->PFUP  = (1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<4) | (1<<5);
#else
	/* do not pull up RXD0, RXD1, TXD0, TXD1 */
	gpio->PFUP  = (1<<0) | (1<<1) | (1<<2) | (1<<3);
#endif
	gpio->PGCON = 0x0;
	gpio->PGUP  = 0x0;
	gpio->OPENCR= 0x0;

	/* suppress flicker of the VFDs */
	gpio->MISCCR = 0x40;
	gpio->PFCON |= (2<<12);

	gd->bd->bi_arch_number = MACH_TYPE_TRAB;

	/* adress of boot parameters */
	gd->bd->bi_boot_params = 0x0c000100;

	/* Make sure both buzzers are turned off */
	gpio->PDCON |= 0x5400;
	gpio->PDDAT &= ~0xE0;

#ifdef CONFIG_VFD
	vfd_init_clocks();
#endif /* CONFIG_VFD */

#ifdef CONFIG_MODEM_SUPPORT
	udelay_no_timer (KBD_MDELAY);

	if (key_pressed()) {
		disable_putc();	/* modem doesn't understand banner etc */
		do_mdm_init = 1;
	}
#endif	/* CONFIG_MODEM_SUPPORT */

#ifdef CONFIG_DRIVER_S3C24X0_I2C
	/* Configure I/O ports PG5 und PG6 for I2C */
	gpio->PGCON = (gpio->PGCON & 0x003c00) | 0x003c00;
#endif /* CONFIG_DRIVER_S3C24X0_I2C */

	return 0;
}

int dram_init (void)
{
	gd->bd->bi_dram[0].start = PHYS_SDRAM_1;
	gd->bd->bi_dram[0].size = PHYS_SDRAM_1_SIZE;
	return 0;
}

/*-----------------------------------------------------------------------
 * Keyboard Controller
 */

/* Maximum key number */
#define KEYBD_KEY_NUM		4

#define KBD_DATA	(((*(volatile ulong *)0x04020000) >> 16) & 0xF)

static char *key_match (ulong);

int misc_init_r (void)
{
	ulong kbd_data = KBD_DATA;
	char *str;
	char keybd_env[KEYBD_KEY_NUM + 1];
	int i;

#ifdef CONFIG_VERSION_VARIABLE
	{
		/* Set version variable. Please note, that this variable is
		 * also set in main_loop() later in the boot process. The
		 * version variable has to be set this early, because so it
		 * could be used in script files on an usb stick, which
		 * might be called during do_auto_update() */
		extern char version_string[];

		setenv ("ver", version_string);
	}
#endif /* CONFIG_VERSION_VARIABLE */

#ifdef CONFIG_AUTO_UPDATE
	{
		extern int do_auto_update(void);
		/* this has priority over all else */
		do_auto_update();
	}
#endif

	for (i = 0; i < KEYBD_KEY_NUM; ++i) {
		keybd_env[i] = '0' + ((kbd_data >> i) & 1);
	}
	keybd_env[i] = '\0';
	debug ("** Setting keybd=\"%s\"\n", keybd_env);
	setenv ("keybd", keybd_env);

	str = strdup (key_match (kbd_data));	/* decode keys */

#ifdef CONFIG_PREBOOT	/* automatically configure "preboot" command on key match */
	debug ("** Setting preboot=\"%s\"\n", str);
	setenv ("preboot", str);	/* set or delete definition */
#endif /* CONFIG_PREBOOT */
	if (str != NULL) {
		free (str);
	}

#ifdef CONFIG_SYS_BRIGHTNESS
	tsc2000_set_brightness();
#endif
	return (0);
}

#ifdef CONFIG_PREBOOT

static uchar kbd_magic_prefix[] = "key_magic";
static uchar kbd_command_prefix[] = "key_cmd";

static int compare_magic (ulong kbd_data, char *str)
{
	uchar key_mask;

	debug ("compare_magic: kbd: %04lx  str: \"%s\"\n",kbd_data,str);
	for (; *str; str++)
	{
		uchar c = *str - '1';

		if (c >= KEYBD_KEY_NUM)		/* bad key number */
			return -1;

		key_mask = 1 << c;

		if (!(kbd_data & key_mask)) {	/* key not pressed */
			debug ( "compare_magic: "
				"kbd: %04lx mask: %04lx - key not pressed\n",
				kbd_data, key_mask );
			return -1;
		}

		kbd_data &= ~key_mask;
	}

	if (kbd_data) {				/* key(s) not released */
		debug ( "compare_magic: "
			"kbd: %04lx - key(s) not released\n", kbd_data);
		return -1;
	}

	return 0;
}

/*-----------------------------------------------------------------------
 * Check if pressed key(s) match magic sequence,
 * and return the command string associated with that key(s).
 *
 * If no key press was decoded, NULL is returned.
 *
 * Note: the first character of the argument will be overwritten with
 * the "magic charcter code" of the decoded key(s), or '\0'.
 *
 *
 * Note: the string points to static environment data and must be
 * saved before you call any function that modifies the environment.
 */
static char *key_match (ulong kbd_data)
{
	char magic[sizeof (kbd_magic_prefix) + 1];
	char cmd_name[sizeof (kbd_command_prefix) + 1];
	char *suffix;
	char *kbd_magic_keys;

	/*
	 * The following string defines the characters that can pe appended
	 * to "key_magic" to form the names of environment variables that
	 * hold "magic" key codes, i. e. such key codes that can cause
	 * pre-boot actions. If the string is empty (""), then only
	 * "key_magic" is checked (old behaviour); the string "125" causes
	 * checks for "key_magic1", "key_magic2" and "key_magic5", etc.
	 */
	if ((kbd_magic_keys = getenv ("magic_keys")) == NULL)
		kbd_magic_keys = "";

	debug ("key_match: magic_keys=\"%s\"\n", kbd_magic_keys);

	/* loop over all magic keys;
	 * use '\0' suffix in case of empty string
	 */
	for (suffix=kbd_magic_keys; *suffix || suffix==kbd_magic_keys; ++suffix)
	{
		sprintf (magic, "%s%c", kbd_magic_prefix, *suffix);

		debug ("key_match: magic=\"%s\"\n",
			getenv(magic) ? getenv(magic) : "<UNDEFINED>");

		if (compare_magic(kbd_data, getenv(magic)) == 0)
		{
			sprintf (cmd_name, "%s%c", kbd_command_prefix, *suffix);
			debug ("key_match: cmdname %s=\"%s\"\n",
				cmd_name,
				getenv (cmd_name) ?
					getenv (cmd_name) :
					"<UNDEFINED>");
			return (getenv (cmd_name));
		}
	}
	debug ("key_match: no match\n");
	return (NULL);
}
#endif							/* CONFIG_PREBOOT */

/* Read Keyboard status */
int do_kbd (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	ulong kbd_data = KBD_DATA;
	char keybd_env[KEYBD_KEY_NUM + 1];
	int i;

	puts ("Keys:");
	for (i = 0; i < KEYBD_KEY_NUM; ++i) {
		keybd_env[i] = '0' + ((kbd_data >> i) & 1);
		printf (" %c", keybd_env[i]);
	}
	keybd_env[i] = '\0';
	putc ('\n');
	setenv ("keybd", keybd_env);
	return 0;
}

U_BOOT_CMD(
	kbd,	1,	1,	do_kbd,
	"read keyboard status",
	""
);

#ifdef CONFIG_MODEM_SUPPORT
static int key_pressed(void)
{
	return (compare_magic(KBD_DATA, CONFIG_MODEM_KEY_MAGIC) == 0);
}
#endif	/* CONFIG_MODEM_SUPPORT */

#ifdef CONFIG_SYS_BRIGHTNESS

static inline void SET_CS_TOUCH(void)
{
	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();

	gpio->PDDAT &= 0x5FF;
}

static inline void CLR_CS_TOUCH(void)
{
	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();

	gpio->PDDAT |= 0x200;
}

static void spi_init(void)
{
	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();
	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();
	int i;

	/* Configure I/O ports. */
	gpio->PDCON = (gpio->PDCON & 0xF3FFFF) | 0x040000;
	gpio->PGCON = (gpio->PGCON & 0x0F3FFF) | 0x008000;
	gpio->PGCON = (gpio->PGCON & 0x0CFFFF) | 0x020000;
	gpio->PGCON = (gpio->PGCON & 0x03FFFF) | 0x080000;

	CLR_CS_TOUCH();

	spi->ch[0].SPPRE = 0x1F; /* Baudrate ca. 514kHz */
	spi->ch[0].SPPIN = 0x01;  /* SPI-MOSI holds Level after last bit */
	spi->ch[0].SPCON = 0x1A;  /* Polling, Prescaler, Master, CPOL=0, CPHA=1 */

	/* Dummy byte ensures clock to be low. */
	for (i = 0; i < 10; i++) {
		spi->ch[0].SPTDAT = 0xFF;
	}
	wait_transmit_done();
}

static void wait_transmit_done(void)
{
	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();

	while (!(spi->ch[0].SPSTA & 0x01)); /* wait until transfer is done */
}

static void tsc2000_write(unsigned int page, unsigned int reg,
						  unsigned int data)
{
	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();
	unsigned int command;

	SET_CS_TOUCH();
	command = 0x0000;
	command |= (page << 11);
	command |= (reg << 5);

	spi->ch[0].SPTDAT = (command & 0xFF00) >> 8;
	wait_transmit_done();
	spi->ch[0].SPTDAT = (command & 0x00FF);
	wait_transmit_done();
	spi->ch[0].SPTDAT = (data & 0xFF00) >> 8;
	wait_transmit_done();
	spi->ch[0].SPTDAT = (data & 0x00FF);
	wait_transmit_done();

	CLR_CS_TOUCH();
}

static void tsc2000_set_brightness(void)
{
	char tmp[10];
	int i, br;

	spi_init();
	tsc2000_write(1, 2, 0x0); /* Power up DAC */

	i = getenv_r("brightness", tmp, sizeof(tmp));
	br = (i > 0)
		? (int) simple_strtoul (tmp, NULL, 10)
		: CONFIG_SYS_BRIGHTNESS;

	tsc2000_write(0, 0xb, br & 0xff);
}
#endif
Commit	Line	Data
c609719b WD	1	/*
c609719b WD	2	* (C) Copyright 2002
792a09eb	3	* Gary Jennejohn, DENX Software Engineering, <[email protected]>
c609719b WD	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*/
	23
	24	/* #define DEBUG */
	25
	26	#include <common.h>
c609719b WD	27	#include <malloc.h>
c609719b WD	28	#include <s3c2400.h>
8bde7f77	29	#include <command.h>
c609719b	30
d87080b7	31	DECLARE_GLOBAL_DATA_PTR;
c609719b	32
6d0f6bcf	33	#ifdef CONFIG_SYS_BRIGHTNESS
1cb8e980 WD	34	static void spi_init(void);
1cb8e980 WD	35	static void wait_transmit_done(void);
82226bf4	36	static void tsc2000_write(unsigned int page, unsigned int reg,
1cb8e980 WD	37	unsigned int data);
	38	static void tsc2000_set_brightness(void);
	39	#endif
c609719b WD	40	#ifdef CONFIG_MODEM_SUPPORT
	41	static int key_pressed(void);
	42	extern void disable_putc(void);
	43	extern int do_mdm_init; /* defined in common/main.c */
	44
	45	/*
	46	* We need a delay of at least 500 us after turning on the VFD clock
	47	* before we can read any useful information for the CPLD controlling
	48	* the keyboard switches. Let's play safe and wait 5 ms. The problem
	49	* is that timers are not available yet, so we use a manually timed
	50	* loop.
	51	*/
e95b61cf WD	52	#define KBD_MDELAY 5000
e95b61cf WD	53	static void udelay_no_timer (int usec)
c609719b	54	{
c609719b	55	int i;
e95b61cf	56	int delay = usec * 3;
c609719b	57
731215eb	58	for (i = 0; i < delay; i ++) gd->bd->bi_arch_number = MACH_TYPE_TRAB;
c609719b WD	59	}
	60	#endif /* CONFIG_MODEM_SUPPORT */
	61
	62	/*
	63	* Miscellaneous platform dependent initialisations
	64	*/
	65
	66	int board_init ()
	67	{
6069ff26 WD	68	#if defined(CONFIG_VFD)
6069ff26 WD	69	extern int vfd_init_clocks(void);
a6c7ad2f	70	#endif
48b42616 WD	71	S3C24X0_CLOCK_POWER * const clk_power = S3C24X0_GetBase_CLOCK_POWER();
48b42616 WD	72	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();
c609719b WD	73
	74	/* memory and cpu-speed are setup before relocation */
	75	#ifdef CONFIG_TRAB_50MHZ
	76	/* change the clock to be 50 MHz 1:1:1 */
	77	/* MDIV:0x5c PDIV:4 SDIV:2 */
48b42616 WD	78	clk_power->MPLLCON = 0x5c042;
48b42616 WD	79	clk_power->CLKDIVN = 0;
c609719b WD	80	#else
	81	/* change the clock to be 133 MHz 1:2:4 */
	82	/* MDIV:0x7d PDIV:4 SDIV:1 */
48b42616 WD	83	clk_power->MPLLCON = 0x7d041;
48b42616 WD	84	clk_power->CLKDIVN = 3;
c609719b WD	85	#endif
	86
	87	/* set up the I/O ports */
48b42616 WD	88	gpio->PACON = 0x3ffff;
	89	gpio->PBCON = 0xaaaaaaaa;
	90	gpio->PBUP = 0xffff;
c609719b	91	/* INPUT nCTS0 nRTS0 TXD[1] TXD[0] RXD[1] RXD[0] */
53677ef1	92	/* 00, 10, 10, 10, 10, 10, 10 */
48b42616	93	gpio->PFCON = (2<<0) \| (2<<2) \| (2<<4) \| (2<<6) \| (2<<8) \| (2<<10);
c609719b WD	94	#ifdef CONFIG_HWFLOW
c609719b WD	95	/* do not pull up RXD0, RXD1, TXD0, TXD1, CTS0, RTS0 */
48b42616	96	gpio->PFUP = (1<<0) \| (1<<1) \| (1<<2) \| (1<<3) \| (1<<4) \| (1<<5);
c609719b WD	97	#else
c609719b WD	98	/* do not pull up RXD0, RXD1, TXD0, TXD1 */
48b42616	99	gpio->PFUP = (1<<0) \| (1<<1) \| (1<<2) \| (1<<3);
c609719b	100	#endif
48b42616 WD	101	gpio->PGCON = 0x0;
	102	gpio->PGUP = 0x0;
	103	gpio->OPENCR= 0x0;
c609719b	104
149dded2 WD	105	/* suppress flicker of the VFDs */
	106	gpio->MISCCR = 0x40;
	107	gpio->PFCON \|= (2<<12);
	108
731215eb	109	gd->bd->bi_arch_number = MACH_TYPE_TRAB;
c609719b WD	110
	111	/* adress of boot parameters */
	112	gd->bd->bi_boot_params = 0x0c000100;
	113
1cb8e980	114	/* Make sure both buzzers are turned off */
48b42616 WD	115	gpio->PDCON \|= 0x5400;
48b42616 WD	116	gpio->PDDAT &= ~0xE0;
1cb8e980	117
a6c7ad2f	118	#ifdef CONFIG_VFD
6069ff26	119	vfd_init_clocks();
a6c7ad2f	120	#endif /* CONFIG_VFD */
c609719b	121
6069ff26	122	#ifdef CONFIG_MODEM_SUPPORT
e95b61cf	123	udelay_no_timer (KBD_MDELAY);
c609719b WD	124
	125	if (key_pressed()) {
	126	disable_putc(); /* modem doesn't understand banner etc */
	127	do_mdm_init = 1;
	128	}
	129	#endif /* CONFIG_MODEM_SUPPORT */
	130
6dff5529 WD	131	#ifdef CONFIG_DRIVER_S3C24X0_I2C
6dff5529 WD	132	/* Configure I/O ports PG5 und PG6 for I2C */
53677ef1	133	gpio->PGCON = (gpio->PGCON & 0x003c00) \| 0x003c00;
6dff5529 WD	134	#endif /* CONFIG_DRIVER_S3C24X0_I2C */
6dff5529 WD	135
c609719b WD	136	return 0;
	137	}
	138
	139	int dram_init (void)
	140	{
c609719b WD	141	gd->bd->bi_dram[0].start = PHYS_SDRAM_1;
	142	gd->bd->bi_dram[0].size = PHYS_SDRAM_1_SIZE;
	143	return 0;
	144	}
	145
	146	/*-----------------------------------------------------------------------
	147	* Keyboard Controller
	148	*/
	149
	150	/* Maximum key number */
	151	#define KEYBD_KEY_NUM 4
	152
	153	#define KBD_DATA ((((volatile ulong )0x04020000) >> 16) & 0xF)
	154
a63c31cf	155	static char *key_match (ulong);
c609719b WD	156
	157	int misc_init_r (void)
	158	{
	159	ulong kbd_data = KBD_DATA;
a63c31cf WD	160	char *str;
a63c31cf WD	161	char keybd_env[KEYBD_KEY_NUM + 1];
c609719b WD	162	int i;
c609719b WD	163
4bdb53ca WD	164	#ifdef CONFIG_VERSION_VARIABLE
	165	{
	166	/* Set version variable. Please note, that this variable is
	167	* also set in main_loop() later in the boot process. The
	168	* version variable has to be set this early, because so it
	169	* could be used in script files on an usb stick, which
	170	* might be called during do_auto_update() */
	171	extern char version_string[];
	172
	173	setenv ("ver", version_string);
	174	}
	175	#endif /* CONFIG_VERSION_VARIABLE */
	176
f54ebdfa	177	#ifdef CONFIG_AUTO_UPDATE
a3d9181e WD	178	{
	179	extern int do_auto_update(void);
	180	/* this has priority over all else */
	181	do_auto_update();
	182	}
f54ebdfa WD	183	#endif
f54ebdfa WD	184
c609719b WD	185	for (i = 0; i < KEYBD_KEY_NUM; ++i) {
	186	keybd_env[i] = '0' + ((kbd_data >> i) & 1);
	187	}
	188	keybd_env[i] = '\0';
	189	debug ("** Setting keybd=\"%s\"\n", keybd_env);
	190	setenv ("keybd", keybd_env);
	191
	192	str = strdup (key_match (kbd_data)); /* decode keys */
	193
	194	#ifdef CONFIG_PREBOOT /* automatically configure "preboot" command on key match */
	195	debug ("** Setting preboot=\"%s\"\n", str);
	196	setenv ("preboot", str); /* set or delete definition */
	197	#endif /* CONFIG_PREBOOT */
	198	if (str != NULL) {
	199	free (str);
	200	}
	201
6d0f6bcf	202	#ifdef CONFIG_SYS_BRIGHTNESS
1cb8e980 WD	203	tsc2000_set_brightness();
1cb8e980 WD	204	#endif
c609719b WD	205	return (0);
	206	}
	207
	208	#ifdef CONFIG_PREBOOT
	209
	210	static uchar kbd_magic_prefix[] = "key_magic";
	211	static uchar kbd_command_prefix[] = "key_cmd";
	212
a63c31cf	213	static int compare_magic (ulong kbd_data, char *str)
c609719b WD	214	{
	215	uchar key_mask;
	216
	217	debug ("compare_magic: kbd: %04lx str: \"%s\"\n",kbd_data,str);
	218	for (; *str; str++)
	219	{
	220	uchar c = *str - '1';
	221
	222	if (c >= KEYBD_KEY_NUM) /* bad key number */
	223	return -1;
	224
	225	key_mask = 1 << c;
	226
	227	if (!(kbd_data & key_mask)) { /* key not pressed */
	228	debug ( "compare_magic: "
	229	"kbd: %04lx mask: %04lx - key not pressed\n",
	230	kbd_data, key_mask );
	231	return -1;
	232	}
	233
	234	kbd_data &= ~key_mask;
	235	}
	236
	237	if (kbd_data) { /* key(s) not released */
	238	debug ( "compare_magic: "
	239	"kbd: %04lx - key(s) not released\n", kbd_data);
	240	return -1;
	241	}
	242
	243	return 0;
	244	}
	245
	246	/*-----------------------------------------------------------------------
	247	* Check if pressed key(s) match magic sequence,
	248	* and return the command string associated with that key(s).
	249	*
	250	* If no key press was decoded, NULL is returned.
	251	*
	252	* Note: the first character of the argument will be overwritten with
	253	* the "magic charcter code" of the decoded key(s), or '\0'.
	254	*
	255	*
	256	* Note: the string points to static environment data and must be
	257	* saved before you call any function that modifies the environment.
	258	*/
a63c31cf	259	static char *key_match (ulong kbd_data)
c609719b	260	{
a63c31cf WD	261	char magic[sizeof (kbd_magic_prefix) + 1];
	262	char cmd_name[sizeof (kbd_command_prefix) + 1];
	263	char *suffix;
	264	char *kbd_magic_keys;
c609719b WD	265
	266	/*
	267	* The following string defines the characters that can pe appended
	268	* to "key_magic" to form the names of environment variables that
	269	* hold "magic" key codes, i. e. such key codes that can cause
	270	* pre-boot actions. If the string is empty (""), then only
	271	* "key_magic" is checked (old behaviour); the string "125" causes
	272	* checks for "key_magic1", "key_magic2" and "key_magic5", etc.
	273	*/
	274	if ((kbd_magic_keys = getenv ("magic_keys")) == NULL)
	275	kbd_magic_keys = "";
	276
	277	debug ("key_match: magic_keys=\"%s\"\n", kbd_magic_keys);
	278
	279	/* loop over all magic keys;
	280	* use '\0' suffix in case of empty string
	281	*/
	282	for (suffix=kbd_magic_keys; *suffix \|\| suffix==kbd_magic_keys; ++suffix)
	283	{
	284	sprintf (magic, "%s%c", kbd_magic_prefix, *suffix);
	285
	286	debug ("key_match: magic=\"%s\"\n",
	287	getenv(magic) ? getenv(magic) : "<UNDEFINED>");
	288
	289	if (compare_magic(kbd_data, getenv(magic)) == 0)
	290	{
	291	sprintf (cmd_name, "%s%c", kbd_command_prefix, *suffix);
	292	debug ("key_match: cmdname %s=\"%s\"\n",
	293	cmd_name,
	294	getenv (cmd_name) ?
	295	getenv (cmd_name) :
	296	"<UNDEFINED>");
	297	return (getenv (cmd_name));
	298	}
	299	}
	300	debug ("key_match: no match\n");
	301	return (NULL);
	302	}
	303	#endif /* CONFIG_PREBOOT */
	304
	305	/* Read Keyboard status */
	306	int do_kbd (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	307	{
	308	ulong kbd_data = KBD_DATA;
a63c31cf	309	char keybd_env[KEYBD_KEY_NUM + 1];
c609719b WD	310	int i;
	311
	312	puts ("Keys:");
	313	for (i = 0; i < KEYBD_KEY_NUM; ++i) {
	314	keybd_env[i] = '0' + ((kbd_data >> i) & 1);
	315	printf (" %c", keybd_env[i]);
	316	}
	317	keybd_env[i] = '\0';
	318	putc ('\n');
	319	setenv ("keybd", keybd_env);
	320	return 0;
	321	}
	322
0d498393	323	U_BOOT_CMD(
53677ef1	324	kbd, 1, 1, do_kbd,
2fb2604d	325	"read keyboard status",
a89c33db	326	""
8bde7f77 WD	327	);
8bde7f77 WD	328
c609719b WD	329	#ifdef CONFIG_MODEM_SUPPORT
	330	static int key_pressed(void)
	331	{
	332	return (compare_magic(KBD_DATA, CONFIG_MODEM_KEY_MAGIC) == 0);
	333	}
	334	#endif /* CONFIG_MODEM_SUPPORT */
1cb8e980	335
6d0f6bcf	336	#ifdef CONFIG_SYS_BRIGHTNESS
1cb8e980	337
48b42616 WD	338	static inline void SET_CS_TOUCH(void)
	339	{
	340	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();
	341
	342	gpio->PDDAT &= 0x5FF;
	343	}
	344
	345	static inline void CLR_CS_TOUCH(void)
	346	{
	347	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();
	348
	349	gpio->PDDAT \|= 0x200;
	350	}
1cb8e980 WD	351
	352	static void spi_init(void)
	353	{
48b42616 WD	354	S3C24X0_GPIO * const gpio = S3C24X0_GetBase_GPIO();
48b42616 WD	355	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();
1cb8e980 WD	356	int i;
	357
	358	/* Configure I/O ports. */
53677ef1	359	gpio->PDCON = (gpio->PDCON & 0xF3FFFF) \| 0x040000;
48b42616 WD	360	gpio->PGCON = (gpio->PGCON & 0x0F3FFF) \| 0x008000;
	361	gpio->PGCON = (gpio->PGCON & 0x0CFFFF) \| 0x020000;
	362	gpio->PGCON = (gpio->PGCON & 0x03FFFF) \| 0x080000;
1cb8e980	363
48b42616	364	CLR_CS_TOUCH();
1cb8e980	365
48b42616 WD	366	spi->ch[0].SPPRE = 0x1F; /* Baudrate ca. 514kHz */
	367	spi->ch[0].SPPIN = 0x01; /* SPI-MOSI holds Level after last bit */
	368	spi->ch[0].SPCON = 0x1A; /* Polling, Prescaler, Master, CPOL=0, CPHA=1 */
1cb8e980 WD	369
	370	/* Dummy byte ensures clock to be low. */
	371	for (i = 0; i < 10; i++) {
48b42616	372	spi->ch[0].SPTDAT = 0xFF;
1cb8e980	373	}
82226bf4	374	wait_transmit_done();
1cb8e980 WD	375	}
	376
	377	static void wait_transmit_done(void)
	378	{
48b42616 WD	379	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();
	380
	381	while (!(spi->ch[0].SPSTA & 0x01)); /* wait until transfer is done */
1cb8e980 WD	382	}
1cb8e980 WD	383
82226bf4	384	static void tsc2000_write(unsigned int page, unsigned int reg,
1cb8e980 WD	385	unsigned int data)
1cb8e980 WD	386	{
48b42616	387	S3C24X0_SPI * const spi = S3C24X0_GetBase_SPI();
1cb8e980 WD	388	unsigned int command;
1cb8e980 WD	389
48b42616	390	SET_CS_TOUCH();
1cb8e980 WD	391	command = 0x0000;
	392	command \|= (page << 11);
	393	command \|= (reg << 5);
	394
48b42616	395	spi->ch[0].SPTDAT = (command & 0xFF00) >> 8;
1cb8e980	396	wait_transmit_done();
48b42616	397	spi->ch[0].SPTDAT = (command & 0x00FF);
1cb8e980	398	wait_transmit_done();
48b42616	399	spi->ch[0].SPTDAT = (data & 0xFF00) >> 8;
1cb8e980	400	wait_transmit_done();
48b42616	401	spi->ch[0].SPTDAT = (data & 0x00FF);
1cb8e980 WD	402	wait_transmit_done();
1cb8e980 WD	403
48b42616	404	CLR_CS_TOUCH();
1cb8e980 WD	405	}
	406
	407	static void tsc2000_set_brightness(void)
	408	{
a63c31cf	409	char tmp[10];
1cb8e980 WD	410	int i, br;
	411
	412	spi_init();
	413	tsc2000_write(1, 2, 0x0); /* Power up DAC */
	414
	415	i = getenv_r("brightness", tmp, sizeof(tmp));
	416	br = (i > 0)
	417	? (int) simple_strtoul (tmp, NULL, 10)
6d0f6bcf	418	: CONFIG_SYS_BRIGHTNESS;
1cb8e980 WD	419
	420	tsc2000_write(0, 0xb, br & 0xff);
	421	}
	422	#endif