#include #include #include #include #include extern rt_uint16_t rt_data_queue_len(struct rt_data_queue *) __attribute__((weak)); static struct rt_data_queue q; static struct rt_thread control, worker; static unsigned char control_stack[65536], worker_stack[65536]; static unsigned long payload[256]; static struct rt_semaphore gate; static int worker_op, worker_id, worker_size, worker_timeout; static int ptr_id(const void *p) { int i; for(i=0;i<256;i++) if(p==&payload[i]) return i; return -1; } static void worker_entry(void *unused) { const void *p=NULL; rt_size_t n=0; rt_err_t rc; (void)unused; rt_sem_take(&gate,RT_WAITING_FOREVER); puts("WB"); fflush(stdout); if(worker_op==1) rc=rt_data_queue_push(&q,&payload[worker_id],worker_size,worker_timeout); else rc=rt_data_queue_pop(&q,&p,&n,worker_timeout); printf("WR %ld %d %lu\n",rc,ptr_id(p),(unsigned long)n); fflush(stdout); } static void control_entry(void *unused) { char line[128], op; int a,b,c,d,i; const void *p; rt_size_t n; rt_err_t rc; (void)unused; rt_sem_init(&gate,"gate",0,RT_IPC_FLAG_FIFO); while(fgets(line,sizeof(line),stdin)) { op=0;a=b=c=d=0;sscanf(line," %c %d %d %d %d",&op,&a,&b,&c,&d); p=NULL;n=0; switch(op) { case 'I': rc=rt_data_queue_init(&q,a,b,NULL); printf("I %ld\n",rc);break; case 'P': rc=rt_data_queue_push(&q,&payload[a],b,c);printf("P %ld\n",rc);break; case 'O': rc=rt_data_queue_pop(&q,&p,&n,a);printf("O %ld %d %lu\n",rc,ptr_id(p),(unsigned long)n);break; case 'K': rc=rt_data_queue_peak(&q,&p,&n);printf("K %ld %d %lu\n",rc,ptr_id(p),(unsigned long)n);break; case 'L': printf("L %d\n",rt_data_queue_len ? (int)rt_data_queue_len(&q) : -999);break; case 'R': rt_data_queue_reset(&q);puts("R");break; case 'D': rc=rt_data_queue_deinit(&q);printf("D %ld\n",rc);break; case 'W': worker_op=a;worker_timeout=b;worker_id=c;worker_size=d; rc=rt_thread_init(&worker,"worker",worker_entry,NULL,worker_stack,sizeof(worker_stack),5,100); printf("WI %ld\n",rc);rc=rt_thread_startup(&worker);printf("WS %ld\n",rc);break; case 'G': rc=rt_sem_release(&gate);printf("G %ld\n",rc);break; case 'T': for(i=0;i