linux/drivers/ide/triflex.c
<<
>>
Prefs
   1/*
   2 * IDE Chipset driver for the Compaq TriFlex IDE controller.
   3 * 
   4 * Known to work with the Compaq Workstation 5x00 series.
   5 *
   6 * Copyright (C) 2002 Hewlett-Packard Development Group, L.P.
   7 * Author: Torben Mathiasen <torben.mathiasen@hp.com>
   8 *
   9 * This program is free software; you can redistribute it and/or modify
  10 * it under the terms of the GNU General Public License version 2 as
  11 * published by the Free Software Foundation.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License
  19 * along with this program; if not, write to the Free Software
  20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21 * 
  22 * Loosely based on the piix & svwks drivers.
  23 *
  24 * Documentation:
  25 *      Not publically available.
  26 */
  27
  28#include <linux/types.h>
  29#include <linux/module.h>
  30#include <linux/kernel.h>
  31#include <linux/pci.h>
  32#include <linux/ide.h>
  33#include <linux/init.h>
  34
  35#define DRV_NAME "triflex"
  36
  37static void triflex_set_mode(ide_drive_t *drive, const u8 speed)
  38{
  39        ide_hwif_t *hwif = drive->hwif;
  40        struct pci_dev *dev = to_pci_dev(hwif->dev);
  41        u32 triflex_timings = 0;
  42        u16 timing = 0;
  43        u8 channel_offset = hwif->channel ? 0x74 : 0x70, unit = drive->dn & 1;
  44
  45        pci_read_config_dword(dev, channel_offset, &triflex_timings);
  46
  47        switch(speed) {
  48                case XFER_MW_DMA_2:
  49                        timing = 0x0103; 
  50                        break;
  51                case XFER_MW_DMA_1:
  52                        timing = 0x0203;
  53                        break;
  54                case XFER_MW_DMA_0:
  55                        timing = 0x0808;
  56                        break;
  57                case XFER_SW_DMA_2:
  58                case XFER_SW_DMA_1:
  59                case XFER_SW_DMA_0:
  60                        timing = 0x0f0f;
  61                        break;
  62                case XFER_PIO_4:
  63                        timing = 0x0202;
  64                        break;
  65                case XFER_PIO_3:
  66                        timing = 0x0204;
  67                        break;
  68                case XFER_PIO_2:
  69                        timing = 0x0404;
  70                        break;
  71                case XFER_PIO_1:
  72                        timing = 0x0508;
  73                        break;
  74                case XFER_PIO_0:
  75                        timing = 0x0808;
  76                        break;
  77        }
  78
  79        triflex_timings &= ~(0xFFFF << (16 * unit));
  80        triflex_timings |= (timing << (16 * unit));
  81        
  82        pci_write_config_dword(dev, channel_offset, triflex_timings);
  83}
  84
  85static void triflex_set_pio_mode(ide_drive_t *drive, const u8 pio)
  86{
  87        triflex_set_mode(drive, XFER_PIO_0 + pio);
  88}
  89
  90static const struct ide_port_ops triflex_port_ops = {
  91        .set_pio_mode           = triflex_set_pio_mode,
  92        .set_dma_mode           = triflex_set_mode,
  93};
  94
  95static const struct ide_port_info triflex_device __devinitdata = {
  96        .name           = DRV_NAME,
  97        .enablebits     = {{0x80, 0x01, 0x01}, {0x80, 0x02, 0x02}},
  98        .port_ops       = &triflex_port_ops,
  99        .pio_mask       = ATA_PIO4,
 100        .swdma_mask     = ATA_SWDMA2,
 101        .mwdma_mask     = ATA_MWDMA2,
 102};
 103
 104static int __devinit triflex_init_one(struct pci_dev *dev, 
 105                const struct pci_device_id *id)
 106{
 107        return ide_pci_init_one(dev, &triflex_device, NULL);
 108}
 109
 110static const struct pci_device_id triflex_pci_tbl[] = {
 111        { PCI_VDEVICE(COMPAQ, PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE), 0 },
 112        { 0, },
 113};
 114MODULE_DEVICE_TABLE(pci, triflex_pci_tbl);
 115
 116static struct pci_driver triflex_pci_driver = {
 117        .name           = "TRIFLEX_IDE",
 118        .id_table       = triflex_pci_tbl,
 119        .probe          = triflex_init_one,
 120        .remove         = ide_pci_remove,
 121        .suspend        = ide_pci_suspend,
 122        .resume         = ide_pci_resume,
 123};
 124
 125static int __init triflex_ide_init(void)
 126{
 127        return ide_pci_register_driver(&triflex_pci_driver);
 128}
 129
 130static void __exit triflex_ide_exit(void)
 131{
 132        pci_unregister_driver(&triflex_pci_driver);
 133}
 134
 135module_init(triflex_ide_init);
 136module_exit(triflex_ide_exit);
 137
 138MODULE_AUTHOR("Torben Mathiasen");
 139MODULE_DESCRIPTION("PCI driver module for Compaq Triflex IDE");
 140MODULE_LICENSE("GPL");
 141
 142
 143
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.