#include <stdlib.h>
#include <stdio.h>
#include <sys/io.h>
#include <assert.h>

void detect_opl(unsigned short base) {

	unsigned char saved, saved2;

	outb(0x4, base);
	usleep(4);
	outb(0x60, base+1);
	usleep(24);
	outb(0x4, base);
	usleep(4);
	outb(0x80, base+1);
	usleep(24);
	saved = inb(base);
	outb(0x2, base);
	usleep(4);
	outb(0xff, base+1);
	usleep(24);
	outb(0x4, base);
	usleep(4);
	outb(0x21, base+1);
	usleep(24);
	saved2 = inb(base);
	outb(0x4, base);
	usleep(4);
	outb(0x60, base+1);
	usleep(24);
	outb(0x4, base);
	usleep(4);
	outb(0x80, base+1);
	usleep(24);

	printf("OPL detection result: 0x%x, 0x%x\n", saved, saved2);
	if ((saved2 & 0xe0) == 0xc0) {
		if ((saved & 0xe0) == 0x06) {
			printf("OPL2 detected at 0x%x\n", base);
		}
		else if ((saved & 0xe0) == 0 || (saved & 0xe0) == 0x0f) {
			printf("OPL3/4 detected at 0x%x\n", base);
		}
	}
	else printf("OPL NOT detected at 0x%x\n", base);
}

int main() {

	unsigned short base = 0xe000;
	int i;

	assert(!getuid());
	assert(iopl(3) != -1);
	printf("Using base 0x%x\n", base);
	
	for (i = 0; i < 0x20; i+=4) {
		printf("Reg %xh: 0x%lx\n", i, inl(base+i));
	}
	for (i = 0x20; i < 0x28; i++) {
		printf("Reg %xh: 0x%x\n", i, inb(base+i));
	}
	for (i = 0x80; i < 0x90; i+=4) {
		printf("Reg %xh: 0x%lx\n", i, inl(base+i));
	}
	detect_opl(0x388);
	detect_opl(0x390);
	detect_opl(0x220);
	detect_opl(0x222);
//	printf("Status: %d\n",inb(0x388));
//	printf("Secondary Index: %d\n",inb(0x390));
}

