mirror of
https://github.com/torvalds/linux
synced 2024-10-06 19:34:19 +00:00
MIPS: APRP: Split RTLX support into separate files.
Split the RTLX functionality in preparation for adding support for CMP platforms. Common functions remain in the original file and a new file contains code specific to platforms that do not have a CMP. Signed-off-by: Deng-Cheng Zhu <dengcheng.zhu@imgtec.com> Signed-off-by: Steven J. Hill <Steven.Hill@imgtec.com> Reviewed-by: Qais Yousef <Qais.Yousef@imgtec.com> Patchwork: http://patchwork.linux-mips.org/patch/6093/ Reviewed-by: John Crispin <blogic@openwrt.org>
This commit is contained in:
parent
17a1d523aa
commit
2c973ef0cc
|
@ -1956,6 +1956,11 @@ config MIPS_VPE_APSP_API
|
||||||
depends on MIPS_VPE_LOADER
|
depends on MIPS_VPE_LOADER
|
||||||
help
|
help
|
||||||
|
|
||||||
|
config MIPS_VPE_APSP_API_MT
|
||||||
|
bool
|
||||||
|
default "y"
|
||||||
|
depends on MIPS_VPE_APSP_API && !MIPS_CMP
|
||||||
|
|
||||||
config MIPS_CMP
|
config MIPS_CMP
|
||||||
bool "MIPS CMP support"
|
bool "MIPS CMP support"
|
||||||
depends on SYS_SUPPORTS_MIPS_CMP && MIPS_MT_SMP
|
depends on SYS_SUPPORTS_MIPS_CMP && MIPS_MT_SMP
|
||||||
|
|
|
@ -1,6 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* Copyright (C) 2004, 2005 MIPS Technologies, Inc. All rights reserved.
|
* Copyright (C) 2004, 2005 MIPS Technologies, Inc. All rights reserved.
|
||||||
*
|
* Copyright (C) 2013 Imagination Technologies Ltd.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef __ASM_RTLX_H_
|
#ifndef __ASM_RTLX_H_
|
||||||
|
@ -8,6 +8,8 @@
|
||||||
|
|
||||||
#include <irq.h>
|
#include <irq.h>
|
||||||
|
|
||||||
|
#define RTLX_MODULE_NAME "rtlx"
|
||||||
|
|
||||||
#define LX_NODE_BASE 10
|
#define LX_NODE_BASE 10
|
||||||
|
|
||||||
#define MIPS_CPU_RTLX_IRQ 0
|
#define MIPS_CPU_RTLX_IRQ 0
|
||||||
|
@ -15,18 +17,31 @@
|
||||||
#define RTLX_VERSION 2
|
#define RTLX_VERSION 2
|
||||||
#define RTLX_xID 0x12345600
|
#define RTLX_xID 0x12345600
|
||||||
#define RTLX_ID (RTLX_xID | RTLX_VERSION)
|
#define RTLX_ID (RTLX_xID | RTLX_VERSION)
|
||||||
|
#define RTLX_BUFFER_SIZE 2048
|
||||||
#define RTLX_CHANNELS 8
|
#define RTLX_CHANNELS 8
|
||||||
|
|
||||||
#define RTLX_CHANNEL_STDIO 0
|
#define RTLX_CHANNEL_STDIO 0
|
||||||
#define RTLX_CHANNEL_DBG 1
|
#define RTLX_CHANNEL_DBG 1
|
||||||
#define RTLX_CHANNEL_SYSIO 2
|
#define RTLX_CHANNEL_SYSIO 2
|
||||||
|
|
||||||
extern int rtlx_open(int index, int can_sleep);
|
void rtlx_starting(int vpe);
|
||||||
extern int rtlx_release(int index);
|
void rtlx_stopping(int vpe);
|
||||||
extern ssize_t rtlx_read(int index, void __user *buff, size_t count);
|
|
||||||
extern ssize_t rtlx_write(int index, const void __user *buffer, size_t count);
|
int rtlx_open(int index, int can_sleep);
|
||||||
extern unsigned int rtlx_read_poll(int index, int can_sleep);
|
int rtlx_release(int index);
|
||||||
extern unsigned int rtlx_write_poll(int index);
|
ssize_t rtlx_read(int index, void __user *buff, size_t count);
|
||||||
|
ssize_t rtlx_write(int index, const void __user *buffer, size_t count);
|
||||||
|
unsigned int rtlx_read_poll(int index, int can_sleep);
|
||||||
|
unsigned int rtlx_write_poll(int index);
|
||||||
|
|
||||||
|
int __init rtlx_module_init(void);
|
||||||
|
void __exit rtlx_module_exit(void);
|
||||||
|
|
||||||
|
void _interrupt_sp(void);
|
||||||
|
|
||||||
|
extern struct vpe_notifications rtlx_notify;
|
||||||
|
extern const struct file_operations rtlx_fops;
|
||||||
|
extern void (*aprp_hook)(void);
|
||||||
|
|
||||||
enum rtlx_state {
|
enum rtlx_state {
|
||||||
RTLX_STATE_UNUSED = 0,
|
RTLX_STATE_UNUSED = 0,
|
||||||
|
@ -35,10 +50,15 @@ enum rtlx_state {
|
||||||
RTLX_STATE_OPENED
|
RTLX_STATE_OPENED
|
||||||
};
|
};
|
||||||
|
|
||||||
#define RTLX_BUFFER_SIZE 2048
|
extern struct chan_waitqueues {
|
||||||
|
wait_queue_head_t rt_queue;
|
||||||
|
wait_queue_head_t lx_queue;
|
||||||
|
atomic_t in_open;
|
||||||
|
struct mutex mutex;
|
||||||
|
} channel_wqs[RTLX_CHANNELS];
|
||||||
|
|
||||||
/* each channel supports read and write.
|
/* each channel supports read and write.
|
||||||
linux (vpe0) reads lx_buffer and writes rt_buffer
|
linux (vpe0) reads lx_buffer and writes rt_buffer
|
||||||
SP (vpe1) reads rt_buffer and writes lx_buffer
|
SP (vpe1) reads rt_buffer and writes lx_buffer
|
||||||
*/
|
*/
|
||||||
struct rtlx_channel {
|
struct rtlx_channel {
|
||||||
|
@ -55,11 +75,10 @@ struct rtlx_channel {
|
||||||
char *lx_buffer;
|
char *lx_buffer;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct rtlx_info {
|
extern struct rtlx_info {
|
||||||
unsigned long id;
|
unsigned long id;
|
||||||
enum rtlx_state state;
|
enum rtlx_state state;
|
||||||
|
|
||||||
struct rtlx_channel channel[RTLX_CHANNELS];
|
struct rtlx_channel channel[RTLX_CHANNELS];
|
||||||
};
|
} *rtlx;
|
||||||
|
|
||||||
#endif /* __ASM_RTLX_H_ */
|
#endif /* __ASM_RTLX_H_ */
|
||||||
|
|
|
@ -59,6 +59,7 @@ obj-$(CONFIG_MIPS_VPE_LOADER) += vpe.o
|
||||||
obj-$(CONFIG_MIPS_VPE_LOADER_CMP) += vpe-cmp.o
|
obj-$(CONFIG_MIPS_VPE_LOADER_CMP) += vpe-cmp.o
|
||||||
obj-$(CONFIG_MIPS_VPE_LOADER_MT) += vpe-mt.o
|
obj-$(CONFIG_MIPS_VPE_LOADER_MT) += vpe-mt.o
|
||||||
obj-$(CONFIG_MIPS_VPE_APSP_API) += rtlx.o
|
obj-$(CONFIG_MIPS_VPE_APSP_API) += rtlx.o
|
||||||
|
obj-$(CONFIG_MIPS_VPE_APSP_API_MT) += rtlx-mt.o
|
||||||
|
|
||||||
obj-$(CONFIG_I8259) += i8259.o
|
obj-$(CONFIG_I8259) += i8259.o
|
||||||
obj-$(CONFIG_IRQ_CPU) += irq_cpu.o
|
obj-$(CONFIG_IRQ_CPU) += irq_cpu.o
|
||||||
|
|
148
arch/mips/kernel/rtlx-mt.c
Normal file
148
arch/mips/kernel/rtlx-mt.c
Normal file
|
@ -0,0 +1,148 @@
|
||||||
|
/*
|
||||||
|
* 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;
|
||||||
|
|
||||||
|
/* Ought not to be strictly necessary for SMTC builds */
|
||||||
|
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 struct irqaction rtlx_irq = {
|
||||||
|
.handler = rtlx_interrupt,
|
||||||
|
.name = "RTLX",
|
||||||
|
};
|
||||||
|
|
||||||
|
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=<n> 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)) {
|
||||||
|
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;
|
||||||
|
}
|
||||||
|
|
||||||
|
rtlx_irq.dev_id = rtlx;
|
||||||
|
err = setup_irq(rtlx_irq_num, &rtlx_irq);
|
||||||
|
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);
|
||||||
|
}
|
|
@ -42,52 +42,12 @@
|
||||||
#include <asm/rtlx.h>
|
#include <asm/rtlx.h>
|
||||||
#include <asm/setup.h>
|
#include <asm/setup.h>
|
||||||
|
|
||||||
static struct rtlx_info *rtlx;
|
|
||||||
static int major;
|
|
||||||
static char module_name[] = "rtlx";
|
|
||||||
|
|
||||||
static struct chan_waitqueues {
|
|
||||||
wait_queue_head_t rt_queue;
|
|
||||||
wait_queue_head_t lx_queue;
|
|
||||||
atomic_t in_open;
|
|
||||||
struct mutex mutex;
|
|
||||||
} channel_wqs[RTLX_CHANNELS];
|
|
||||||
|
|
||||||
static struct vpe_notifications notify;
|
|
||||||
static int sp_stopping;
|
static int sp_stopping;
|
||||||
|
struct rtlx_info *rtlx;
|
||||||
extern void *vpe_get_shared(int index);
|
struct chan_waitqueues channel_wqs[RTLX_CHANNELS];
|
||||||
|
struct vpe_notifications rtlx_notify;
|
||||||
static void rtlx_dispatch(void)
|
void (*aprp_hook)(void) = NULL;
|
||||||
{
|
EXPORT_SYMBOL(aprp_hook);
|
||||||
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;
|
|
||||||
|
|
||||||
/* Ought not to be strictly necessary for SMTC builds */
|
|
||||||
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 void __used dump_rtlx(void)
|
static void __used dump_rtlx(void)
|
||||||
{
|
{
|
||||||
|
@ -127,7 +87,7 @@ static int rtlx_init(struct rtlx_info *rtlxi)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* notifications */
|
/* notifications */
|
||||||
static void starting(int vpe)
|
void rtlx_starting(int vpe)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
sp_stopping = 0;
|
sp_stopping = 0;
|
||||||
|
@ -140,7 +100,7 @@ static void starting(int vpe)
|
||||||
wake_up_interruptible(&channel_wqs[i].lx_queue);
|
wake_up_interruptible(&channel_wqs[i].lx_queue);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void stopping(int vpe)
|
void rtlx_stopping(int vpe)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
|
@ -384,6 +344,8 @@ ssize_t rtlx_write(int index, const void __user *buffer, size_t count)
|
||||||
smp_wmb();
|
smp_wmb();
|
||||||
mutex_unlock(&channel_wqs[index].mutex);
|
mutex_unlock(&channel_wqs[index].mutex);
|
||||||
|
|
||||||
|
_interrupt_sp();
|
||||||
|
|
||||||
return count;
|
return count;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -454,7 +416,7 @@ static ssize_t file_write(struct file *file, const char __user * buffer,
|
||||||
return rtlx_write(minor, buffer, count);
|
return rtlx_write(minor, buffer, count);
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct file_operations rtlx_fops = {
|
const struct file_operations rtlx_fops = {
|
||||||
.owner = THIS_MODULE,
|
.owner = THIS_MODULE,
|
||||||
.open = file_open,
|
.open = file_open,
|
||||||
.release = file_release,
|
.release = file_release,
|
||||||
|
@ -464,90 +426,6 @@ static const struct file_operations rtlx_fops = {
|
||||||
.llseek = noop_llseek,
|
.llseek = noop_llseek,
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct irqaction rtlx_irq = {
|
|
||||||
.handler = rtlx_interrupt,
|
|
||||||
.name = "RTLX",
|
|
||||||
};
|
|
||||||
|
|
||||||
static int rtlx_irq_num = MIPS_CPU_IRQ_BASE + MIPS_CPU_RTLX_IRQ;
|
|
||||||
|
|
||||||
static char register_chrdev_failed[] __initdata =
|
|
||||||
KERN_ERR "rtlx_module_init: unable to register device\n";
|
|
||||||
|
|
||||||
static int __init rtlx_module_init(void)
|
|
||||||
{
|
|
||||||
struct device *dev;
|
|
||||||
int i, err;
|
|
||||||
|
|
||||||
if (!cpu_has_mipsmt) {
|
|
||||||
printk("VPE loader: not a MIPS MT capable processor\n");
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (tclimit == 0) {
|
|
||||||
printk(KERN_WARNING "No TCs reserved for AP/SP, not "
|
|
||||||
"initializing RTLX.\nPass maxtcs=<n> argument as kernel "
|
|
||||||
"argument\n");
|
|
||||||
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
major = register_chrdev(0, module_name, &rtlx_fops);
|
|
||||||
if (major < 0) {
|
|
||||||
printk(register_chrdev_failed);
|
|
||||||
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", module_name, i);
|
|
||||||
if (IS_ERR(dev)) {
|
|
||||||
err = PTR_ERR(dev);
|
|
||||||
goto out_chrdev;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* set up notifiers */
|
|
||||||
notify.start = starting;
|
|
||||||
notify.stop = stopping;
|
|
||||||
vpe_notify(tclimit, ¬ify);
|
|
||||||
|
|
||||||
if (cpu_has_vint)
|
|
||||||
set_vi_handler(MIPS_CPU_RTLX_IRQ, rtlx_dispatch);
|
|
||||||
else {
|
|
||||||
pr_err("APRP RTLX init on non-vectored-interrupt processor\n");
|
|
||||||
err = -ENODEV;
|
|
||||||
goto out_chrdev;
|
|
||||||
}
|
|
||||||
|
|
||||||
rtlx_irq.dev_id = rtlx;
|
|
||||||
setup_irq(rtlx_irq_num, &rtlx_irq);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
out_chrdev:
|
|
||||||
for (i = 0; i < RTLX_CHANNELS; i++)
|
|
||||||
device_destroy(mt_class, MKDEV(major, i));
|
|
||||||
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static 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, module_name);
|
|
||||||
}
|
|
||||||
|
|
||||||
module_init(rtlx_module_init);
|
module_init(rtlx_module_init);
|
||||||
module_exit(rtlx_module_exit);
|
module_exit(rtlx_module_exit);
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue