static int comedi_rt_get_irq(struct comedi_irq_struct *it)
{
rt_request_global_irq(it->irq, handle_void_irq_ptrs[it->irq]);
rt_startup_irq(it->irq);
return 0;
}
int init_module(void)
{
RESET_COUNT = SECS*100;
rt_mount_rtai();
rt_assign_irq_to_cpu(TIMER_8254_IRQ, 1 << hard_cpu_id());
rt_request_timer(just_ret, COUNT, 1);
rt_request_global_irq(TIMER_8254_IRQ, calibrate);
printk("\n->>> HERE WE GO (PRINTING EVERY %d SECONDS, 'make stop' to end calibrating) <<<-\n\n", RESET_COUNT/100);
return 0;
}
int init_module(void)
{
int ret;
unsigned long local_ip = rt_inet_aton(local_ip_s);
unsigned long server_ip = rt_inet_aton(server_ip_s);
rtf_create(PRINT, 40000);
rt_sem_init(&tx_sem, 0);
rt_printk ("local ip address %s=%8x\n", local_ip_s, (unsigned int) local_ip);
rt_printk ("server ip address %s=%8x\n", server_ip_s, (unsigned int) server_ip);
/* create rt-socket */
sock=rt_socket(AF_INET,SOCK_DGRAM,0);
/* bind the rt-socket to local_addr */
memset(&local_addr, 0, sizeof(struct sockaddr_in));
local_addr.sin_family = AF_INET;
local_addr.sin_port = htons(RCV_PORT);
local_addr.sin_addr.s_addr = local_ip;
ret=rt_socket_bind(sock, (struct sockaddr *) &local_addr, sizeof(struct sockaddr_in));
/* set server-addr */
memset(&server_addr, 0, sizeof(struct sockaddr_in));
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(SRV_PORT);
server_addr.sin_addr.s_addr = server_ip;
// set up receiving
rt_socket_callback(sock, echo_rcv, NULL);
rt_set_oneshot_mode();
start_rt_timer(TIMERTICKS);
ret=rt_task_init(&rt_task,(void *)process,0,4096,10,0,NULL);
rt_task_resume(&rt_task);
rt_request_global_irq(parirq, parport_irq_handler);
rt_startup_irq(parirq);
outb(0xFF, PAR_DATA);
outb(0x14 + KHZ0_1, PAR_CONTROL);
return ret;
}
void rt_request_timer(void (*handler)(void), unsigned int tick, int unused)
{
RTIME t;
extern union rtai_tsc rtai_tsc;
unsigned long flags;
TRACE_RTAI_TIMER(TRACE_RTAI_EV_TIMER_REQUEST, handler, tick);
flags = hard_lock_all();
/*
* sync w/jiffie, wait for a OS timer 0 match and clear the match bit
*/
rtai_tsc.tsc = 0;
/* wait for a timer match 0 and clear the match bit */
do {
} while ( (signed long)(OSMR0 - OSCR) >= 0 );
OSSR = OSSR_M0;
/* set up rt_times structure */
rt_times.linux_tick = LATCH;
rt_times.periodic_tick = tick > 0 && tick < (RTIME)rt_times.linux_tick ? tick : rt_times.linux_tick;
rt_times.tick_time = t = rdtsc();
rt_times.intr_time = t + (RTIME)rt_times.periodic_tick;
rt_times.linux_time = t + (RTIME)rt_times.linux_tick;
/* Trick the scheduler - set this our way. */
// tuned.setup_time_TIMER_CPUNIT = (int)(~(~0 >> 1)) + 1; /* smallest negative + 1 - for extra safety:-) */
/* update Match-register */
rt_set_timer_match_reg(rt_times.periodic_tick);
irq_desc[TIMER_8254_IRQ].action->handler = soft_timer_interrupt;
rt_free_global_irq(TIMER_8254_IRQ);
rt_request_global_irq(TIMER_8254_IRQ, handler);
/*
* pend linux timer irq to handle current jiffie
*/
rt_pend_linux_irq(TIMER_8254_IRQ);
hard_unlock_all(flags);
return;
}
int init_module(void)
{
unsigned int add_rtskbs = 30;
int ret;
unsigned long local_ip;
unsigned long server_ip;
if (strlen(local_ip_s) != 0)
local_ip = rt_inet_aton(local_ip_s);
else
local_ip = INADDR_ANY;
server_ip = rt_inet_aton(server_ip_s);
rtf_create(PRINT_FIFO, 40000);
rt_sem_init(&tx_sem, 0);
rt_printk("local ip address %s=%8x\n", local_ip_s, (unsigned int) local_ip);
rt_printk("server ip address %s=%8x\n", server_ip_s, (unsigned int) server_ip);
/* create rt-socket */
rt_printk("create rtsocket\n");
if ((sock = socket_rt(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
rt_printk("socket not created\n");
return sock;
}
/* extend the socket pool */
ret = ioctl_rt(sock, RTNET_RTIOC_EXTPOOL, &add_rtskbs);
if (ret != (int)add_rtskbs) {
close_rt(sock);
rt_printk("ioctl_rt(RTNET_RTIOC_EXTPOOL) = %d\n", ret);
return -1;
}
/* bind the rt-socket to local_addr */
local_addr.sin_family = AF_INET;
local_addr.sin_port = htons(RCV_PORT);
local_addr.sin_addr.s_addr = local_ip;
if ((ret = bind_rt(sock, (struct sockaddr *)&local_addr,
sizeof(struct sockaddr_in))) < 0) {
close_rt(sock);
rt_printk("can't bind rtsocket\n");
return ret;
}
/* set server-addr */
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(SRV_PORT);
server_addr.sin_addr.s_addr = server_ip;
rt_task_init(&xmit_task,(void *)process,0,4096,10,0,NULL);
rt_task_resume(&xmit_task);
rt_task_init(&recv_task,(void *)echo_rcv,0,4096,9,0,NULL);
rt_task_resume(&recv_task);
rt_request_global_irq(parirq, parport_irq_handler);
rt_startup_irq(parirq);
outb(0xFF, PAR_DATA);
outb(0x14 + KHZ0_1, PAR_CONTROL);
return ret;
}
static long long user_srq(unsigned long whatever)
{
extern int calibrate_8254(void);
unsigned long args[MAXARGS];
int ret;
ret = copy_from_user(args, (unsigned long *)whatever, MAXARGS*sizeof(unsigned long));
switch (args[0]) {
case CAL_8254: {
return calibrate_8254();
break;
}
case KTHREADS:
case KLATENCY: {
rt_set_oneshot_mode();
period = start_rt_timer(nano2count(args[1]));
if (args[0] == KLATENCY) {
rt_task_init_cpuid(&rtask, spv, args[2], STACKSIZE, 0, 0, 0, hard_cpu_id());
} else {
// rt_kthread_init_cpuid(&rtask, spv, args[2], STACKSIZE, 0, 0, 0, hard_cpu_id());
}
expected = rt_get_time() + 100*period;
rt_task_make_periodic(&rtask, expected, period);
break;
}
case END_KLATENCY: {
stop_rt_timer();
rt_task_delete(&rtask);
break;
}
case FREQ_CAL: {
times.intrs = -1;
reset_count = args[1]*HZ;
count = 0;
rt_assign_irq_to_cpu(TIMER_8254_IRQ, 1 << hard_cpu_id());
rt_request_timer(just_ret, COUNT, 1);
rt_request_global_irq(TIMER_8254_IRQ, calibrate);
break;
}
case END_FREQ_CAL: {
rt_free_timer();
rt_reset_irq_to_sym_mode(TIMER_8254_IRQ);
rt_free_global_irq(TIMER_8254_IRQ);
break;
}
case BUS_CHECK: {
loops = maxj = 0;
bus_period = imuldiv(args[1], CPU_FREQ, 1000000000);
bus_threshold = imuldiv(args[2], CPU_FREQ, 1000000000);
use_parport = args[3];
rt_assign_irq_to_cpu(TIMER_8254_IRQ, 1 << hard_cpu_id());
rt_request_timer((void *)rt_timer_tick_ext, imuldiv(args[1], FREQ_8254, 1000000000), 0);
rt_set_global_irq_ext(TIMER_8254_IRQ, 1, 0);
break;
}
case END_BUS_CHECK: {
rt_free_timer();
rt_reset_irq_to_sym_mode(TIMER_8254_IRQ);
break;
}
case GET_PARAMS: {
rtf_put(0, ¶ms, sizeof(params));
break;
}
}
return 0;
}
int init_module(void)
{
unsigned int nonblock = 1;
unsigned int add_rtskbs = 30;
int ret;
unsigned long local_ip;
unsigned long server_ip;
if (strlen(local_ip_s) != 0)
local_ip = rt_inet_aton(local_ip_s);
else
local_ip = INADDR_ANY;
server_ip = rt_inet_aton(server_ip_s);
rtf_create(PRINT_FIFO, 40000);
rt_sem_init(&tx_sem, 0);
rt_printk ("local ip address %s=%8x\n", local_ip_s, (unsigned int) local_ip);
rt_printk ("server ip address %s=%8x\n", server_ip_s, (unsigned int) server_ip);
/* create rt-socket */
rt_printk("create rtsocket\n");
if ((sock=rt_socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
rt_printk("socket not created\n");
return sock;
}
/* switch to non-blocking */
ret = rt_setsockopt(sock, SOL_SOCKET, RT_SO_NONBLOCK, &nonblock, sizeof(nonblock));
rt_printk("rt_setsockopt(RT_SO_NONBLOCK) = %d\n", ret);
/* extend the socket pool */
ret = rt_setsockopt(sock, SOL_SOCKET, RT_SO_EXTPOOL, &add_rtskbs, sizeof(add_rtskbs));
if (ret != (int)add_rtskbs) {
rt_socket_close(sock);
rt_printk("rt_setsockopt(RT_SO_EXTPOOL) = %d\n", ret);
return -1;
}
/* bind the rt-socket to local_addr */
memset(&local_addr, 0, sizeof(struct sockaddr_in));
local_addr.sin_family = AF_INET;
local_addr.sin_port = htons(RCV_PORT);
local_addr.sin_addr.s_addr = local_ip;
if ( (ret=rt_socket_bind(sock, (struct sockaddr *) &local_addr, sizeof(struct sockaddr_in)))<0 ) {
rt_socket_close(sock);
rt_printk("can't bind rtsocket\n");
return ret;
}
/* set server-addr */
memset(&server_addr, 0, sizeof(struct sockaddr_in));
server_addr.sin_family = AF_INET;
server_addr.sin_port = htons(SRV_PORT);
server_addr.sin_addr.s_addr = server_ip;
/* set up receiving */
rt_socket_callback(sock, echo_rcv, NULL);
ret=rt_task_init(&rt_task,(void *)process,0,4096,10,0,NULL);
rt_task_resume(&rt_task);
rt_request_global_irq(parirq, parport_irq_handler);
rt_startup_irq(parirq);
outb(0xFF, PAR_DATA);
outb(0x14 + KHZ0_1, PAR_CONTROL);
return ret;
}
int init_rtai_proxy( void )
{
rt_assign_irq_to_cpu(TIMER_IRQ, ALLOWED_CPUS);
rt_request_global_irq(TIMER_IRQ, (void *)tmrisr);
return 0;
}
