/*	$NetBSD: device_test.c,v 1.4 2008/04/28 20:23:18 martin Exp $	*/

/*-
 * Copyright (c) 2004 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by UCHIYAMA Yasushi.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <lib/libsa/stand.h>
#include <lib/libkern/libkern.h>

#include <machine/sbd.h>
#include <machine/gavar.h>

#include "console.h"	/* zskbd_print_keyscan */
#include "cmd.h"
#include "local.h"
#include "common.h"

struct ga ga;

extern bool lance_test(void);
int fdd_test(void);
int i82589_test(void);
int picnic_test(void);
int beep_test(void);
int clut_test(int);

int
cmd_ga_test(int argc, char *argp[], int interactive)
{
	int i;

	switch (strtoul(argp[1], 0, 0)) {
	default:
		break;
	case 0:
		if (SBD_INFO->machine == MACHINE_TR2A)
			ga.flags = 0x0001;
		ga_init(&ga);
		break;
	case 1:
		for (i = 0; i < 256; i++)
			fb_clear(240, 240, 240, 240, i);
		break;
	case 2:
		ga_plane_mask_test(&ga);
		break;
	}

	return 0;
}

int
cmd_kbd_scancode(int argc, char *argp[], int interactive)
{

	if (argc < 2) {
		printf("ks on/off\n");
		return 1;
	}

	if (argp[1][1] == 'n')
		zskbd_print_keyscan(1);
	else if (argp[1][1] == 'f')
		zskbd_print_keyscan(0);

	return 0;
}

int
cmd_ether_test(int argc, char *argp[], int interactive)
{

	if (SBD_INFO->machine == MACHINE_TR2)
		i82589_test();
	if (SBD_INFO->machine == MACHINE_TR2A)
		lance_test();

	return 0;
}

int
i82589_test(void)
{
#define	SCP_ADDR	0xa0800000
#define	IEE_ADDR	((volatile uint32_t *)0xbb060000)
	volatile uint32_t cmd;
	volatile uint16_t u16;
	int i;

	/* Board reset */
	*IEE_ADDR = 0;
	*IEE_ADDR = 0;

	for (i = 0; i < 100; i++)
		;

	/* Board self test */
	*(uint32_t *)(SCP_ADDR + 4) = 0xffffffff;
	cmd = (SCP_ADDR & 0x0ffffff0) | /* i82586-mode, A24-A31 are omitted */
	    0x1/*Self test */;
	cmd = (cmd << 16) | (cmd >> 16);
	printf("self test command 0x%x\n", cmd);
	*IEE_ADDR = cmd;
	*IEE_ADDR = cmd;
	for (i = 0; i < 0x60000; i++) 	/* 393216 */
		if ((u16 = *(volatile uint16_t *)(SCP_ADDR + 6)) == 0)
			break;

	if (i != 0x60000) {
		printf("i82596 self test success. (loop %d)\n", i);
	} else {
		printf("i82586 self test failed.\n");
		return 1;
	}

	u16 = *(uint16_t *)(SCP_ADDR + 4);
	printf("SCP_ADDR+4=0x%x\n", u16);
	if ((u16 & 0x103c) != 0) {
		printf("i82589 self test data error.\n");
		return 1;
	} else {
		printf("i82589 self test data OK.\n");
	}

	return 0;
}

int
picnic_test(void)
{

	/* PICNIC test */
	printf("--------------------\n");
	printf("%x ", *(uint8_t *)0xbb000000); /* 0x00 */
	printf("%x ", *(uint8_t *)0xbb000004); /* 0xc0 */
	printf("%x ", *(uint8_t *)0xbb000008); /* 0x00 */
	printf("%x ", *(uint8_t *)0xbb000010); /* 0x01 */
	printf("\n");
	printf("%x ", *(uint8_t *)0xbb001000); /* 0x00 */
	printf("%x ", *(uint8_t *)0xbb001004); /* 0x00 */
	printf("%x ", *(uint8_t *)0xbb001008); /* 0x00 */
	printf("%x\n", *(uint8_t *)0xbb001010);/* 0x01 */
	printf("--------------------\n");
	*(uint8_t *)0xbb001010 = 0;
#if 0
	*(uint32_t *)0xbb060000 = 0;
#endif
	printf("--------------------\n");
	printf("%x ", *(uint8_t *)0xbb000000);
	printf("%x ", *(uint8_t *)0xbb000004);
	printf("%x ", *(uint8_t *)0xbb000008);
	printf("%x ", *(uint8_t *)0xbb000010);
	printf("\n");
	printf("%x ", *(uint8_t *)0xbb001000);
	printf("%x ", *(uint8_t *)0xbb001004);
	printf("%x ", *(uint8_t *)0xbb001008);
	printf("%x\n", *(uint8_t *)0xbb001010);
	printf("--------------------\n");

	return 0;
}

int
beep_test(void)
{

	/* Beep test */
	for (;;)
		*(volatile uint8_t *)0xbb007000 = 0xff;

	return 0;
}

int
fdd_test(void)
{

	/* ROM_FDRDWR test */
	uint8_t buf[512];
	int i, err, cnt;
	uint32_t pos;

	for (i = 0; i < 1989; i++) {
		memset(buf, 0, 512);
		blk_to_2d_position(i, &pos, &cnt);
		err = ROM_FD_RW(0, pos, cnt, buf);
		printf("%d err=%d\n", i, err);
		if (err != 0)
			break;
#if 0
		for (j = 0; j < 512; j++)
			printf("%x", buf[j]);
		printf("\n");
#else
		printf("%s\n", buf);
#endif
	}
	return 0;
}