217 lines
		
	
	
		
			5.5 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			217 lines
		
	
	
		
			5.5 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * Copyright (C) Procsys. All rights reserved.
 | |
|  * Author: Mushtaq Khan <mushtaq_k@procsys.com>
 | |
|  *			<mushtaqk_921@yahoo.co.in>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU General Public License as
 | |
|  * published by the Free Software Foundation; either version 2 of
 | |
|  * the License, or (at your option) any later version.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software
 | |
|  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 | |
|  * MA 02111-1307 USA
 | |
|  *
 | |
|  * with the reference to ata_piix driver in kernel 2.4.32
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * This file contains SATA controller and SATA drive initialization functions
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <pci.h>
 | |
| #include <command.h>
 | |
| #include <config.h>
 | |
| #include <asm/byteorder.h>
 | |
| #include <ide.h>
 | |
| #include <ata.h>
 | |
| 
 | |
| #ifdef CFG_ATA_PIIX		/*ata_piix driver */
 | |
| 
 | |
| #define DEBUG_SATA 0		/*For debug prints set DEBUG_SATA to 1 */
 | |
| 
 | |
| #define DRV_DECL		/*For file specific declarations */
 | |
| #include <sata.h>
 | |
| #undef DRV_DECL
 | |
| 
 | |
| /*Macros realted to PCI*/
 | |
| #define PCI_SATA_BUS	0x00
 | |
| #define PCI_SATA_DEV	0x1f
 | |
| #define PCI_SATA_FUNC	0x02
 | |
| 
 | |
| #define PCI_SATA_BASE1 0x10
 | |
| #define PCI_SATA_BASE2 0x14
 | |
| #define PCI_SATA_BASE3 0x18
 | |
| #define PCI_SATA_BASE4 0x1c
 | |
| #define PCI_SATA_BASE5 0x20
 | |
| #define PCI_PMR         0x90
 | |
| #define PCI_PI          0x09
 | |
| #define PCI_PCS         0x92
 | |
| #define PCI_DMA_CTL     0x48
 | |
| 
 | |
| #define PORT_PRESENT (1<<0)
 | |
| #define PORT_ENABLED (1<<4)
 | |
| 
 | |
| u32 bdf;
 | |
| u32 iobase1 = 0;		/*Primary cmd block */
 | |
| u32 iobase2 = 0;		/*Primary ctl block */
 | |
| u32 iobase3 = 0;		/*Sec cmd block */
 | |
| u32 iobase4 = 0;		/*sec ctl block */
 | |
| u32 iobase5 = 0;		/*BMDMA*/
 | |
| int
 | |
| pci_sata_init (void)
 | |
| {
 | |
| 	u32 bus = PCI_SATA_BUS;
 | |
| 	u32 dev = PCI_SATA_DEV;
 | |
| 	u32 fun = PCI_SATA_FUNC;
 | |
| 	u16 cmd = 0;
 | |
| 	u8 lat = 0, pcibios_max_latency = 0xff;
 | |
| 	u8 pmr;			/*Port mapping reg */
 | |
| 	u8 pi;			/*Prgming Interface reg */
 | |
| 
 | |
| 	bdf = PCI_BDF (bus, dev, fun);
 | |
| 	pci_read_config_dword (bdf, PCI_SATA_BASE1, &iobase1);
 | |
| 	pci_read_config_dword (bdf, PCI_SATA_BASE2, &iobase2);
 | |
| 	pci_read_config_dword (bdf, PCI_SATA_BASE3, &iobase3);
 | |
| 	pci_read_config_dword (bdf, PCI_SATA_BASE4, &iobase4);
 | |
| 	pci_read_config_dword (bdf, PCI_SATA_BASE5, &iobase5);
 | |
| 
 | |
| 	if ((iobase1 == 0xFFFFFFFF) || (iobase2 == 0xFFFFFFFF) ||
 | |
| 	    (iobase3 == 0xFFFFFFFF) || (iobase4 == 0xFFFFFFFF) ||
 | |
| 	    (iobase5 == 0xFFFFFFFF)) {
 | |
| 		printf ("error no base addr for SATA controller\n");
 | |
| 		return 1;
 | |
| 	 /*ERROR*/}
 | |
| 
 | |
| 	iobase1 &= 0xFFFFFFFE;
 | |
| 	iobase2 &= 0xFFFFFFFE;
 | |
| 	iobase3 &= 0xFFFFFFFE;
 | |
| 	iobase4 &= 0xFFFFFFFE;
 | |
| 	iobase5 &= 0xFFFFFFFE;
 | |
| 
 | |
| 	/*check for mode */
 | |
| 	pci_read_config_byte (bdf, PCI_PMR, &pmr);
 | |
| 	if (pmr > 1) {
 | |
| 		printf ("combined mode not supported\n");
 | |
| 		return 1;
 | |
| 	}
 | |
| 
 | |
| 	pci_read_config_byte (bdf, PCI_PI, &pi);
 | |
| 	if ((pi & 0x05) != 0x05) {
 | |
| 		printf ("Sata is in Legacy mode\n");
 | |
| 		return 1;
 | |
| 	} else {
 | |
| 		printf ("sata is in Native mode\n");
 | |
| 	}
 | |
| 
 | |
| 	/*MASTER CFG AND IO CFG */
 | |
| 	pci_read_config_word (bdf, PCI_COMMAND, &cmd);
 | |
| 	cmd |= PCI_COMMAND_MASTER | PCI_COMMAND_IO;
 | |
| 	pci_write_config_word (bdf, PCI_COMMAND, cmd);
 | |
| 	pci_read_config_byte (dev, PCI_LATENCY_TIMER, &lat);
 | |
| 
 | |
| 	if (lat < 16)
 | |
| 		lat = (64 <= pcibios_max_latency) ? 64 : pcibios_max_latency;
 | |
| 	else if (lat > pcibios_max_latency)
 | |
| 		lat = pcibios_max_latency;
 | |
| 	pci_write_config_byte (dev, PCI_LATENCY_TIMER, lat);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int
 | |
| sata_bus_probe (int port_no)
 | |
| {
 | |
| 	int orig_mask, mask;
 | |
| 	u16 pcs;
 | |
| 
 | |
| 	mask = (PORT_PRESENT << port_no);
 | |
| 	pci_read_config_word (bdf, PCI_PCS, &pcs);
 | |
| 	orig_mask = (int) pcs & 0xff;
 | |
| 	if ((orig_mask & mask) != mask)
 | |
| 		return 0;
 | |
| 	else
 | |
| 		return 1;
 | |
| }
 | |
| 
 | |
| int
 | |
| init_sata (void)
 | |
| {
 | |
| 	u8 i, rv = 0;
 | |
| 
 | |
| 	for (i = 0; i < CFG_SATA_MAXDEVICES; i++) {
 | |
| 		sata_dev_desc[i].type = DEV_TYPE_UNKNOWN;
 | |
| 		sata_dev_desc[i].if_type = IF_TYPE_IDE;
 | |
| 		sata_dev_desc[i].dev = i;
 | |
| 		sata_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
 | |
| 		sata_dev_desc[i].blksz = 0;
 | |
| 		sata_dev_desc[i].lba = 0;
 | |
| 		sata_dev_desc[i].block_read = sata_read;
 | |
| 	}
 | |
| 
 | |
| 	rv = pci_sata_init ();
 | |
| 	if (rv == 1) {
 | |
| 		printf ("pci initialization failed\n");
 | |
| 		return 1;
 | |
| 	}
 | |
| 
 | |
| 	port[0].port_no = 0;
 | |
| 	port[0].ioaddr.cmd_addr = iobase1;
 | |
| 	port[0].ioaddr.altstatus_addr = port[0].ioaddr.ctl_addr =
 | |
| 	    iobase2 | ATA_PCI_CTL_OFS;
 | |
| 	port[0].ioaddr.bmdma_addr = iobase5;
 | |
| 
 | |
| 	port[1].port_no = 1;
 | |
| 	port[1].ioaddr.cmd_addr = iobase3;
 | |
| 	port[1].ioaddr.altstatus_addr = port[1].ioaddr.ctl_addr =
 | |
| 	    iobase4 | ATA_PCI_CTL_OFS;
 | |
| 	port[1].ioaddr.bmdma_addr = iobase5 + 0x8;
 | |
| 
 | |
| 	for (i = 0; i < CFG_SATA_MAXBUS; i++)
 | |
| 		sata_port (&port[i].ioaddr);
 | |
| 
 | |
| 	for (i = 0; i < CFG_SATA_MAXBUS; i++) {
 | |
| 		if (!(sata_bus_probe (i))) {
 | |
| 			port[i].port_state = 0;
 | |
| 			printf ("SATA#%d port is not present \n", i);
 | |
| 		} else {
 | |
| 			printf ("SATA#%d port is present\n", i);
 | |
| 			if (sata_bus_softreset (i)) {
 | |
| 				port[i].port_state = 0;
 | |
| 			} else {
 | |
| 				port[i].port_state = 1;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	for (i = 0; i < CFG_SATA_MAXBUS; i++) {
 | |
| 		u8 j, devno;
 | |
| 
 | |
| 		if (port[i].port_state == 0)
 | |
| 			continue;
 | |
| 		for (j = 0; j < CFG_SATA_DEVS_PER_BUS; j++) {
 | |
| 			sata_identify (i, j);
 | |
| 			set_Feature_cmd (i, j);
 | |
| 			devno = i * CFG_SATA_DEVS_PER_BUS + j;
 | |
| 			if ((sata_dev_desc[devno].lba > 0) &&
 | |
| 			    (sata_dev_desc[devno].blksz > 0)) {
 | |
| 				dev_print (&sata_dev_desc[devno]);
 | |
| 				/* initialize partition type */
 | |
| 				init_part (&sata_dev_desc[devno]);
 | |
| 				if (curr_dev < 0)
 | |
| 					curr_dev =
 | |
| 					    i * CFG_SATA_DEVS_PER_BUS + j;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| #endif
 |