arch/mips/jazz/floppy-jazz.c

   1 /* $Id: floppy-jazz.c,v 1.1 1998/05/07 18:38:29 ralf Exp $
   2  *
   3  * This file is subject to the terms and conditions of the GNU General Public
   4  * License.  See the file "COPYING" in the main directory of this archive
   5  * for more details.
   6  *
   7  * Low-level floppy stuff for Jazz family machines.
   8  *
   9  * Copyright (C) 1998 by Ralf Baechle
  10  */
  11 #include <linux/delay.h>
  12 #include <linux/init.h>
  13 #include <linux/linkage.h>
  14 #include <linux/types.h>
  15 #include <linux/mm.h>
  16 #include <asm/addrspace.h>
  17 #include <asm/jazz.h>
  18 #include <asm/jazzdma.h>
  19 #include <asm/keyboard.h>
  20 #include <asm/pgtable.h>
  21 #include <asm/floppy.h>
  22
  23 static unsigned char jazz_fd_inb(unsigned int port)
  24 {
  25         unsigned char c;
  26
  27         c = *(volatile unsigned char *) port;
  28         udelay(1);
  29
  30         return c;
  31 }
  32
  33 static void jazz_fd_outb(unsigned char value, unsigned int port)
  34 {
  35         *(volatile unsigned char *) port = value;
  36 }
  37
  38 /*
  39  * How to access the floppy DMA functions.
  40  */
  41 static void jazz_fd_enable_dma(int channel)
  42 {
  43         vdma_enable(JAZZ_FLOPPY_DMA);
  44 }
  45
  46 static void jazz_fd_disable_dma(int channel)
  47 {
  48         vdma_disable(JAZZ_FLOPPY_DMA);
  49 }
  50
  51 static int jazz_fd_request_dma(int channel)
  52 {
  53         return 0;
  54 }
  55
  56 static void jazz_fd_free_dma(int channel)
  57 {
  58 }
  59
  60 static void jazz_fd_clear_dma_ff(int channel)
  61 {
  62 }
  63
  64 static void jazz_fd_set_dma_mode(int channel, char mode)
  65 {
  66         vdma_set_mode(JAZZ_FLOPPY_DMA, mode);
  67 }
  68
  69 static void jazz_fd_set_dma_addr(int channel, unsigned int a)
  70 {
  71         vdma_set_addr(JAZZ_FLOPPY_DMA, vdma_phys2log(PHYSADDR(a)));
  72 }
  73
  74 static void jazz_fd_set_dma_count(int channel, unsigned int count)
  75 {
  76         vdma_set_count(JAZZ_FLOPPY_DMA, count);
  77 }
  78
  79 static int jazz_fd_get_dma_residue(int channel)
  80 {
  81         return vdma_get_residue(JAZZ_FLOPPY_DMA);
  82 }
  83
  84 static void jazz_fd_enable_irq(int irq)
  85 {
  86 }
  87
  88 static void jazz_fd_disable_irq(int irq)
  89 {
  90 }
  91
  92 static unsigned long jazz_fd_getfdaddr1(void)
  93 {
  94         return JAZZ_FDC_BASE;
  95 }
  96
  97 /* Pure 2^n version of get_order */
  98 extern inline int __get_order(unsigned long size)
  99 {
 100         int order;
 101
 102         size = (size-1) >> (PAGE_SHIFT-1);
 103         order = -1;
 104         do {
 105                 size >>= 1;
 106                 order++;
 107         } while (size);
 108         return order;
 109 }
 110
 111 static unsigned long jazz_fd_dma_mem_alloc(unsigned long size)
 112 {
 113         int order = __get_order(size);
 114         unsigned long mem;
 115
 116         mem = __get_dma_pages(GFP_KERNEL, order);
 117         if(!mem)
 118                 return 0;
 119         vdma_alloc(PHYSADDR(mem), size);        /* XXX error checking */
 120
 121         return mem;
 122 }
 123
 124 static void jazz_fd_dma_mem_free(unsigned long addr,
 125                                         unsigned long size)
 126 {
 127         vdma_free(vdma_phys2log(PHYSADDR(addr)));
 128         free_pages(addr, __get_order(size));
 129 }
 130
 131 static unsigned long jazz_fd_drive_type(unsigned long n)
 132 {
 133         /* XXX This is wrong for machines with ED 2.88mb disk drives like the
 134            Olivetti M700.  Anyway, we should suck this from the ARC
 135            firmware.  */
 136         if (n == 0)
 137                 return 4;       /* 3,5", 1.44mb */
 138
 139         return 0;
 140 }
 141
 142 struct fd_ops jazz_fd_ops = {
 143         /*
 144          * How to access the floppy controller's ports
 145          */
 146         jazz_fd_inb,
 147         jazz_fd_outb,
 148         /*
 149          * How to access the floppy DMA functions.
 150          */
 151         jazz_fd_enable_dma,
 152         jazz_fd_disable_dma,
 153         jazz_fd_request_dma,
 154         jazz_fd_free_dma,
 155         jazz_fd_clear_dma_ff,
 156         jazz_fd_set_dma_mode,
 157         jazz_fd_set_dma_addr,
 158         jazz_fd_set_dma_count,
 159         jazz_fd_get_dma_residue,
 160         jazz_fd_enable_irq,
 161         jazz_fd_disable_irq,
 162         jazz_fd_getfdaddr1,
 163         jazz_fd_dma_mem_alloc,
 164         jazz_fd_dma_mem_free,
 165         jazz_fd_drive_type
 166 };