2005-04-17 02:20:36 +04:00
/*
* Architecture specific parts of the Floppy driver
*
* This file is subject to the terms and conditions of the GNU General Public
* License . See the file " COPYING " in the main directory of this archive
* for more details .
*
* Copyright ( C ) 1995
*/
# ifdef __KERNEL__
# ifndef __ASM_PPC_FLOPPY_H
# define __ASM_PPC_FLOPPY_H
# define fd_inb(port) inb_p(port)
# define fd_outb(value,port) outb_p(value,port)
# define fd_disable_dma() fd_ops->_disable_dma(FLOPPY_DMA)
# define fd_free_dma() fd_ops->_free_dma(FLOPPY_DMA)
# define fd_get_dma_residue() fd_ops->_get_dma_residue(FLOPPY_DMA)
# define fd_dma_setup(addr, size, mode, io) fd_ops->_dma_setup(addr, size, mode, io)
# define fd_enable_irq() enable_irq(FLOPPY_IRQ)
# define fd_disable_irq() disable_irq(FLOPPY_IRQ)
# define fd_free_irq() free_irq(FLOPPY_IRQ, NULL);
static int fd_request_dma ( void ) ;
struct fd_dma_ops {
void ( * _disable_dma ) ( unsigned int dmanr ) ;
void ( * _free_dma ) ( unsigned int dmanr ) ;
int ( * _get_dma_residue ) ( unsigned int dummy ) ;
int ( * _dma_setup ) ( char * addr , unsigned long size , int mode , int io ) ;
} ;
static int virtual_dma_count ;
static int virtual_dma_residue ;
static char * virtual_dma_addr ;
static int virtual_dma_mode ;
static int doing_vdma ;
static struct fd_dma_ops * fd_ops ;
static irqreturn_t floppy_hardint ( int irq , void * dev_id , struct pt_regs * regs )
{
unsigned char st ;
int lcount ;
char * lptr ;
if ( ! doing_vdma )
return floppy_interrupt ( irq , dev_id , regs ) ;
st = 1 ;
for ( lcount = virtual_dma_count , lptr = virtual_dma_addr ;
lcount ; lcount - - , lptr + + ) {
st = inb ( virtual_dma_port + 4 ) & 0xa0 ;
if ( st ! = 0xa0 )
break ;
if ( virtual_dma_mode )
outb_p ( * lptr , virtual_dma_port + 5 ) ;
else
* lptr = inb_p ( virtual_dma_port + 5 ) ;
}
virtual_dma_count = lcount ;
virtual_dma_addr = lptr ;
st = inb ( virtual_dma_port + 4 ) ;
if ( st = = 0x20 )
return IRQ_HANDLED ;
if ( ! ( st & 0x20 ) ) {
virtual_dma_residue + = virtual_dma_count ;
virtual_dma_count = 0 ;
doing_vdma = 0 ;
floppy_interrupt ( irq , dev_id , regs ) ;
return IRQ_HANDLED ;
}
return IRQ_HANDLED ;
}
static void vdma_disable_dma ( unsigned int dummy )
{
doing_vdma = 0 ;
virtual_dma_residue + = virtual_dma_count ;
virtual_dma_count = 0 ;
}
static void vdma_nop ( unsigned int dummy )
{
}
static int vdma_get_dma_residue ( unsigned int dummy )
{
return virtual_dma_count + virtual_dma_residue ;
}
static int fd_request_irq ( void )
{
if ( can_use_virtual_dma )
2006-07-02 06:29:22 +04:00
return request_irq ( FLOPPY_IRQ , floppy_hardint ,
IRQF_DISABLED , " floppy " , NULL ) ;
2005-04-17 02:20:36 +04:00
else
2006-07-02 06:29:22 +04:00
return request_irq ( FLOPPY_IRQ , floppy_interrupt ,
IRQF_DISABLED , " floppy " , NULL ) ;
2005-04-17 02:20:36 +04:00
}
static int vdma_dma_setup ( char * addr , unsigned long size , int mode , int io )
{
doing_vdma = 1 ;
virtual_dma_port = io ;
virtual_dma_mode = ( mode = = DMA_MODE_WRITE ) ;
virtual_dma_addr = addr ;
virtual_dma_count = size ;
virtual_dma_residue = 0 ;
return 0 ;
}
static int hard_dma_setup ( char * addr , unsigned long size , int mode , int io )
{
/* actual, physical DMA */
doing_vdma = 0 ;
clear_dma_ff ( FLOPPY_DMA ) ;
set_dma_mode ( FLOPPY_DMA , mode ) ;
set_dma_addr ( FLOPPY_DMA , ( unsigned int ) virt_to_bus ( addr ) ) ;
set_dma_count ( FLOPPY_DMA , size ) ;
enable_dma ( FLOPPY_DMA ) ;
return 0 ;
}
static struct fd_dma_ops real_dma_ops =
{
. _disable_dma = disable_dma ,
. _free_dma = free_dma ,
. _get_dma_residue = get_dma_residue ,
. _dma_setup = hard_dma_setup
} ;
static struct fd_dma_ops virt_dma_ops =
{
. _disable_dma = vdma_disable_dma ,
. _free_dma = vdma_nop ,
. _get_dma_residue = vdma_get_dma_residue ,
. _dma_setup = vdma_dma_setup
} ;
static int fd_request_dma ( )
{
if ( can_use_virtual_dma & 1 ) {
fd_ops = & virt_dma_ops ;
return 0 ;
}
else {
fd_ops = & real_dma_ops ;
return request_dma ( FLOPPY_DMA , " floppy " ) ;
}
}
static int FDC1 = 0x3f0 ;
static int FDC2 = - 1 ;
/*
* Again , the CMOS information not available
*/
# define FLOPPY0_TYPE 6
# define FLOPPY1_TYPE 0
# define N_FDC 2 /* Don't change this! */
# define N_DRIVE 8
# define FLOPPY_MOTOR_MASK 0xf0
/*
* The PowerPC has no problems with floppy DMA crossing 64 k borders .
*/
# define CROSS_64KB(a,s) (0)
# endif /* __ASM_PPC_FLOPPY_H */
# define EXTRA_FLOPPY_PARAMS
# endif /* __KERNEL__ */