| ata-national.c (194893) | ata-national.c (200171) |
|---|---|
| 1/*- 2 * Copyright (c) 1998 - 2008 S�ren Schmidt <sos@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright --- 11 unchanged lines hidden (view full) --- 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> | 1/*- 2 * Copyright (c) 1998 - 2008 S�ren Schmidt <sos@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright --- 11 unchanged lines hidden (view full) --- 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> |
| 28__FBSDID("$FreeBSD: head/sys/dev/ata/chipsets/ata-national.c 194893 2009-06-24 19:49:18Z mav $"); | 28__FBSDID("$FreeBSD: head/sys/dev/ata/chipsets/ata-national.c 200171 2009-12-06 00:10:13Z mav $"); |
| 29 30#include "opt_ata.h" 31#include <sys/param.h> 32#include <sys/module.h> 33#include <sys/systm.h> 34#include <sys/kernel.h> 35#include <sys/ata.h> 36#include <sys/bus.h> --- 11 unchanged lines hidden (view full) --- 48#include <dev/pci/pcivar.h> 49#include <dev/pci/pcireg.h> 50#include <dev/ata/ata-all.h> 51#include <dev/ata/ata-pci.h> 52#include <ata_if.h> 53 54/* local prototypes */ 55static int ata_national_chipinit(device_t dev); | 29 30#include "opt_ata.h" 31#include <sys/param.h> 32#include <sys/module.h> 33#include <sys/systm.h> 34#include <sys/kernel.h> 35#include <sys/ata.h> 36#include <sys/bus.h> --- 11 unchanged lines hidden (view full) --- 48#include <dev/pci/pcivar.h> 49#include <dev/pci/pcireg.h> 50#include <dev/ata/ata-all.h> 51#include <dev/ata/ata-pci.h> 52#include <ata_if.h> 53 54/* local prototypes */ 55static int ata_national_chipinit(device_t dev); |
| 56static void ata_national_setmode(device_t dev, int mode); | 56static int ata_national_ch_attach(device_t dev); 57static int ata_national_setmode(device_t dev, int target, int mode); |
| 57 | 58 |
| 58 | |
| 59/* 60 * National chipset support functions 61 */ 62static int 63ata_national_probe(device_t dev) 64{ 65 struct ata_pci_controller *ctlr = device_get_softc(dev); 66 --- 9 unchanged lines hidden (view full) --- 76static int 77ata_national_chipinit(device_t dev) 78{ 79 struct ata_pci_controller *ctlr = device_get_softc(dev); 80 81 if (ata_setup_interrupt(dev, ata_generic_intr)) 82 return ENXIO; 83 | 59/* 60 * National chipset support functions 61 */ 62static int 63ata_national_probe(device_t dev) 64{ 65 struct ata_pci_controller *ctlr = device_get_softc(dev); 66 --- 9 unchanged lines hidden (view full) --- 76static int 77ata_national_chipinit(device_t dev) 78{ 79 struct ata_pci_controller *ctlr = device_get_softc(dev); 80 81 if (ata_setup_interrupt(dev, ata_generic_intr)) 82 return ENXIO; 83 |
| 84 ctlr->ch_attach = ata_national_ch_attach; |
|
| 84 ctlr->setmode = ata_national_setmode; 85 return 0; 86} 87 | 85 ctlr->setmode = ata_national_setmode; 86 return 0; 87} 88 |
| 88static void 89ata_national_setmode(device_t dev, int mode) | 89static int 90ata_national_ch_attach(device_t dev) |
| 90{ | 91{ |
| 91 device_t gparent = GRANDPARENT(dev); 92 struct ata_channel *ch = device_get_softc(device_get_parent(dev)); 93 struct ata_device *atadev = device_get_softc(dev); 94 int devno = (ch->unit << 1) + atadev->unit; 95 u_int32_t piotiming[] = 96 { 0x9172d132, 0x21717121, 0x00803020, 0x20102010, 0x00100010, 97 0x00803020, 0x20102010, 0x00100010, 98 0x00100010, 0x00100010, 0x00100010 }; 99 u_int32_t dmatiming[] = { 0x80077771, 0x80012121, 0x80002020 }; 100 u_int32_t udmatiming[] = { 0x80921250, 0x80911140, 0x80911030 }; 101 int error; | 92 struct ata_channel *ch = device_get_softc(dev); 93 int error; 94 95 error = ata_pci_ch_attach(dev); 96 ch->dma.alignment = 16; 97 ch->dma.max_iosize = 64 * DEV_BSIZE; 98 return (error); 99} |
| 102 | 100 |
| 103 ch->dma.alignment = 16; 104 ch->dma.max_iosize = 64 * DEV_BSIZE; | 101static int 102ata_national_setmode(device_t dev, int target, int mode) 103{ 104 device_t parent = device_get_parent(dev); 105 struct ata_channel *ch = device_get_softc(dev); 106 int devno = (ch->unit << 1) + target; 107 int piomode; 108 u_int32_t piotiming[] = 109 { 0x9172d132, 0x21717121, 0x00803020, 0x20102010, 0x00100010, 110 0x9172d132, 0x20102010, 0x00100010 }; 111 u_int32_t dmatiming[] = { 0x80077771, 0x80012121, 0x80002020 }; 112 u_int32_t udmatiming[] = { 0x80921250, 0x80911140, 0x80911030 }; |
| 105 | 113 |
| 106 mode = ata_limit_mode(dev, mode, ATA_UDMA2); | 114 mode = min(mode, ATA_UDMA2); |
| 107 | 115 |
| 108 error = ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode); 109 110 if (bootverbose) 111 device_printf(dev, "%s setting %s on National chip\n", 112 (error) ? "failed" : "success", ata_mode2str(mode)); 113 if (!error) { | |
| 114 if (mode >= ATA_UDMA0) { | 116 if (mode >= ATA_UDMA0) { |
| 115 pci_write_config(gparent, 0x44 + (devno << 3), | 117 pci_write_config(parent, 0x44 + (devno << 3), |
| 116 udmatiming[mode & ATA_MODE_MASK], 4); | 118 udmatiming[mode & ATA_MODE_MASK], 4); |
| 117 } 118 else if (mode >= ATA_WDMA0) { 119 pci_write_config(gparent, 0x44 + (devno << 3), | 119 piomode = ATA_PIO4; 120 } else if (mode >= ATA_WDMA0) { 121 pci_write_config(parent, 0x44 + (devno << 3), |
| 120 dmatiming[mode & ATA_MODE_MASK], 4); | 122 dmatiming[mode & ATA_MODE_MASK], 4); |
| 121 } 122 else { 123 pci_write_config(gparent, 0x44 + (devno << 3), 124 pci_read_config(gparent, 0x44 + (devno << 3), 4) | | 123 piomode = mode; 124 } else { 125 pci_write_config(parent, 0x44 + (devno << 3), 126 pci_read_config(parent, 0x44 + (devno << 3), 4) | |
| 125 0x80000000, 4); | 127 0x80000000, 4); |
| 128 piomode = mode; |
|
| 126 } | 129 } |
| 127 pci_write_config(gparent, 0x40 + (devno << 3), 128 piotiming[ata_mode2idx(mode)], 4); 129 atadev->mode = mode; 130 } | 130 pci_write_config(parent, 0x40 + (devno << 3), 131 piotiming[ata_mode2idx(piomode)], 4); 132 return (mode); |
| 131} 132 133ATA_DECLARE_DRIVER(ata_national); | 133} 134 135ATA_DECLARE_DRIVER(ata_national); |