1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
|
#include <linux/module.h>
#include <linux/kernel.h>
#include <rtl_time.h>
#include <rtl_sched.h>
#include <asm/io.h>
#include <rtl.h>
#include <time.h>
#include "common.h"
int number_of_tests=50;
int period[2]={20000000,1000000};
int periodic_mode=0;
pthread_t T[2];
int shutdown = 0;
/* For testing purposes, if we are on a smp machine, try to
run the measurement module on the _other_cpu
on a uniprocessor, ignore this test.
*/
void *thread_code(void *t) {
int i;
int index = (int)t;
printk("Multitask %x task starts\n",index);
rtl_printf("Multitask %x task starts\n",index);
rtl_printf("Multi task period %d\n",(int) period[index]);
pthread_make_periodic_np(T[index], gethrtime(), period[index]);
do {
for(i=0; i < 1000; i++) pthread_wait_np();
conpr("T");conpr((t== 0? "0\n":"1\n"));
} while (!shutdown);
return 0;
}
int init_module(void)
{
pthread_attr_t attr;
struct sched_param sched_param;
int thread_status0 = 0;
int thread_status1 = 0;
printk("RTLinux multithread test module on CPU %d\n",rtl_getcpuid());
printk("WARNING: Output for this test is only visible on console\n");
pthread_attr_init (&attr);
sched_param.sched_priority = 1;
pthread_attr_setschedparam (&attr, &sched_param);
printk("About to thread create\n");
thread_status0 = pthread_create (&T[0], &attr, thread_code, (void *)0);
thread_status1 = pthread_create (&T[1], &attr, thread_code, (void *)1);
if (thread_status0 != 0) {
printk("failed to create RT-thread0\n");
return -1;
} else if (thread_status1 != 0) {
printk("failed to create RT-thread1\n");
return -1;
} else {
printk("created RT-threads\n");
}
return 0;
}
void cleanup_module(void)
{
printk ("Removing module on CPU %d\n", rtl_getcpuid());
pthread_delete_np (T[0]);
pthread_delete_np (T[1]);
}
|
