• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6/drivers/ide/
1/*
2 * H8/300 generic IDE interface
3 */
4
5#include <linux/init.h>
6#include <linux/ide.h>
7
8#include <asm/io.h>
9#include <asm/irq.h>
10
11#define DRV_NAME "ide-h8300"
12
13#define bswap(d) \
14({					\
15	u16 r;				\
16	__asm__("mov.b %w1,r1h\n\t"	\
17		"mov.b %x1,r1l\n\t"	\
18		"mov.w r1,%0"		\
19		:"=r"(r)		\
20		:"r"(d)			\
21		:"er1");		\
22	(r);				\
23})
24
25static void mm_outsw(unsigned long addr, void *buf, u32 len)
26{
27	unsigned short *bp = (unsigned short *)buf;
28	for (; len > 0; len--, bp++)
29		*(volatile u16 *)addr = bswap(*bp);
30}
31
32static void mm_insw(unsigned long addr, void *buf, u32 len)
33{
34	unsigned short *bp = (unsigned short *)buf;
35	for (; len > 0; len--, bp++)
36		*bp = bswap(*(volatile u16 *)addr);
37}
38
39static void h8300_input_data(ide_drive_t *drive, struct ide_cmd *cmd,
40			     void *buf, unsigned int len)
41{
42	mm_insw(drive->hwif->io_ports.data_addr, buf, (len + 1) / 2);
43}
44
45static void h8300_output_data(ide_drive_t *drive, struct ide_cmd *cmd,
46			      void *buf, unsigned int len)
47{
48	mm_outsw(drive->hwif->io_ports.data_addr, buf, (len + 1) / 2);
49}
50
51static const struct ide_tp_ops h8300_tp_ops = {
52	.exec_command		= ide_exec_command,
53	.read_status		= ide_read_status,
54	.read_altstatus		= ide_read_altstatus,
55	.write_devctl		= ide_write_devctl,
56
57	.dev_select		= ide_dev_select,
58	.tf_load		= ide_tf_load,
59	.tf_read		= ide_tf_read,
60
61	.input_data		= h8300_input_data,
62	.output_data		= h8300_output_data,
63};
64
65#define H8300_IDE_GAP (2)
66
67static inline void hw_setup(struct ide_hw *hw)
68{
69	int i;
70
71	memset(hw, 0, sizeof(*hw));
72	for (i = 0; i <= 7; i++)
73		hw->io_ports_array[i] = CONFIG_H8300_IDE_BASE + H8300_IDE_GAP*i;
74	hw->io_ports.ctl_addr = CONFIG_H8300_IDE_ALT;
75	hw->irq = EXT_IRQ0 + CONFIG_H8300_IDE_IRQ;
76}
77
78static const struct ide_port_info h8300_port_info = {
79	.tp_ops			= &h8300_tp_ops,
80	.host_flags		= IDE_HFLAG_NO_IO_32BIT | IDE_HFLAG_NO_DMA,
81	.chipset		= ide_generic,
82};
83
84static int __init h8300_ide_init(void)
85{
86	struct ide_hw hw, *hws[] = { &hw };
87
88	printk(KERN_INFO DRV_NAME ": H8/300 generic IDE interface\n");
89
90	if (!request_region(CONFIG_H8300_IDE_BASE, H8300_IDE_GAP*8, "ide-h8300"))
91		goto out_busy;
92	if (!request_region(CONFIG_H8300_IDE_ALT, H8300_IDE_GAP, "ide-h8300")) {
93		release_region(CONFIG_H8300_IDE_BASE, H8300_IDE_GAP*8);
94		goto out_busy;
95	}
96
97	hw_setup(&hw);
98
99	return ide_host_add(&h8300_port_info, hws, 1, NULL);
100
101out_busy:
102	printk(KERN_ERR "ide-h8300: IDE I/F resource already used.\n");
103
104	return -EBUSY;
105}
106
107module_init(h8300_ide_init);
108
109MODULE_LICENSE("GPL");
110