Quelle  rtlx-mt.c   Sprache: C

/*
 * 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) 2005 MIPS Technologies, Inc.  All rights reserved.
 * Copyright (C) 2013 Imagination Technologies Ltd.
 */
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/err.h>
#include <linux/wait.h>
#include <linux/sched.h>
#include <linux/interrupt.h>
#include <linux/irq.h>

#include <asm/mips_mt.h>
#include <asm/vpe.h>
#include <asm/rtlx.h>

static int major;

static void rtlx_dispatch(void)
{
 if (read_c0_cause() & read_c0_status() & C_SW0)
  do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ);
}

/*
 * Interrupt handler may be called before rtlx_init has otherwise had
 * a chance to run.
 */
static irqreturn_t rtlx_interrupt(int irq, void *dev_id)
{
 unsigned int vpeflags;
 unsigned long flags;
 int i;

 local_irq_save(flags);
 vpeflags = dvpe();
 set_c0_status(0x100 << MIPS_CPU_RTLX_IRQ);
 irq_enable_hazard();
 evpe(vpeflags);
 local_irq_restore(flags);

 for (i = 0; i < RTLX_CHANNELS; i++) {
  wake_up(&channel_wqs[i].lx_queue);
  wake_up(&channel_wqs[i].rt_queue);
 }

 return IRQ_HANDLED;
}

static int rtlx_irq_num = MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ;

void _interrupt_sp(void)
{
 unsigned long flags;

 local_irq_save(flags);
 dvpe();
 settc(1);
 write_vpe_c0_cause(read_vpe_c0_cause() | C_SW0);
 evpe(EVPE_ENABLE);
 local_irq_restore(flags);
}

int __init rtlx_module_init(void)
{
 struct device *dev;
 int i, err;

 if (!cpu_has_mipsmt) {
  pr_warn("VPE loader: not a MIPS MT capable processor\n");
  return -ENODEV;
 }

 if (aprp_cpu_index() == 0) {
  pr_warn("No TCs reserved for AP/SP, not initializing RTLX.\n"
   "Pass maxtcs= argument as kernel argument\n");

  return -ENODEV;
 }

 major = register_chrdev(0, RTLX_MODULE_NAME, &rtlx_fops);
 if (major < 0) {
  pr_err("rtlx_module_init: unable to register device\n");
  return major;
 }

 /* initialise the wait queues */
 for (i = 0; i < RTLX_CHANNELS; i++) {
  init_waitqueue_head(&channel_wqs[i].rt_queue);
  init_waitqueue_head(&channel_wqs[i].lx_queue);
  atomic_set(&channel_wqs[i].in_open, 0);
  mutex_init(&channel_wqs[i].mutex);

  dev = device_create(&mt_class, NULL, MKDEV(major, i), NULL,
        "%s%d", RTLX_MODULE_NAME, i);
  if (IS_ERR(dev)) {
   while (i--)
    device_destroy(&mt_class, MKDEV(major, i));

   err = PTR_ERR(dev);
   goto out_chrdev;
  }
 }

 /* set up notifiers */
 rtlx_notify.start = rtlx_starting;
 rtlx_notify.stop = rtlx_stopping;
 vpe_notify(aprp_cpu_index(), &rtlx_notify);

 if (cpu_has_vint) {
  aprp_hook = rtlx_dispatch;
 } else {
  pr_err("APRP RTLX init on non-vectored-interrupt processor\n");
  err = -ENODEV;
  goto out_class;
 }

 err = request_irq(rtlx_irq_num, rtlx_interrupt, 0, "RTLX", rtlx);
 if (err)
  goto out_class;

 return 0;

out_class:
 for (i = 0; i < RTLX_CHANNELS; i++)
  device_destroy(&mt_class, MKDEV(major, i));
out_chrdev:
 unregister_chrdev(major, RTLX_MODULE_NAME);

 return err;
}

void __exit rtlx_module_exit(void)
{
 int i;

 for (i = 0; i < RTLX_CHANNELS; i++)
  device_destroy(&mt_class, MKDEV(major, i));

 unregister_chrdev(major, RTLX_MODULE_NAME);

 aprp_hook = NULL;
}