2 * TX4938 internal IDE driver
3 * Based on tx4939ide.c.
5 * This file is subject to the terms and conditions of the GNU General Public
6 * License. See the file "COPYING" in the main directory of this archive
9 * (C) Copyright TOSHIBA CORPORATION 2005-2007
12 #include <linux/module.h>
13 #include <linux/types.h>
14 #include <linux/ide.h>
15 #include <linux/init.h>
16 #include <linux/platform_device.h>
20 #include <asm/txx9/tx4938.h>
22 static void tx4938ide_tune_ebusc(unsigned int ebus_ch
,
23 unsigned int gbus_clock
,
26 struct ide_timing
*t
= ide_timing_find_mode(XFER_PIO_0
+ pio
);
27 u64 cr
= __raw_readq(&tx4938_ebuscptr
->cr
[ebus_ch
]);
28 unsigned int sp
= (cr
>> 4) & 3;
29 unsigned int clock
= gbus_clock
/ (4 - sp
);
30 unsigned int cycle
= 1000000000 / clock
;
34 /* Minimum DIOx- active time */
35 wt
= DIV_ROUND_UP(t
->act8b
, cycle
) - 2;
36 /* IORDY setup time: 35ns */
37 wt
= max_t(int, wt
, DIV_ROUND_UP(35, cycle
));
38 /* actual wait-cycle is max(wt & ~1, 1) */
39 if (wt
> 2 && (wt
& 1))
42 /* Address-valid to DIOR/DIOW setup */
43 shwt
= DIV_ROUND_UP(t
->setup
, cycle
);
45 /* -DIOx recovery time (SHWT * 4) and cycle time requirement */
46 while ((shwt
* 4 + wt
+ (wt
? 2 : 3)) * cycle
< t
->cycle
)
49 pr_warning("tx4938ide: SHWT violation (%d)\n", shwt
);
52 pr_debug("tx4938ide: ebus %d, bus cycle %dns, WT %d, SHWT %d\n",
53 ebus_ch
, cycle
, wt
, shwt
);
55 __raw_writeq((cr
& ~0x3f007ull
) | (wt
<< 12) | shwt
,
56 &tx4938_ebuscptr
->cr
[ebus_ch
]);
59 static void tx4938ide_set_pio_mode(ide_drive_t
*drive
, const u8 pio
)
61 ide_hwif_t
*hwif
= drive
->hwif
;
62 struct tx4938ide_platform_info
*pdata
= hwif
->dev
->platform_data
;
66 pair
= ide_get_pair_dev(drive
);
68 safe
= min(safe
, ide_get_best_pio_mode(pair
, 255, 5));
69 tx4938ide_tune_ebusc(pdata
->ebus_ch
, pdata
->gbus_clock
, safe
);
74 /* custom iops (independent from SWAP_IO_SPACE) */
75 static u8
tx4938ide_inb(unsigned long port
)
77 return __raw_readb((void __iomem
*)port
);
80 static void tx4938ide_outb(u8 value
, unsigned long port
)
82 __raw_writeb(value
, (void __iomem
*)port
);
85 static void tx4938ide_tf_load(ide_drive_t
*drive
, struct ide_cmd
*cmd
)
87 ide_hwif_t
*hwif
= drive
->hwif
;
88 struct ide_io_ports
*io_ports
= &hwif
->io_ports
;
89 struct ide_taskfile
*tf
= &cmd
->tf
;
90 u8 HIHI
= cmd
->tf_flags
& IDE_TFLAG_LBA48
? 0xE0 : 0xEF;
92 if (cmd
->ftf_flags
& IDE_FTFLAG_FLAGGED
)
95 if (cmd
->ftf_flags
& IDE_FTFLAG_OUT_DATA
) {
96 u16 data
= (tf
->hob_data
<< 8) | tf
->data
;
99 __raw_writew(data
, (void __iomem
*)io_ports
->data_addr
);
102 if (cmd
->tf_flags
& IDE_TFLAG_OUT_HOB_FEATURE
)
103 tx4938ide_outb(tf
->hob_feature
, io_ports
->feature_addr
);
104 if (cmd
->tf_flags
& IDE_TFLAG_OUT_HOB_NSECT
)
105 tx4938ide_outb(tf
->hob_nsect
, io_ports
->nsect_addr
);
106 if (cmd
->tf_flags
& IDE_TFLAG_OUT_HOB_LBAL
)
107 tx4938ide_outb(tf
->hob_lbal
, io_ports
->lbal_addr
);
108 if (cmd
->tf_flags
& IDE_TFLAG_OUT_HOB_LBAM
)
109 tx4938ide_outb(tf
->hob_lbam
, io_ports
->lbam_addr
);
110 if (cmd
->tf_flags
& IDE_TFLAG_OUT_HOB_LBAH
)
111 tx4938ide_outb(tf
->hob_lbah
, io_ports
->lbah_addr
);
113 if (cmd
->tf_flags
& IDE_TFLAG_OUT_FEATURE
)
114 tx4938ide_outb(tf
->feature
, io_ports
->feature_addr
);
115 if (cmd
->tf_flags
& IDE_TFLAG_OUT_NSECT
)
116 tx4938ide_outb(tf
->nsect
, io_ports
->nsect_addr
);
117 if (cmd
->tf_flags
& IDE_TFLAG_OUT_LBAL
)
118 tx4938ide_outb(tf
->lbal
, io_ports
->lbal_addr
);
119 if (cmd
->tf_flags
& IDE_TFLAG_OUT_LBAM
)
120 tx4938ide_outb(tf
->lbam
, io_ports
->lbam_addr
);
121 if (cmd
->tf_flags
& IDE_TFLAG_OUT_LBAH
)
122 tx4938ide_outb(tf
->lbah
, io_ports
->lbah_addr
);
124 if (cmd
->tf_flags
& IDE_TFLAG_OUT_DEVICE
)
125 tx4938ide_outb((tf
->device
& HIHI
) | drive
->select
,
126 io_ports
->device_addr
);
129 static void tx4938ide_tf_read(ide_drive_t
*drive
, struct ide_cmd
*cmd
)
131 ide_hwif_t
*hwif
= drive
->hwif
;
132 struct ide_io_ports
*io_ports
= &hwif
->io_ports
;
133 struct ide_taskfile
*tf
= &cmd
->tf
;
135 if (cmd
->ftf_flags
& IDE_FTFLAG_IN_DATA
) {
139 data
= __raw_readw((void __iomem
*)io_ports
->data_addr
);
140 tf
->data
= data
& 0xff;
141 tf
->hob_data
= (data
>> 8) & 0xff;
144 /* be sure we're looking at the low order bits */
145 tx4938ide_outb(ATA_DEVCTL_OBS
, io_ports
->ctl_addr
);
147 if (cmd
->tf_flags
& IDE_TFLAG_IN_FEATURE
)
148 tf
->feature
= tx4938ide_inb(io_ports
->feature_addr
);
149 if (cmd
->tf_flags
& IDE_TFLAG_IN_NSECT
)
150 tf
->nsect
= tx4938ide_inb(io_ports
->nsect_addr
);
151 if (cmd
->tf_flags
& IDE_TFLAG_IN_LBAL
)
152 tf
->lbal
= tx4938ide_inb(io_ports
->lbal_addr
);
153 if (cmd
->tf_flags
& IDE_TFLAG_IN_LBAM
)
154 tf
->lbam
= tx4938ide_inb(io_ports
->lbam_addr
);
155 if (cmd
->tf_flags
& IDE_TFLAG_IN_LBAH
)
156 tf
->lbah
= tx4938ide_inb(io_ports
->lbah_addr
);
157 if (cmd
->tf_flags
& IDE_TFLAG_IN_DEVICE
)
158 tf
->device
= tx4938ide_inb(io_ports
->device_addr
);
160 if (cmd
->tf_flags
& IDE_TFLAG_LBA48
) {
161 tx4938ide_outb(ATA_HOB
| ATA_DEVCTL_OBS
, io_ports
->ctl_addr
);
163 if (cmd
->tf_flags
& IDE_TFLAG_IN_HOB_FEATURE
)
165 tx4938ide_inb(io_ports
->feature_addr
);
166 if (cmd
->tf_flags
& IDE_TFLAG_IN_HOB_NSECT
)
167 tf
->hob_nsect
= tx4938ide_inb(io_ports
->nsect_addr
);
168 if (cmd
->tf_flags
& IDE_TFLAG_IN_HOB_LBAL
)
169 tf
->hob_lbal
= tx4938ide_inb(io_ports
->lbal_addr
);
170 if (cmd
->tf_flags
& IDE_TFLAG_IN_HOB_LBAM
)
171 tf
->hob_lbam
= tx4938ide_inb(io_ports
->lbam_addr
);
172 if (cmd
->tf_flags
& IDE_TFLAG_IN_HOB_LBAH
)
173 tf
->hob_lbah
= tx4938ide_inb(io_ports
->lbah_addr
);
177 static void tx4938ide_input_data_swap(ide_drive_t
*drive
, struct ide_cmd
*cmd
,
178 void *buf
, unsigned int len
)
180 unsigned long port
= drive
->hwif
->io_ports
.data_addr
;
181 unsigned short *ptr
= buf
;
182 unsigned int count
= (len
+ 1) / 2;
185 *ptr
++ = cpu_to_le16(__raw_readw((void __iomem
*)port
));
186 __ide_flush_dcache_range((unsigned long)buf
, roundup(len
, 2));
189 static void tx4938ide_output_data_swap(ide_drive_t
*drive
, struct ide_cmd
*cmd
,
190 void *buf
, unsigned int len
)
192 unsigned long port
= drive
->hwif
->io_ports
.data_addr
;
193 unsigned short *ptr
= buf
;
194 unsigned int count
= (len
+ 1) / 2;
197 __raw_writew(le16_to_cpu(*ptr
), (void __iomem
*)port
);
200 __ide_flush_dcache_range((unsigned long)buf
, roundup(len
, 2));
203 static const struct ide_tp_ops tx4938ide_tp_ops
= {
204 .exec_command
= ide_exec_command
,
205 .read_status
= ide_read_status
,
206 .read_altstatus
= ide_read_altstatus
,
208 .set_irq
= ide_set_irq
,
210 .tf_load
= tx4938ide_tf_load
,
211 .tf_read
= tx4938ide_tf_read
,
213 .input_data
= tx4938ide_input_data_swap
,
214 .output_data
= tx4938ide_output_data_swap
,
217 #endif /* __BIG_ENDIAN */
219 static const struct ide_port_ops tx4938ide_port_ops
= {
220 .set_pio_mode
= tx4938ide_set_pio_mode
,
223 static const struct ide_port_info tx4938ide_port_info __initdata
= {
224 .port_ops
= &tx4938ide_port_ops
,
226 .tp_ops
= &tx4938ide_tp_ops
,
228 .host_flags
= IDE_HFLAG_MMIO
| IDE_HFLAG_NO_DMA
,
229 .pio_mask
= ATA_PIO5
,
230 .chipset
= ide_generic
,
233 static int __init
tx4938ide_probe(struct platform_device
*pdev
)
236 hw_regs_t
*hws
[] = { &hw
, NULL
, NULL
, NULL
};
237 struct ide_host
*host
;
238 struct resource
*res
;
239 struct tx4938ide_platform_info
*pdata
= pdev
->dev
.platform_data
;
241 unsigned long mapbase
, mapctl
;
242 struct ide_port_info d
= tx4938ide_port_info
;
244 irq
= platform_get_irq(pdev
, 0);
247 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
251 if (!devm_request_mem_region(&pdev
->dev
, res
->start
,
252 res
->end
- res
->start
+ 1, "tx4938ide"))
254 mapbase
= (unsigned long)devm_ioremap(&pdev
->dev
, res
->start
,
255 8 << pdata
->ioport_shift
);
256 mapctl
= (unsigned long)devm_ioremap(&pdev
->dev
,
257 res
->start
+ 0x10000 +
258 (6 << pdata
->ioport_shift
),
259 1 << pdata
->ioport_shift
);
260 if (!mapbase
|| !mapctl
)
263 memset(&hw
, 0, sizeof(hw
));
264 if (pdata
->ioport_shift
) {
265 unsigned long port
= mapbase
;
266 unsigned long ctl
= mapctl
;
268 hw
.io_ports_array
[0] = port
;
273 for (i
= 1; i
<= 7; i
++)
274 hw
.io_ports_array
[i
] =
275 port
+ (i
<< pdata
->ioport_shift
);
276 hw
.io_ports
.ctl_addr
= ctl
;
278 ide_std_init_ports(&hw
, mapbase
, mapctl
);
282 pr_info("TX4938 IDE interface (base %#lx, ctl %#lx, irq %d)\n",
283 mapbase
, mapctl
, hw
.irq
);
284 if (pdata
->gbus_clock
)
285 tx4938ide_tune_ebusc(pdata
->ebus_ch
, pdata
->gbus_clock
, 0);
288 ret
= ide_host_add(&d
, hws
, &host
);
290 platform_set_drvdata(pdev
, host
);
294 static int __exit
tx4938ide_remove(struct platform_device
*pdev
)
296 struct ide_host
*host
= platform_get_drvdata(pdev
);
298 ide_host_remove(host
);
302 static struct platform_driver tx4938ide_driver
= {
305 .owner
= THIS_MODULE
,
307 .remove
= __exit_p(tx4938ide_remove
),
310 static int __init
tx4938ide_init(void)
312 return platform_driver_probe(&tx4938ide_driver
, tx4938ide_probe
);
315 static void __exit
tx4938ide_exit(void)
317 platform_driver_unregister(&tx4938ide_driver
);
320 module_init(tx4938ide_init
);
321 module_exit(tx4938ide_exit
);
323 MODULE_DESCRIPTION("TX4938 internal IDE driver");
324 MODULE_LICENSE("GPL");
325 MODULE_ALIAS("platform:tx4938ide");