#include <DOS.H>
#include <conio.h>
#include <stdio.h>
#include <emurtk.h>
#include <time.h>

unsigned char SNS0, SNS1, SNS2;
int SN[18], SNB[18], a, d, z = 0, x = 0, y = 0;
char DRV[3];
unsigned char inputD()
{
	unsigned char data = 0;
	outportb(0x37A, 0x2E);
	outportb(0x378, 0xFF);
	outportb(0x37A, 0x2F);
	delay(1);
	data = inportb(0x378);
	outportb(0x37A, 0x04);
	return data;
}
void writeRC(char data)
{
	outportb(0x37A, 0x04);
	outportb(0x378, data);
	outportb(0x37A, 0x00);
	delay(1);
	outportb(0x37A, 0x04);
}
void writeRA(char data)
{
	outportb(0x37A, 0x0E);
	outportb(0x378, data);
	outportb(0x37A, 0x0A);
	delay(1);
	outportb(0x37A, 0x0E);
}
void RS()
{
	writeRC(0x13);
	SNS0 = inputD();
	SNS1 = inputD();
	SNS2 = inputD();
	int SNS[3] = { SNS0 ,SNS1 ,SNS2 };
	int u = 0, i, j;
	for (i = 0; i<3; i++) {
		for (j = 0; j<6; j++) {
			SN[u] = (SNS[i] + 1) % 2;
			SNS[i] /= 2;
			u++;
		}
	}
}
void Doit()
{
	writeRC(0x11);
	writeRA(0x80);

	writeRA(0x10);

	writeRC(0x11);
	writeRA(0x80);
	writeRA(0x01);

	writeRC(0x11);
	writeRA(0x80);
	writeRA(0x04);

}
void Stop()
{
	writeRC(0x11);
	writeRA(0x00);
	writeRA(0x00);
}

void calibration()
{
	while ((SN[0] != 1) && (SN[3] != 1) && (SN[6] != 1)) {
		Doit();
		RS();
		printf("\nSN[0]=%d, SN[3]=%d, SN[6]=%d\n", SN[0], SN[3], SN[6]);
	}
}

int main()
{


	RS();
	printf("na4alo");
	calibration();
printf("\nSN[0]=%d, SN[3]=%d, SN[6]=%d\n", SN[0], SN[3], SN[6]);
	printf("vipolneno");
	return 0;
}