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
|
#include <rtl.h>
#include <time.h>
#include <rtl_fifo.h>
#include <pthread.h>
#include <unistd.h>
static pthread_t thread;
static int fd_fifo;
static void * start_routine(void *arg)
{
struct sched_param p;
p . sched_priority = 1;
pthread_setschedparam (pthread_self(), SCHED_FIFO, &p);
pthread_make_periodic_np (pthread_self(), gethrtime(), 500000000);
while (1) {
pthread_wait_np ();
write(fd_fifo, "test ", 6);
}
return 0;
}
int init_module(void) {
fd_fifo = open("/dev/rtf0", O_NONBLOCK | O_CREAT);
if (fd_fifo < 0) {
rtl_printf("/dev/rtf0 open returned %d\n", fd_fifo);
return -1;
}
rtl_printf("ioctl on /dev/rtf0 (setting fifo size to 4000) returned %d\n",
ioctl(fd_fifo, RTF_SETSIZE, 4000));
return pthread_create (&thread, NULL, start_routine, 0);
}
void cleanup_module(void)
{
int ret;
pthread_delete_np (thread);
ret = close(fd_fifo);
rtl_printf ("rtl_fifo: close returned %d\n", ret);
}
|
