linux/drivers/ide/ide-h8300.c
<<
>>
Prefs
   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
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.