[mirror_ubuntu-artful-kernel.git] / arch / mips / jazz / reset.c

/*
 * Reset a Jazz machine.
 *
 * We don't trust the firmware so we do it the classic way by poking and
 * stabbing at the keyboard controller ...
 */
#include <linux/jiffies.h>
#include <asm/jazz.h>

#define KBD_STAT_IBF		0x02	/* Keyboard input buffer full */

static void jazz_write_output(unsigned char val)
{
	int status;

	do {
		status = jazz_kh->command;
	} while (status & KBD_STAT_IBF);
	jazz_kh->data = val;
}

static void jazz_write_command(unsigned char val)
{
	int status;

	do {
		status = jazz_kh->command;
	} while (status & KBD_STAT_IBF);
	jazz_kh->command = val;
}

static unsigned char jazz_read_status(void)
{
	return jazz_kh->command;
}

static inline void kb_wait(void)
{
	unsigned long start = jiffies;
	unsigned long timeout = start + HZ/2;

	do {
		if (! (jazz_read_status() & 0x02))
			return;
	} while (time_before_eq(jiffies, timeout));
}

void jazz_machine_restart(char *command)
{
	while(1) {
		kb_wait();
		jazz_write_command(0xd1);
		kb_wait();
		jazz_write_output(0x00);
	}
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Reset a Jazz machine.
	3	*
	4	* We don't trust the firmware so we do it the classic way by poking and
	5	* stabbing at the keyboard controller ...
	6	*/
	7	#include <linux/jiffies.h>
	8	#include <asm/jazz.h>
1da177e4 LT	9
	10	#define KBD_STAT_IBF 0x02 /* Keyboard input buffer full */
	11
	12	static void jazz_write_output(unsigned char val)
	13	{
	14	int status;
	15
	16	do {
	17	status = jazz_kh->command;
	18	} while (status & KBD_STAT_IBF);
	19	jazz_kh->data = val;
	20	}
	21
	22	static void jazz_write_command(unsigned char val)
	23	{
	24	int status;
	25
	26	do {
	27	status = jazz_kh->command;
	28	} while (status & KBD_STAT_IBF);
	29	jazz_kh->command = val;
	30	}
	31
	32	static unsigned char jazz_read_status(void)
	33	{
	34	return jazz_kh->command;
	35	}
	36
	37	static inline void kb_wait(void)
	38	{
	39	unsigned long start = jiffies;
	40	unsigned long timeout = start + HZ/2;
	41
	42	do {
	43	if (! (jazz_read_status() & 0x02))
	44	return;
	45	} while (time_before_eq(jiffies, timeout));
	46	}
	47
	48	void jazz_machine_restart(char *command)
	49	{
	50	while(1) {
	51	kb_wait();
49a89efb	52	jazz_write_command(0xd1);
1da177e4	53	kb_wait();
49a89efb	54	jazz_write_output(0x00);
1da177e4 LT	55	}
1da177e4 LT	56	}