#include <system.h>

void send_command(unsigned int number, unsigned int flags)
{
	switch (number)
	{
		case ATA_IDENTIFY:
		{
			unsigned char selector = (flags & (1 << ATA_SLAVE)) ? 0xB0 : 0xA0;
			unsigned char controller = (flags & (1 << ATA_CONTROLLER)) ? PRIMARY_BASE : SECONDARY_BASE;
			outportb(ATA_DRIVE(controller), selector);
			outportb(ATA_SECTOR_COUNT(controller), 0);
			outportb(ATA_SECTOR_NUM(controller), 0);
			outportb(ATA_CYLINDER_LOW(controller), 0);
			outportb(ATA_CYLINDER_HI(controller), 0);
			outportb(ATA_COMMAND(controller), 0xEC);
			unsigned char status = inportb(ATA_COMMAND(controller));
			if (status == 0)
			{
				puts("Drive does not exist.");
			}
			unsigned char st[32] = { '\0' };
			while ((status = inportb(ATA_COMMAND(controller))) & (1 << ATA_BSY))
			{
				;
			}
			
		}
	}
}

void hd_install(void)
{
	// First of all, check we actually have any hard drives.  If not,
	// we have what is called a Floating Bus.  We check for this by reading the Regular Status byte
	// and seeing if it is 0xFF.  If so, simply print an error message and exit.
	unsigned char status = inportb(ATA_COMMAND(PRIMARY_BASE));
	if (status == FLOATING_BUS)
	{
		puts("No hard drives found.  Exiting.\n");
		return;
	}
	unsigned char st[32] = { '\0' };
	uitoa(status, st, 10);
	puts("ATA Status: ");
	puts(st);
	puts("\n");
	send_command(ATA_IDENTIFY, (1 << ATA_CONTROLLER));
}
