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
 |