mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-16 00:34:20 +08:00
sparc64: Convert EBUS floppy support to pure OF driver.
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
aae7fb87ec
commit
3ae627a19e
@ -9,19 +9,11 @@
|
|||||||
#ifndef __ASM_SPARC64_FLOPPY_H
|
#ifndef __ASM_SPARC64_FLOPPY_H
|
||||||
#define __ASM_SPARC64_FLOPPY_H
|
#define __ASM_SPARC64_FLOPPY_H
|
||||||
|
|
||||||
#include <linux/init.h>
|
|
||||||
#include <linux/pci.h>
|
|
||||||
#include <linux/of.h>
|
#include <linux/of.h>
|
||||||
#include <linux/of_device.h>
|
#include <linux/of_device.h>
|
||||||
|
#include <linux/dma-mapping.h>
|
||||||
|
|
||||||
#include <asm/page.h>
|
|
||||||
#include <asm/pgtable.h>
|
|
||||||
#include <asm/system.h>
|
|
||||||
#include <asm/idprom.h>
|
|
||||||
#include <asm/oplib.h>
|
|
||||||
#include <asm/auxio.h>
|
#include <asm/auxio.h>
|
||||||
#include <asm/irq.h>
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Define this to enable exchanging drive 0 and 1 if only drive 1 is
|
* Define this to enable exchanging drive 0 and 1 if only drive 1 is
|
||||||
@ -292,13 +284,11 @@ static int sun_fd_eject(int drive)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_PCI
|
|
||||||
#include <asm/ebus.h>
|
|
||||||
#include <asm/ebus_dma.h>
|
#include <asm/ebus_dma.h>
|
||||||
#include <asm/ns87303.h>
|
#include <asm/ns87303.h>
|
||||||
|
|
||||||
static struct ebus_dma_info sun_pci_fd_ebus_dma;
|
static struct ebus_dma_info sun_pci_fd_ebus_dma;
|
||||||
static struct pci_dev *sun_pci_ebus_dev;
|
static struct device *sun_floppy_dev;
|
||||||
static int sun_pci_broken_drive = -1;
|
static int sun_pci_broken_drive = -1;
|
||||||
|
|
||||||
struct sun_pci_dma_op {
|
struct sun_pci_dma_op {
|
||||||
@ -379,7 +369,7 @@ static void sun_pci_fd_enable_dma(void)
|
|||||||
sun_pci_dma_pending.addr = -1U;
|
sun_pci_dma_pending.addr = -1U;
|
||||||
|
|
||||||
sun_pci_dma_current.addr =
|
sun_pci_dma_current.addr =
|
||||||
pci_map_single(sun_pci_ebus_dev,
|
dma_map_single(sun_floppy_dev,
|
||||||
sun_pci_dma_current.buf,
|
sun_pci_dma_current.buf,
|
||||||
sun_pci_dma_current.len,
|
sun_pci_dma_current.len,
|
||||||
sun_pci_dma_current.direction);
|
sun_pci_dma_current.direction);
|
||||||
@ -396,7 +386,7 @@ static void sun_pci_fd_disable_dma(void)
|
|||||||
{
|
{
|
||||||
ebus_dma_enable(&sun_pci_fd_ebus_dma, 0);
|
ebus_dma_enable(&sun_pci_fd_ebus_dma, 0);
|
||||||
if (sun_pci_dma_current.addr != -1U)
|
if (sun_pci_dma_current.addr != -1U)
|
||||||
pci_unmap_single(sun_pci_ebus_dev,
|
dma_unmap_single(sun_floppy_dev,
|
||||||
sun_pci_dma_current.addr,
|
sun_pci_dma_current.addr,
|
||||||
sun_pci_dma_current.len,
|
sun_pci_dma_current.len,
|
||||||
sun_pci_dma_current.direction);
|
sun_pci_dma_current.direction);
|
||||||
@ -406,9 +396,9 @@ static void sun_pci_fd_disable_dma(void)
|
|||||||
static void sun_pci_fd_set_dma_mode(int mode)
|
static void sun_pci_fd_set_dma_mode(int mode)
|
||||||
{
|
{
|
||||||
if (mode == DMA_MODE_WRITE)
|
if (mode == DMA_MODE_WRITE)
|
||||||
sun_pci_dma_pending.direction = PCI_DMA_TODEVICE;
|
sun_pci_dma_pending.direction = DMA_TO_DEVICE;
|
||||||
else
|
else
|
||||||
sun_pci_dma_pending.direction = PCI_DMA_FROMDEVICE;
|
sun_pci_dma_pending.direction = DMA_FROM_DEVICE;
|
||||||
|
|
||||||
ebus_dma_prepare(&sun_pci_fd_ebus_dma, mode != DMA_MODE_WRITE);
|
ebus_dma_prepare(&sun_pci_fd_ebus_dma, mode != DMA_MODE_WRITE);
|
||||||
}
|
}
|
||||||
@ -540,24 +530,19 @@ static int sun_pci_fd_test_drive(unsigned long port, int drive)
|
|||||||
#undef MSR
|
#undef MSR
|
||||||
#undef DOR
|
#undef DOR
|
||||||
|
|
||||||
#endif /* CONFIG_PCI */
|
static int __init ebus_fdthree_p(struct device_node *dp)
|
||||||
|
|
||||||
#ifdef CONFIG_PCI
|
|
||||||
static int __init ebus_fdthree_p(struct linux_ebus_device *edev)
|
|
||||||
{
|
{
|
||||||
if (!strcmp(edev->prom_node->name, "fdthree"))
|
if (!strcmp(dp->name, "fdthree"))
|
||||||
return 1;
|
return 1;
|
||||||
if (!strcmp(edev->prom_node->name, "floppy")) {
|
if (!strcmp(dp->name, "floppy")) {
|
||||||
const char *compat;
|
const char *compat;
|
||||||
|
|
||||||
compat = of_get_property(edev->prom_node,
|
compat = of_get_property(dp, "compatible", NULL);
|
||||||
"compatible", NULL);
|
|
||||||
if (compat && !strcmp(compat, "fdthree"))
|
if (compat && !strcmp(compat, "fdthree"))
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
|
|
||||||
static unsigned long __init sun_floppy_init(void)
|
static unsigned long __init sun_floppy_init(void)
|
||||||
{
|
{
|
||||||
@ -584,44 +569,45 @@ static unsigned long __init sun_floppy_init(void)
|
|||||||
floppy_op = op;
|
floppy_op = op;
|
||||||
FLOPPY_IRQ = op->irqs[0];
|
FLOPPY_IRQ = op->irqs[0];
|
||||||
} else {
|
} else {
|
||||||
#ifdef CONFIG_PCI
|
struct device_node *ebus_dp;
|
||||||
struct linux_ebus *ebus;
|
|
||||||
struct linux_ebus_device *edev = NULL;
|
|
||||||
unsigned long config = 0;
|
|
||||||
void __iomem *auxio_reg;
|
void __iomem *auxio_reg;
|
||||||
const char *state_prop;
|
const char *state_prop;
|
||||||
|
unsigned long config;
|
||||||
|
|
||||||
for_each_ebus(ebus) {
|
dp = NULL;
|
||||||
for_each_ebusdev(edev, ebus) {
|
for_each_node_by_name(ebus_dp, "ebus") {
|
||||||
if (ebus_fdthree_p(edev))
|
for (dp = ebus_dp->child; dp; dp = dp->sibling) {
|
||||||
goto ebus_done;
|
if (ebus_fdthree_p(dp))
|
||||||
|
goto found_fdthree;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
ebus_done:
|
found_fdthree:
|
||||||
if (!edev)
|
if (!dp)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
op = &edev->ofdev;
|
op = of_find_device_by_node(dp);
|
||||||
|
if (!op)
|
||||||
|
return 0;
|
||||||
|
|
||||||
state_prop = of_get_property(op->node, "status", NULL);
|
state_prop = of_get_property(op->node, "status", NULL);
|
||||||
if (state_prop && !strncmp(state_prop, "disabled", 8))
|
if (state_prop && !strncmp(state_prop, "disabled", 8))
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
FLOPPY_IRQ = edev->irqs[0];
|
FLOPPY_IRQ = op->irqs[0];
|
||||||
|
|
||||||
/* Make sure the high density bit is set, some systems
|
/* Make sure the high density bit is set, some systems
|
||||||
* (most notably Ultra5/Ultra10) come up with it clear.
|
* (most notably Ultra5/Ultra10) come up with it clear.
|
||||||
*/
|
*/
|
||||||
auxio_reg = (void __iomem *) edev->resource[2].start;
|
auxio_reg = (void __iomem *) op->resource[2].start;
|
||||||
writel(readl(auxio_reg)|0x2, auxio_reg);
|
writel(readl(auxio_reg)|0x2, auxio_reg);
|
||||||
|
|
||||||
sun_pci_ebus_dev = ebus->self;
|
sun_floppy_dev = &op->dev;
|
||||||
|
|
||||||
spin_lock_init(&sun_pci_fd_ebus_dma.lock);
|
spin_lock_init(&sun_pci_fd_ebus_dma.lock);
|
||||||
|
|
||||||
/* XXX ioremap */
|
/* XXX ioremap */
|
||||||
sun_pci_fd_ebus_dma.regs = (void __iomem *)
|
sun_pci_fd_ebus_dma.regs = (void __iomem *)
|
||||||
edev->resource[1].start;
|
op->resource[1].start;
|
||||||
if (!sun_pci_fd_ebus_dma.regs)
|
if (!sun_pci_fd_ebus_dma.regs)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
@ -635,7 +621,7 @@ static unsigned long __init sun_floppy_init(void)
|
|||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
/* XXX ioremap */
|
/* XXX ioremap */
|
||||||
sun_fdc = (struct sun_flpy_controller *)edev->resource[0].start;
|
sun_fdc = (struct sun_flpy_controller *) op->resource[0].start;
|
||||||
|
|
||||||
sun_fdops.fd_inb = sun_pci_fd_inb;
|
sun_fdops.fd_inb = sun_pci_fd_inb;
|
||||||
sun_fdops.fd_outb = sun_pci_fd_outb;
|
sun_fdops.fd_outb = sun_pci_fd_outb;
|
||||||
@ -672,12 +658,15 @@ static unsigned long __init sun_floppy_init(void)
|
|||||||
/*
|
/*
|
||||||
* Find NS87303 SuperIO config registers (through ecpp).
|
* Find NS87303 SuperIO config registers (through ecpp).
|
||||||
*/
|
*/
|
||||||
for_each_ebus(ebus) {
|
config = 0;
|
||||||
for_each_ebusdev(edev, ebus) {
|
for (dp = ebus_dp->child; dp; dp = dp->sibling) {
|
||||||
if (!strcmp(edev->prom_node->name, "ecpp")) {
|
if (!strcmp(dp->name, "ecpp")) {
|
||||||
config = edev->resource[1].start;
|
struct of_device *ecpp_op;
|
||||||
goto config_done;
|
|
||||||
}
|
ecpp_op = of_find_device_by_node(dp);
|
||||||
|
if (ecpp_op)
|
||||||
|
config = ecpp_op->resource[1].start;
|
||||||
|
goto config_done;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
config_done:
|
config_done:
|
||||||
@ -726,9 +715,6 @@ static unsigned long __init sun_floppy_init(void)
|
|||||||
#endif /* PCI_FDC_SWAP_DRIVES */
|
#endif /* PCI_FDC_SWAP_DRIVES */
|
||||||
|
|
||||||
return sun_floppy_types[0];
|
return sun_floppy_types[0];
|
||||||
#else
|
|
||||||
return 0;
|
|
||||||
#endif
|
|
||||||
}
|
}
|
||||||
prop = of_get_property(op->node, "status", NULL);
|
prop = of_get_property(op->node, "status", NULL);
|
||||||
if (prop && !strncmp(state, "disabled", 8))
|
if (prop && !strncmp(state, "disabled", 8))
|
||||||
|
Loading…
Reference in New Issue
Block a user