lp_intern.c

powerpc内核mpc8241linux系统下char驱动程序

/*
 * split into mid and low-level for better support of different hardware
 * by Joerg Dorchain ([e-mail])
 *
 * Amiga printer device by Michael Rausch ([e-mail]);
 * Atari support added by Andreas Schwab ([e-mail]);
 * based upon work from
 *
 * Copyright (C) 1992 by Jim Weigand and Linus Torvalds
 * Copyright (C) 1992,1993 by Michael K. Johnson
 * - Thanks much to Gunter Windau for pointing out to me where the error
 *   checking ought to be.
 * Copyright (C) 1993 by Nigel Gamble (added interrupt code)
 */

#include <linux/module.h>
#include <linux/config.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <asm/irq.h>
#include <asm/setup.h>
#ifdef CONFIG_AMIGA
#include <asm/amigahw.h>
#include <asm/amigaints.h>
#endif
#ifdef CONFIG_ATARI
#include <linux/delay.h>
#include <linux/sched.h>
#include <asm/atarihw.h>
#include <asm/atariints.h>
#endif
#ifdef CONFIG_MVME16x
#include <asm/mvme16xhw.h>
#endif
#ifdef CONFIG_BVME6000
#include<asm/bvme6000hw.h>
#endif
#include <linux/lp_intern.h>

static int minor = -1;
MODULE_PARM(minor,"i");

static void lp_int_out(int, int);
static int lp_int_busy(int);
static int lp_int_pout(int);
static int lp_int_online(int);


static void
lp_int_out (int c, int dev)
{
  switch (m68k_machtype)
    {
#ifdef CONFIG_AMIGA
    case MACH_AMIGA:
       {
	int wait = 0;
	while (wait != lp_table[dev]->wait) wait++;
	ciaa.prb = c;
       }
      break;
#endif
#ifdef CONFIG_ATARI
    case MACH_ATARI:
       {
	 int wait = 0;
	 sound_ym.rd_data_reg_sel = 15;
	 sound_ym.wd_data = c;
	 sound_ym.rd_data_reg_sel = 14;
	 while (wait != lp_table[dev]->wait) wait++;
	 sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~(1 << 5);
	 while (wait) wait--;
	 sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5);
	 break;
       }
#endif
#ifdef CONFIG_MVME16x
    case MACH_MVME16x:
      {
	int wait = 0;
	while (wait != lp_table[dev]->wait) wait++;
        mvmelp.data = c;
        break;
      }
#endif
#ifdef CONFIG_BVME6000
    case MACH_BVME6000:
      {
	int wait = 0;
	while (wait != lp_table[dev]->wait) wait++;
        bvmepit.padr = c;
        bvmepit.pacr |= 0x02;
        break;
      }
#endif
    }
}

static int
lp_int_busy (int dev)
{
  switch (m68k_machtype)
    {
#ifdef CONFIG_AMIGA
    case MACH_AMIGA:
      return ciab.pra & 1;
#endif
#ifdef CONFIG_ATARI
    case MACH_ATARI:
      return mfp.par_dt_reg & 1;
#endif
#ifdef CONFIG_MVME16x
    case MACH_MVME16x:
      return mvmelp.isr & 1;
#endif
#ifdef CONFIG_BVME6000
    case MACH_BVME6000:
      return 0 /* !(bvmepit.psr & 0x40) */ ;
#endif
    default:
      return 0;
    }
}

static int
lp_int_pout (int dev)
{
  switch (m68k_machtype)
    {
#ifdef CONFIG_AMIGA
    case MACH_AMIGA:
      return ciab.pra & 2;
#endif
#ifdef CONFIG_ATARI
    case MACH_ATARI:
      return 0;
#endif
#ifdef CONFIG_MVME16x
    case MACH_MVME16x:
      return mvmelp.isr & 2;
#endif
#ifdef CONFIG_BVME6000
    case MACH_BVME6000:
      return 0;
#endif
    default:
      return 0;
    }
}

static int
lp_int_online (int dev)
{
  switch (m68k_machtype)
    {
#ifdef CONFIG_AMIGA
    case MACH_AMIGA:
      return ciab.pra & 4;
#endif
#ifdef CONFIG_ATARI
    case MACH_ATARI:
      return !(mfp.par_dt_reg & 1);
#endif
#ifdef CONFIG_MVME16x
    case MACH_MVME16x:
      return mvmelp.isr & 4;
#endif
#ifdef CONFIG_BVME6000
    case MACH_BVME6000:
      return 1;
#endif
    default:
      return 0;
    }
}

static void lp_int_interrupt(int irq, void *data, struct pt_regs *fp)
{
#ifdef CONFIG_MVME16x
  if (MACH_IS_MVME16x)
    mvmelp.ack_icr |= 0x08;
#endif
#ifdef CONFIG_BVME6000
  if (MACH_IS_BVME6000)
    bvmepit.pacr &= ~0x02;
#endif
  lp_interrupt(minor);
}

static int lp_int_open(int dev)
{
  MOD_INC_USE_COUNT;
  return 0;
}

static void lp_int_release(int dev)
{
  MOD_DEC_USE_COUNT;
}

static struct lp_struct tab = {
	"Builtin parallel port",	/* name */
	0,				/* irq */
	lp_int_out,
	lp_int_busy,
	lp_int_pout,
	lp_int_online,
	0,
	NULL,				/* ioctl */
	lp_int_open,
	lp_int_release,
	LP_EXIST,
	LP_INIT_CHAR,
	LP_INIT_TIME,
	LP_INIT_WAIT,
	NULL,
	NULL,
};

__initfunc(int lp_internal_init(void))
{
#ifdef CONFIG_AMIGA
  if (MACH_IS_AMIGA && AMIGAHW_PRESENT(AMI_PARALLEL))
    {
      ciaa.ddrb = 0xff;
      ciab.ddra &= 0xf8;
      if (lp_irq)
        tab.irq = request_irq(IRQ_AMIGA_CIAA_FLG, lp_int_interrupt,
          0, "builtin printer port", lp_int_interrupt);
      tab.base = (void *) &ciaa.prb; /* dummy, not used */
      tab.type = LP_AMIGA;
    }
#endif
#ifdef CONFIG_ATARI
  if (MACH_IS_ATARI)
    {
      unsigned long flags;

      save_flags(flags);
      cli();
      sound_ym.rd_data_reg_sel = 7;
      sound_ym.wd_data = (sound_ym.rd_data_reg_sel & 0x3f) | 0xc0;
      restore_flags(flags);
      if (lp_irq)
        tab.irq = request_irq(IRQ_MFP_BUSY, lp_int_interrupt,
          IRQ_TYPE_SLOW, "builtin printer port", lp_int_interrupt);
      tab.base = (void *) &sound_ym.wd_data; /* dummy, not used */
      tab.type = LP_ATARI;
    }
#endif
#ifdef CONFIG_MAC
    if (MACH_IS_MAC)
    	return -ENODEV;
#endif
#ifdef CONFIG_MVME16x
    if (MACH_IS_MVME16x)
    {
      unsigned long flags;

      if (!(mvme16x_config & MVME16x_CONFIG_GOT_LP))
        return -ENODEV;

      save_flags(flags);
      cli();
      mvmelp.ack_icr = 0x08;
      mvmelp.flt_icr = 0x08;
      mvmelp.sel_icr = 0x08;
      mvmelp.pe_icr =  0x08;
      mvmelp.bsy_icr = 0x08;
      mvmelp.cr =      0x10;
      mvmelp.ack_icr = 0xd9; /* Int on trailing edge of ACK */
      restore_flags(flags);

      if (lp_irq)
        tab.irq = request_irq(MVME167_IRQ_PRN, lp_int_interrupt,
          0, "builtin printer port", lp_int_interrupt);
      tab.base = (void *)&mvmelp; /* dummy, not used */
      tab.type = LP_MVME167;
    }
#endif
#ifdef CONFIG_BVME6000
    if (MACH_IS_BVME6000)
    {
      unsigned long flags;

      save_flags(flags);
      cli();
      bvmepit.pgcr =   0x0f;
      bvmepit.psrr =   0x18;
      bvmepit.paddr =  0xff;
      bvmepit.pcdr  =  (bvmepit.pcdr & 0xfc) | 0x02;
      bvmepit.pcddr |= 0x03;
      bvmepit.pacr =   0x78;
      bvmepit.pbcr =   0x00;
      bvmepit.pivr =   BVME_IRQ_PRN;
      bvmepit.pgcr =   0x1f;
      restore_flags(flags);

      if (lp_irq)
        tab.irq = request_irq(BVME_IRQ_PRN, lp_int_interrupt,
          0, "builtin printer port", lp_int_interrupt);
      tab.base = (void *)&bvmepit; /* dummy, not used */
      tab.type = LP_BVME6000;
    }
#endif


  if ((minor = register_parallel(&tab, minor)) < 0) {
    printk("builtin lp init: cant get a minor\n");
    if (lp_irq) {
#ifdef CONFIG_AMIGA
      if (MACH_IS_AMIGA)
	free_irq(IRQ_AMIGA_CIAA_FLG, lp_int_interrupt);
#endif
#ifdef CONFIG_ATARI
      if (MACH_IS_ATARI)
	free_irq(IRQ_MFP_BUSY, lp_int_interrupt);
#endif
#ifdef CONFIG_MVME16x
      if (MACH_IS_MVME16x)
        free_irq(MVME167_IRQ_PRN, lp_int_interrupt);
#endif
#ifdef CONFIG_BVME6000
      if (MACH_IS_BVME6000)
        free_irq(BVME_IRQ_PRN, lp_int_interrupt);
#endif
    }
    return -ENODEV;
  }
  
  return 0;
}

#ifdef MODULE
int init_module(void)
{
return lp_internal_init();
}

void cleanup_module(void)
{
if (lp_irq) {
#ifdef CONFIG_AMIGA
  if (MACH_IS_AMIGA)
    free_irq(IRQ_AMIGA_CIAA_FLG, lp_int_interrupt);
#endif
#ifdef CONFIG_ATARI
  if (MACH_IS_ATARI)
    free_irq(IRQ_MFP_BUSY, lp_int_interrupt);
#endif
#ifdef CONFIG_MVME16x
  if (MACH_IS_MVME16x)
    free_irq(MVME167_IRQ_PRN, lp_int_interrupt);
#endif
#ifdef CONFIG_BVME6000
  if (MACH_IS_BVME6000)
    free_irq(BVME_IRQ_PRN, lp_int_interrupt);
#endif
}
unregister_parallel(minor);
}
#endif