From: Evan Ko Date: Mon, 9 Feb 2009 21:02:35 +0000 (-0800) Subject: Staging: add phison ATA driver to the tree X-Git-Url: https://git.stricted.de/?a=commitdiff_plain;h=cfc2f947f849d75dfb1bff780dfee023c2e5a390;p=GitHub%2Fexynos8895%2Fandroid_kernel_samsung_universal8895.git 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 Signed-off-by: Greg Kroah-Hartman --- diff --git a/drivers/staging/phison/phison.c b/drivers/staging/phison/phison.c new file mode 100644 index 000000000000..571d03df8d65 --- /dev/null +++ b/drivers/staging/phison/phison.c @@ -0,0 +1,227 @@ +/* + * Copyright (C) 2006 Red Hat + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#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);