eckelmann.kpaste.net RSS- diff --git a/ptxdist/local_src/ecu01-comp-cap/main.c b/ptxdist/local_src/ecu01-comp-cap/main.c
- index 1fe9651..785aa36 100644
- --- a/ptxdist/local_src/ecu01-comp-cap/main.c
- +++ b/ptxdist/local_src/ecu01-comp-cap/main.c
- @@ -47,7 +47,11 @@
- #include <linux/seq_file.h>
- #include <linux/cdev.h>
- #include <linux/spinlock.h>
- -
- +#include <linux/irq.h>
- +#include <linux/irqdesc.h>
- +#include <linux/interrupt.h>
- +#include <linux/sched.h>
- +#include <linux/sched/rt.h>
- //#include <asm/system.h> /* cli(), *_flags */
- #include <asm/uaccess.h> /* copy_*_user */
- @@ -177,6 +181,79 @@ int comp_cap_release(struct inode *inode, struct file *filp)
- return 0;
- }
- +static
- +struct task_struct *irq_desc_to_irq_thread_task_struct(struct irq_desc *irq_desc)
- +{
- + if (irq_desc && irq_desc->action)
- + {
- + /*
- + * Note: |irq_desc->action| can be chained if the irq
- + * is a shared one. Maybe we should place a fatal assert
- + * for that case since we do not handle this here.
- + */
- + return irq_desc->action->thread;
- + }
- +
- + return NULL;
- +}
- +
- +#define ECU01_CC_IRQ_THREAD_RTPRIO (MAX_USER_RT_PRIO-1)
- +
- +/*
- + * set scheduler paramters of the compare capture interrupt threads
- + *
- + * Note: Realtime priorities of the compare capture interrupt
- + * threads can be monitored with
- + * $ ps -e -o s,tid,pid,cls,pri,rtprio,comm,time | egrep 'irq/.+CC' #
- + *
- + * ToDo: Failure to set the parameters should be fatal for the
- + * |open()| syscall which calls this function!
- + */
- +static
- +void set_cc_irq_thread_scheduler_parameters(struct comp_cap_dev_priv *priv_dev)
- +{
- + struct irq_desc *irq_desc;
- + bool set_sched_success = false;
- + struct task_struct *ts;
- + struct sched_param param;
- + (void)memset(¶m, 0, sizeof(param));
- + param.sched_priority = ECU01_CC_IRQ_THREAD_RTPRIO;
- +
- + irq_desc = irq_to_desc(priv_dev->IRQ);
- + if (!irq_desc)
- + {
- + /* This can fail with certain kernel CONFIG_* settings */
- + (void)printk(KERN_EMERG "%s:%d: %s\n",
- + __func__, __LINE__, "irq_to_desc() failed.");
- + return;
- + }
- +
- + ts = irq_desc_to_irq_thread_task_struct(irq_desc);
- + if (ts)
- + {
- + if (sched_setscheduler(ts, SCHED_FIFO, ¶m) == 0)
- + set_sched_success = true;
- + }
- +
- + /*
- + * Be very verbose&loud about setting the scheduler class
- + * and priority, since the application will not work correctly
- + * if we fail to do this.
- + *
- + * ToDo: Propagate an error to the caller, so that a device
- + * |open()| FAILS.
- + */
- + (void)printk(KERN_EMERG "ecu01-compcap: "
- + "irq=%ld/%ld, %s interrupt thread pid=%ld to '%s'/rtprio=%ld\n",
- + (long)irq_desc->irq_data.irq,
- + (long)priv_dev->IRQ,
- + (set_sched_success?"changed":"failed to change"),
- + (long)(ts?ts->pid:-1),
- + "SCHED_FIFO",
- + (long)param.sched_priority);
- +}
- +
- +
- int start_comp_cap( struct comp_cap_dev *dev, int enable )
- {
- int res = -1;
- @@ -188,6 +265,8 @@ int start_comp_cap( struct comp_cap_dev *dev, int enable )
- res = request_irq(priv_dev->IRQ, cc_isr, IRQF_DISABLED, dev->NAME , priv_dev );
- + set_cc_irq_thread_scheduler_parameters(priv_dev);
- +
- cc_restart(priv_dev);
- priv_dev->clk = clk_get_sys( priv_dev->CLK_PROVIDER, priv_dev->CLK_PARENT);
Quantron: Set CC irq thread scheduler parameters
Posted by Anonymous on Tue 22nd Oct 2019 13:29
raw | new post
view followups (newest first): Quantron: Set CC irq thread scheduler parameters by Anonymous
Submit a correction or amendment below (click here to make a fresh posting)
After submitting an amendment, you'll be able to view the differences between the old and new posts easily.