OSDev.org

Code: Select all

int get_drive_param(unsigned int dev_type,unsigned int bus,struct dev_geo * dev_geo_p)
{
	if(dev_type==SECONDARY_BUS) return -1;

	if(dev_geo_p == NULL) return -1;

	/*Send IDENTIFY COMMAND dev_type*/
	if(dev_type==PRIMARY_BUS)
	{
		dev_geo_p->heads=0;
		dev_geo_p->sectors=0;
		dev_geo_p->cylinders=0;
//		outb(PRIMARY_DRIVE_SELECT_PORT,0xe0); /*Primary, for slave use F0*/
//		outb(PRIMARY_STATUS_PORT,0x06);/*No interrupts*/


//asm volatile("cli;");
	while( get_primary_drive_status() & PRIMARY_STATUS_DRIVE_BUSY); //printk("dum\n");
		/*select the master drive on primary bus*/

		outb(PRIMARY_DRIVE_SELECT_PORT,COMMAND_IDENTIFY_MASTER_DRIVE);
		/*set all input parameters to 0 for identify command*/
		outb(PRIMARY_SECTOR_COUNT_PORT,0);
		outb(PRIMARY_SECTOR_LBA_LOW_PORT,0);
		outb(PRIMARY_CYLLOW_LBA_MID_PORT,0);
		outb(PRIMARY_CYLHIGH_LBA_HIGH_PORT,0);

		/*send the device identify command to port*/
		outb(PRIMARY_COMMAND_PORT,COMMAND_IDENTIFY);
		if(get_primary_drive_status()!=0)
		{
			while(get_primary_drive_status() & PRIMARY_STATUS_DATA_READY)/*loop here*/
			{
				if(inb(PRIMARY_CYLLOW_LBA_MID_PORT) || inb(PRIMARY_CYLHIGH_LBA_HIGH_PORT))
				{
					return -1; /*NOT ATA drive*/
				}
			}
			unsigned short buff[SECTOR_SIZE/2];
			int i=0;
			for(i=0;i<SECTOR_SIZE/2;i++)
			{
				buff[i]=ins(PRIMARY_DATA_PORT);
			}
			/*printk("buff[83]=%x\n",buff[83]);
			printk("buff[49]=%x\n",buff[49]);*/
			dev_geo_p->max_sectors=(unsigned char)(buff[47]& 0xff);
			dev_geo_p->drive_mode|=(unsigned char)(buff[59] & (1<<8));
			/*Currently only setting drive to master but check this later*/
			SET_BIT(dev_geo_p->drive_mode,5);
			if(IS_BIT_SET(buff[49],9)){/*bit 9 is set if LBA is supported*/	
			if(IS_BIT_SET(buff[83],10))
			{
				SET_BIT(dev_geo_p->drive_mode,2);
				dev_geo_p->size_48_upper=*((unsigned int*)&buff[100]);
				dev_geo_p->size_48_lower=*((unsigned int*)&buff[102]);
			}
			if(dev_geo_p->size_48==0) /*48 bit can't be used since no addressable logical sectors, but 28LBA is there*/
			{
				SET_BIT(dev_geo_p->drive_mode,1);
				dev_geo_p->size_28=*((unsigned int*)&buff[60]);
			}
			}
		}
	}