1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
|
/* Driver for MagicBox 2.0 onboard CompactFlash adapter.
* Written by Wojtek Kaniewski <wojtekka@toxygen.net>
*
* GNU General Public License.
*/
#include <linux/version.h>
#include <linux/types.h>
#include <linux/mm.h>
#include <linux/interrupt.h>
#include <linux/blkdev.h>
#include <linux/hdreg.h>
#include <linux/ide.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#define UIC0_PR 0xc4
#define UIC0_TR 0xc5
#define IRQ 25
static int ide_offsets[IDE_NR_PORTS] = {0, 2, 4, 6, 8, 10, 12, 14, -1, -1};
static u8 magicbox_ide_inb (unsigned long port)
{
return (u8) (readw((void __iomem *) port) >> 8) & 255;
}
static u16 magicbox_ide_inw (unsigned long port)
{
return (u16) readw((void __iomem *) port);
}
static void magicbox_ide_insw (unsigned long port, void *addr, u32 count)
{
u16 *ptr;
for (ptr = addr; count--; ptr++)
*ptr = readw((void __iomem *) port);
}
static u32 magicbox_ide_inl (unsigned long port)
{
return (u32) readl((void __iomem *) port);
}
static void magicbox_ide_insl (unsigned long port, void *addr, u32 count)
{
u32 *ptr;
for (ptr = addr; count--; ptr++)
*ptr = readl((void __iomem *) port);
}
static void magicbox_ide_outb (u8 value, unsigned long port)
{
writew(value << 8, (void __iomem *) port);
}
static void magicbox_ide_outbsync (ide_drive_t *drive, u8 value, unsigned long port)
{
writew(value << 8, (void __iomem *) port);
}
static void magicbox_ide_outw (u16 value, unsigned long port)
{
writew(value, (void __iomem *) port);
}
static void magicbox_ide_outsw (unsigned long port, void *addr, u32 count)
{
u16 *ptr;
for (ptr = addr; count--; ptr++)
writew(*ptr, (void __iomem *) port);
}
static void magicbox_ide_outl (u32 value, unsigned long port)
{
writel(value, (void __iomem *) port);
}
static void magicbox_ide_outsl (unsigned long port, void *addr, u32 count)
{
u32 *ptr;
for (ptr = addr; count--; ptr++)
writel(*ptr, (void __iomem *) port);
}
static void __init ide_magicbox_register(unsigned long addr,
unsigned long caddr, int irq)
{
hw_regs_t hw;
ide_hwif_t *hwif;
memset(&hw, 0, sizeof(hw));
ide_setup_ports(&hw, addr, ide_offsets, caddr + 12, 0, NULL,irq);
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)
if (ide_register_hw(&hw, &hwif) != -1)
#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)
if (ide_register_hw(&hw, 1, &hwif) != -1)
#else
if (ide_register_hw(&hw, NULL, 1, &hwif) != -1)
#endif
{
printk(KERN_NOTICE "magicbox-ide: Registered IDE-CF driver\n");
hwif->mmio = 2;
hwif->drives[0].unmask = 1;
hwif->OUTB = magicbox_ide_outb;
hwif->OUTBSYNC = magicbox_ide_outbsync;
hwif->OUTW = magicbox_ide_outw;
hwif->OUTSW = magicbox_ide_outsw;
hwif->OUTSL = magicbox_ide_outsl;
hwif->INB = magicbox_ide_inb;
hwif->INW = magicbox_ide_inw;
hwif->INSW = magicbox_ide_insw;
hwif->INSL = magicbox_ide_insl;
}
}
void __init ide_magicbox_init(void)
{
volatile u16 *addr;
volatile u16 *caddr;
/* Turn on PerWE instead of PCIsomething */
mtdcr(DCRN_CPC0_PCI_BASE, mfdcr(DCRN_CPC0_PCI_BASE) | (0x80000000L >> 27));
/* PerCS1 (CF's CS0): base 0xff100000, 16-bit, rw */
mtdcr(DCRN_EBC_BASE, 1);
mtdcr(DCRN_EBC_BASE + 1, 0xff11a000);
mtdcr(DCRN_EBC_BASE, 0x11);
mtdcr(DCRN_EBC_BASE + 1, 0x080bd800);
/* PerCS2 (CF's CS1): base 0xff200000, 16-bit, rw */
mtdcr(DCRN_EBC_BASE, 2);
mtdcr(DCRN_EBC_BASE + 1, 0xff21a000);
mtdcr(DCRN_EBC_BASE, 0x12);
mtdcr(DCRN_EBC_BASE + 1, 0x080bd800);
/* Remap physical address space */
addr = ioremap_nocache(0xff100000, 4096);
caddr = ioremap_nocache(0xff200000, 4096);
/* Set interrupt to low-to-high-edge-triggered */
mtdcr(UIC0_TR, mfdcr(UIC0_TR) & ~(0x80000000L >> IRQ));
mtdcr(UIC0_PR, mfdcr(UIC0_PR) | (0x80000000L >> IRQ));
ide_magicbox_register((unsigned long)addr, (unsigned long)caddr, IRQ);
}
|
