Staging: add phison ATA driver to the tree
It doesn't build properly yet as it is against an older kernel version. That will be fixed up in patches following this. From: Evan Ko <evan_ko@phison.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Evan Ko
Greg Kroah-Hartman
parent
ecf4745166
commit
cfc2f947f8
|
|
@ -0,0 +1,227 @@
|
|||
/*
|
||||
* Copyright (C) 2006 Red Hat <evan_ko@phison.com>
|
||||
*
|
||||
* May be copied or modified under the terms of the GNU General Public License
|
||||
*
|
||||
* [Modify History]
|
||||
* #0001, Evan, 2008.10.22, V0.00, New release.
|
||||
* #0002, Evan, 2008.11.01, V0.90, Test Work In Ubuntu Linux 8.04.
|
||||
* #0003, Evan, 2008.01.08, V0.91, Change Name "PCIE-SSD" to "E-BOX".
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/pci.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/blkdev.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/device.h>
|
||||
#include <scsi/scsi_host.h>
|
||||
#include <linux/libata.h>
|
||||
#include <linux/ata.h>
|
||||
|
||||
#define PHISON_DEBUG
|
||||
|
||||
#define DRV_NAME "PHISON E-BOX" //#0003
|
||||
#define DRV_VERSION "0.91" //#0003
|
||||
|
||||
#define PCI_VENDOR_ID_PHISON 0x1987
|
||||
#define PCI_DEVICE_ID_PS5000 0x5000
|
||||
|
||||
int phison_pre_reset(struct ata_link *link, unsigned long deadline)
|
||||
{
|
||||
int ret;
|
||||
struct ata_port *ap = link->ap;
|
||||
ap->cbl = ATA_CBL_NONE;
|
||||
ret = ata_std_prereset(link, deadline);
|
||||
#ifdef PHISON_DEBUG
|
||||
printk("****** phison_pre_reset(), ret = %x ******\n", ret);
|
||||
#endif
|
||||
return ret;
|
||||
}
|
||||
|
||||
void phison_error_handler(struct ata_port *ap)
|
||||
{
|
||||
#ifdef PHISON_DEBUG
|
||||
printk("****** phison_error_handler() ******\n");
|
||||
#endif
|
||||
return ata_bmdma_drive_eh(ap, phison_pre_reset, ata_std_softreset, NULL, ata_std_postreset);
|
||||
}
|
||||
|
||||
struct scsi_host_template phison_sht = {
|
||||
.module = THIS_MODULE,
|
||||
.name = DRV_NAME,
|
||||
.ioctl = ata_scsi_ioctl,
|
||||
.queuecommand = ata_scsi_queuecmd,
|
||||
.can_queue = ATA_DEF_QUEUE,
|
||||
.this_id = ATA_SHT_THIS_ID,
|
||||
.sg_tablesize = LIBATA_MAX_PRD,
|
||||
.cmd_per_lun = ATA_SHT_CMD_PER_LUN,
|
||||
.emulated = ATA_SHT_EMULATED,
|
||||
.use_clustering = ATA_SHT_USE_CLUSTERING,
|
||||
.proc_name = DRV_NAME,
|
||||
.dma_boundary = ATA_DMA_BOUNDARY,
|
||||
.slave_configure = ata_scsi_slave_config,
|
||||
.slave_destroy = ata_scsi_slave_destroy,
|
||||
/* Use standard CHS mapping rules */
|
||||
.bios_param = ata_std_bios_param,
|
||||
};
|
||||
|
||||
const struct ata_port_operations phison_ops = {
|
||||
/* Task file is PCI ATA format, use helpers */
|
||||
.tf_load = ata_tf_load,
|
||||
.tf_read = ata_tf_read,
|
||||
.check_status = ata_check_status,
|
||||
.exec_command = ata_exec_command,
|
||||
.dev_select = ata_std_dev_select,
|
||||
|
||||
.freeze = ata_bmdma_freeze,
|
||||
.thaw = ata_bmdma_thaw,
|
||||
.error_handler = phison_error_handler,
|
||||
.post_internal_cmd = ata_bmdma_post_internal_cmd,
|
||||
|
||||
/* BMDMA handling is PCI ATA format, use helpers */
|
||||
.bmdma_setup = ata_bmdma_setup,
|
||||
.bmdma_start = ata_bmdma_start,
|
||||
.bmdma_stop = ata_bmdma_stop,
|
||||
.bmdma_status = ata_bmdma_status,
|
||||
.qc_prep = ata_qc_prep,
|
||||
.qc_issue = ata_qc_issue_prot,
|
||||
.data_xfer = ata_data_xfer,
|
||||
|
||||
/* IRQ-related hooks */
|
||||
.irq_handler = ata_interrupt,
|
||||
.irq_clear = ata_bmdma_irq_clear,
|
||||
.irq_on = ata_irq_on,
|
||||
|
||||
/* Generic PATA PCI ATA helpers */
|
||||
.port_start = ata_port_start,
|
||||
};
|
||||
|
||||
int phison_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
|
||||
{
|
||||
struct ata_port_info info = {
|
||||
.sht = &phison_sht,
|
||||
.flags = ATA_FLAG_NO_ATAPI,
|
||||
|
||||
.pio_mask = 0x1f,
|
||||
.mwdma_mask = 0x07,
|
||||
.udma_mask = ATA_UDMA5,
|
||||
|
||||
.port_ops = &phison_ops,
|
||||
};
|
||||
int ret;
|
||||
|
||||
const struct ata_port_info *ppi[] = { &info, NULL };
|
||||
|
||||
ret = ata_pci_init_one(pdev, ppi);
|
||||
|
||||
#ifdef PHISON_DEBUG
|
||||
printk("****** phison_init_one(), ret = %x ******\n", ret);
|
||||
#endif
|
||||
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
struct pci_device_id phison_pci_tbl[] = {
|
||||
{ PCI_VENDOR_ID_PHISON, PCI_DEVICE_ID_PS5000, PCI_ANY_ID, PCI_ANY_ID,
|
||||
PCI_CLASS_STORAGE_IDE << 8, 0xffff00, 0 },
|
||||
{ 0, },
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(pci, phison_pci_tbl);
|
||||
|
||||
struct pci_driver phison_pci_driver = {
|
||||
.name = DRV_NAME,
|
||||
.id_table = phison_pci_tbl,
|
||||
.probe = phison_init_one,
|
||||
.remove = ata_pci_remove_one,
|
||||
#ifdef CONFIG_PM //haven't test it.
|
||||
.suspend = ata_pci_device_suspend,
|
||||
.resume = ata_pci_device_resume,
|
||||
#endif
|
||||
};
|
||||
|
||||
int phison_ide_init(void)
|
||||
{
|
||||
#if 0 //For Test.
|
||||
struct pci_dev *pci_dev = NULL;
|
||||
struct pci_dev *ps5k_dev = NULL;
|
||||
int i, ret;
|
||||
u16 vid, pid;
|
||||
u32 addr1,addr2,addr3, addr4,addr5,addr6;
|
||||
|
||||
printk("****** phison_ide_init ******\n");
|
||||
|
||||
i = 0;
|
||||
|
||||
while(1)
|
||||
{
|
||||
pci_dev = pci_find_device(PCI_ANY_ID,PCI_ANY_ID, pci_dev);
|
||||
|
||||
if(pci_dev!=NULL)
|
||||
{
|
||||
pci_read_config_word(pci_dev, 0, &pid);
|
||||
pci_read_config_word(pci_dev, 2, &vid);
|
||||
pci_read_config_dword(pci_dev, 16, &addr1);
|
||||
pci_read_config_dword(pci_dev, 16, &addr1);
|
||||
pci_read_config_dword(pci_dev, 16, &addr1);
|
||||
pci_read_config_dword(pci_dev, 16, &addr1);
|
||||
pci_read_config_dword(pci_dev, 20, &addr2);
|
||||
pci_read_config_dword(pci_dev, 24, &addr3);
|
||||
pci_read_config_dword(pci_dev, 28, &addr4);
|
||||
pci_read_config_dword(pci_dev, 32, &addr5);
|
||||
pci_read_config_dword(pci_dev, 36, &addr6);
|
||||
|
||||
printk("****** <0x%02x>, %x, %x, %x,%x,%x,%x,%x,%x ******\n", i, pid, vid, addr1, addr2, addr3, addr4,addr5,addr6);
|
||||
i++;
|
||||
|
||||
if((pid==PCI_VENDOR_ID_PHISON)&&(vid==PCI_DEVICE_ID_PS5000)) ps5k_dev = pci_dev;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(i==0) printk("****** no pci device found ******\n");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if(ps5k_dev!=NULL)
|
||||
{
|
||||
ret = pci_register_driver(&phison_pci_driver);
|
||||
printk("****** PS5000 found, Ret = %x ******\n", ret);
|
||||
return true;
|
||||
}
|
||||
|
||||
printk("****** PS5000 not found ******\n");
|
||||
return false;
|
||||
#else
|
||||
int ret;
|
||||
|
||||
ret = pci_register_driver(&phison_pci_driver);
|
||||
|
||||
#ifdef PHISON_DEBUG
|
||||
printk("****** phison_ide_init(), ret = %x ******\n", ret);
|
||||
#endif
|
||||
|
||||
return ret;
|
||||
#endif
|
||||
|
||||
|
||||
}
|
||||
|
||||
void phison_ide_exit(void)
|
||||
{
|
||||
#ifdef PHISON_DEBUG
|
||||
printk("****** phison_ide_exit() ******\n");
|
||||
#endif
|
||||
pci_unregister_driver(&phison_pci_driver);
|
||||
}
|
||||
|
||||
module_init(phison_ide_init);
|
||||
module_exit(phison_ide_exit);
|
||||
|
||||
MODULE_AUTHOR("Evan Ko");
|
||||
MODULE_DESCRIPTION("PCIE driver module for PHISON PS5000 E-BOX");//#0003
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_VERSION(DRV_VERSION);
|
||||
Loading…
Reference in New Issue