Appendix Example Code

Transcription

1 Appendix A Example Code Tornado Training Workshop Copyright A-1 ynchronization essage Queues: Data Collection essage Queues: Client - Server xception Handling elect ( ) DP CP emo code

2 Synchronization Solution 1 #include vxworks.h 2 #include semlib.h 3 #include intlib.h 4 5 LOCAL SEM_ID mysemid; 6 7 void myinit( ) 8 { 9 /* Initialize software/hardware for device */ mysemid = sembcreate (SEM_Q_FIFO, SEM_EMPTY); 12 intconnect (MY_INT_VEC, myisr, 0); 13 } void mygetdata( ) 16 { 17 /* Tweak device registers to start I/O */ /* Wait for interrupt indicating data is ready */ 20 semtake (mysemid, WAIT_FOREVER); 21 /* use the data */ } LOCAL void myisr( ) 26 { 27 /* Interrupt generated from external device */ semgive (mysemid); 30 } 31 Synchronization A-2

3 Message Queues: Data Collection 1 #include vxworks.h 2 #include tasklib.h 3 #include msgqlib.h 4 #include mylib.h 5 6 LOCAL MSG_Q_ID mymsgqid; 7 8 STATUS myinit (void) 9 { 10 /* Software/hardware initialization done here */ mymsgqid = msgqcreate (MAX_MSGS, MAX_SIZE, 13 MSG_Q_PRIORITY); 14 if (mymsgqid == NULL) 15 return (ERROR); 16 if (taskspawn (..., mypollingcode,...) == ERROR) 17 { 18 msgqdelete (mymsgqid); 19 return (ERROR); 20 } 21 return (OK); 22 } LOCAL void mypollingcode (void) 25 { 26 for (;;) 27 { 28 taskdelay (DELAY_PERIOD); 29 /* Read data from device & */ 30 /* place into message queue*/ if (msgqsend (mymsgqid,...) == ERROR) 33 handletheerror( ); 34 } 35 } int mygetdata (char * pbuf) 38 { 39 return (msgqreceive (mymsgqid, pbuf,...)); 40 } Message Queues: Data Collection A-3

4 Message Queues: Client - Server 1 #include vxworks.h 2 #include tasklib.h 3 #include msgqlib.h 4 #include mylib.h 5 6 LOCAL MSG_Q_ID mymsgqid; 7 8 STATUS myinit (void) 9 { 10 /* Server initialization done here */ mymsgqid = msgqcreate (MAX_MSGS, MSG_SIZE, 13 MSG_Q_PRIORITY); 14 if (mymsgqid == NULL) 15 return (ERROR); 16 if (taskspawn (..., myservercode,...) == ERROR) 17 { 18 msgqdelete (mymsgqid); 19 return (ERROR); 20 } 21 return (OK); 22 } LOCAL void myservercode (void) 25 { 26 for (;;) 27 { 28 /* Wait to receive next request */ 29 if (msgqreceive (mymsgqid, pbuf,...) 30 == ERROR) 31 handletheerror(); 32 /* Service the request */ } 35 } STATUS mysendrequest (MY_REQUEST * prequest) 38 { 39 return (msgqsend (mymsgqid, prequest,...)); 40 } Message Queues: Client - Server A-4

5 Exception Handling 1 #include vxworks.h 2 #include tasklib.h 3 #include setjmp.h 4 #include signal.h 5 #include foolib.h 6 7 jmp_buf location; /* Destination for jump */ 8 9 STATUS fooinit (void) 10 { 11 footid = taskspawn ( tfoopoll, FOO_PRIORITY, 12 FOO_OPTIONS, FOO_STACK_SIZE, 13 (FUNCPTR) foopoll, 0, 0, 0, , 0, 0, 0, 0, 0); 15 if (footid == ERROR) 16 return ERROR; 17 return OK; 18 } LOCAL void foopoll (void) 21 { signal (SIGBUS, foohandler); 24 signal (SIGSEGV, foohandler); FOREVER 27 { 28 if (setjmp (location)!= 0) 29 foologdeverror ( ); 30 fooaccessdev ( ); 31 foologdata ( ); 32 } 33 } LOCAL void foohandler (int signum) 36 { 37 fooresetdev ( ); 38 longjmp (location, 100); 39 } setjmp( ) s return value Exception Handling A-5

6 select( ) 1 #include vxworks.h 2 #include fiolib.h 3 #include selectlib.h 4 #include foolib.h 5 6 LOCAL struct fd_set readfds, tmpfds; 7 LOCAL int fds[num_fds]; 8 LOCAL int width = 0; 9 char channelname[20]; /************************************************ 12 * fooreadinit - Attempt to open channels /dev/0 13 * through /dev/n, N == NUM_FDS-1. For each 14 * channel opened, set the bit of the corresponding 15 * file descriptor in readfds. 16 * RETURNS: The number of channels opened. 17 */ int fooreadinit(void) 20 { 21 int i; /* channel number */ 22 int j; /* index into fds */ 23 /* Initialize read fd_set structure */ FD_ZERO (&readfds); 26 for (i=0, j=0; i < NUM_FDS; i++) 27 { 28 int fd; sprintf (channelname, %s%d, /dev/, i); 31 if ((fd = open(channelname, O_RDWR, 0))>=0) 32 { 33 fds[j++] = fd; 34 FD_SET (fd, &readfds); 35 width = max (fd, width); 36 } 37 } 38 width++; 39 return j; /* Number successfully opened */ 40 } select( ) A-6

7 select( ) Example, continued. 41 /************************************************* 42 * fooread - Service requests arriving over the 43 * nfds file descriptors in the fds[] array. 44 */ void fooread 47 ( 48 int nfds /* # file descriptors in fds[] */ 49 ) 50 { 51 int i; if (nfds <= 0) 54 exit (errno = S_fooLib_BAD_NFDS); /* Call select and wait for read activity */ 57 FOREVER 58 { 59 tmpfds = readfds; 60 if (select (width, &tmpfds, NULL,NULL,NULL) 61 == ERROR) 62 { 63 for (i=0; i < nfds; i++) 64 close (fds[i]); 65 exit (ERROR); 66 } 67 else 68 for (i=0; i < nfds; i++) 69 if (FD_ISSET (fds[i], &tmpfds)) 70 foodorequest (fds[i]); 71 } 72 } /************************************************ 75 * foodorequest - Read the null-terminated 76 * request,and send back the string 77 * You ve got to be kidding!\n 78 */ select( ) A-7

8 Demo Code - WindView Demo demotransfer.c 79 /* demotransfer.c - pass blocks between two tasks */ /* sloppy test program */ #include vxworks.h 84 #include msgqlib.h 85 #include stdlib.h 86 #include stdio.h 87 #include tasklib.h 88 #include wvutillib.h /* globals */ int senderdelayticks = 1; 94 int receiverdelayticks = 1; int sendtask = ERROR; 97 int receivetask = ERROR; int taskoptions = 0; 100 int taskstack = 10000; int senderpriority = 80; 103 int receiverpriority = 90; MSG_Q_ID transferq = NULL; int blk_size = 4096; 108 int QBlocks = 16; 109 int QOptions = MSG_Q_FIFO; BOOL transferstarted = FALSE; /* forward declarations */ void send1 (MSG_Q_ID mq); 116 void receive1 (MSG_Q_ID mq); void datawrite (char * pblock, size_t nbytes); select( ) A-8

9 119 void dataprocess (char * pblock, size_t nbytes); STATUS transferstart (void) 122 { 123 if (transferstarted) 124 return ERROR; transferq = msgqcreate (QBlocks, sizeof (char *), 127 QOptions); receivetask = 130 taskspawn ( trecv1, receiverpriority, 131 taskoptions, taskstack, 132 (FUNCPTR) receive1, (int) transferq, 133 0,0,0,0,0,0,0,0,0); sendtask = taskspawn ( tsend1, senderpriority, 136 taskoptions, taskstack, 137 (FUNCPTR) send1, (int) transferq, 138 0,0,0,0,0,0,0,0,0); transferstarted = TRUE; 141 return OK; 142 } STATUS transferstop (void) 145 { 146 if (!transferstarted) 147 return ERROR; msgqdelete (transferq); transferstarted = FALSE; 152 return OK; 153 } void send1 156 ( 157 MSG_Q_ID mq 158 ) 159 { 160 char * pch; FOREVER 163 { select( ) A-9

10 164 if ( (pch = (char *) malloc (blk_size)) 165 == NULL) 166 { 167 printf ( Out of memory in task %s.\n, 168 taskname(0)); 169 return; 170 } datawrite (pch, blk_size); if (msgqsend (mq, (char *)&pch, sizeof (pch), 175 WAIT_FOREVER, MSG_PRI_NORMAL) == ERROR) 176 { 177 printf ( msgqsend failed.\n ); 178 free (pch); 179 return; 180 } taskdelay (senderdelayticks); 183 } 184 } VOID receive1 187 ( 188 MSG_Q_ID mq 189 ) 190 { 191 char * pch; FOREVER 194 { 195 if (msgqreceive (mq, (char *) &pch, 196 sizeof (pch), WAIT_FOREVER) 197!= sizeof (pch)) 198 { 199 printf ( msgqreceive failed.\n ); 200 return; 201 } dataprocess (pch, blk_size); 204 free (pch); 205 } 206 } select( ) A-10

11 209 void datawrite 210 ( 211 char * pblock, 212 size_t nbytes 213 ) 214 { int * pi = (int *) pblock; 217 size_t nints = nbytes / 4; 218 int x = 0; 219 WV_EVT (1); 220 while (pi - (int *) pblock < nints) 221 *pi++ = x++; 222 WV_EVT (2); 223 } void dataprocess 226 ( 227 char* pblock, 228 size_t nbytes 229 ) 230 { 231 size_t nints = nbytes / 4; 232 int * pbeg = (int *) pblock; 233 int * pend = pbeg + (nints - 1); 234 int x; 235 WV_EVT (3); 236 while (pend > pbeg) 237 { 238 x = *pend; 239 *pend-- = *pbeg; 240 *pbeg++ = x; 241 } 242 WV_EVT (4); 243 } select( ) A-11

12 Demo Code - WindView Demo 1 wvutillib./* wvutillib.h - WindView utility macros */ 2 3 /* Copyright 1998, Inc. */ 4 5 /* 6 modification history a,03nov98,dlk written. 9 */ #ifndef INCwvUtilLibh 12 #define INCwvUtilLibh #include vxworks.h 15 #include wvlib.h 16 #include private/wvbufferp.h 17 #include private/wvuploadpathp.h 18 #include private/wvsockuploadpathlibp.h 19 #include private/eventp.h #ifdef cplusplus 22 extern C { 23 #endif /* cplusplus */ /* defines */ #ifdef WV_INSTR /************************************************** 33 * The default upload path depends on the components 34 * that are included : 35 * 36 * if (upload file is included) 37 * default upload path = file 38 * else if (TSFS socket is included) 39 * default upload path = TSFS socket 40 * else 41 * default upload path = socket 42 * select( ) A-12

13 43 * That is, the default upload path will be the LAST 44 * of the following which is included in the VxWorks 45 * configuration: 46 * 47 * TCP/IP socket upload path 48 * TSFS socket upload path 49 * File upload path 50 * 51 * (See usrwindviewinit() in prjconfig.c) If none of 52 * these are included, there is a configuration 53 * error. 54 * 55 * You can use the WV_START macro to start event 56 * log upload from your application. You can use the 57 * macro as follows, assuming that the default 58 * path is socket and that you want to upload to the 59 * host from which the target boots, and evtrecv or a 60 * graph is listening on the default port 6164: 61 * 62 * WV_START(WV_CLASS_3, sysboothost, 6164 ); 63 */ #define WV_START(evtClass, path, arg)\ 66 wvon(evtclass, path, arg, 0) #define WV_STOP\ 69 do {\ 70 if (wvevtbufferget())\ 71 wvoff();\ 72 } while (FALSE) #define WV_EVT(id) \ 75 wvevent ((id), (char *)NULL, 0) #define WV_EVT_STRING(id, str) \ 78 wvevent ((id), (char *)(str), strlen(str) + 1) #define WV_EVT_OBJ(id, obj) \ 81 wvevent ((id), (char *)&(obj), sizeof (obj)) #define WV_EVT_ARRAY(id, array) \ 84 wvevent ((id), (char *)(array), sizeof (array)) #define WV_INST_SEM(semId) \ 87 wvobjinst (OBJ_SEM, (semid), INSTRUMENT_ON) select( ) A-13

14 88 89 #define WV_INST_MSGQ(msgQId) \ 90 wvobjinst (OBJ_MSG, (msgqid), INSTRUMENT_ON) #define WV_INST_WDOG(wdogId) \ 93 wvobjinst (OBJ_WD, (wdogid), INSTRUMENT_ON) #define WV_INST_TASK(taskId) \ 96 wvobjinst (OBJ_TASK, (void *) (taskid), \ 97 INSTRUMENT_ON) #define WV_OBJ_INST_ON \ 100 wvobjinstmodeset (INSTRUMENT_ON) #define WV_OBJ_INST_OFF \ 103 wvobjinstmodeset (INSTRUMENT_OFF) #else /* WV_INSTR not defined */ #define WV_EVT(id) (void) OK 108 #define WV_EVT_STRING(id, str) (void) OK 109 #define WV_EVT_OBJ(id, obj) (void) OK 110 #define WV_EVT_ARRAY(id, array) (void) OK 111 #define WV_INST_SEM(semId) (void) OK 112 #define WV_INST_MSGQ(msgQId) (void) OK 113 #define WV_INST_WDOG(sdogId) (void) OK 114 #define WV_INST_TASK(taskId) (void) OK 115 #define WV_OBJ_INST_ON (void) OK 116 #define WV_OBJ_INST_OFF (void) OK 117 #define WV_START(evtClass, path, arg) (void) OK 118 #define WV_STOP #endif /* WV_INSTR */ 121 /* typedefs */ /* function declarations */ #ifdef cplusplus 126 } 127 #endif /* cplusplus */ #endif /* INCwvUtilLibh */ select( ) A-14