FreeCalypso > hg > freecalypso-sw
diff rvinterf/asyncshell/sendsp.c @ 875:dab341e172de
fc-shell: sysprim sending (sp command) implemented
author | Space Falcon <falcon@ivan.Harhan.ORG> |
---|---|
date | Sat, 30 May 2015 07:41:23 +0000 |
parents | |
children | bd873572ef2c |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/rvinterf/asyncshell/sendsp.c Sat May 30 07:41:23 2015 +0000 @@ -0,0 +1,76 @@ +/* + * Functions for sending GPF system primitives to the target + */ + +#include <sys/types.h> +#include <stdio.h> +#include <ctype.h> +#include <string.h> +#include <strings.h> +#include <stdlib.h> +#include "pktmux.h" +#include "limits.h" + +send_gpf_sysprim(stackdest, primstr) + char *stackdest, *primstr; +{ + unsigned intlen; + u_char sendpkt[MAX_PKT_TO_TARGET+1]; + unsigned pktlen; + + if (strlen(stackdest) > 4) { + printf( + "error: stack destination arg may not exceed 4 characters\n"); + return(1); + } + intlen = 12 + strlen(primstr); + pktlen = intlen + 4; + if (pktlen > MAX_PKT_TO_TARGET) { + printf("error: max pkt to target limit exceeded\n"); + return(1); + } + /* fill out the packet */ + sendpkt[0] = RVT_L23_HEADER; + sendpkt[1] = 0xB7; /* system prim */ + sendpkt[2] = intlen; + sendpkt[3] = intlen >> 8; + /* send zeros for the timestamp */ + sendpkt[4] = 0; + sendpkt[5] = 0; + sendpkt[6] = 0; + sendpkt[7] = 0; + /* as far as TI's sw is concerned, we are PCO */ + sendpkt[8] = 'P'; + sendpkt[9] = 'C'; + sendpkt[10] = 'O'; + sendpkt[11] = ' '; + sprintf(sendpkt + 12, "%-4s%s", stackdest, primstr); + /* send it! */ + send_pkt_to_target(sendpkt, pktlen); + return(0); +} + +void +cmd_sendsp(args) + char *args; +{ + char *cp, *np; + + for (cp = args; isspace(*cp); cp++) + ; + if (!*cp) { +err: printf("error: two arguments required\n"); + return; + } + for (np = cp; *cp && !isspace(*cp); cp++) + ; + if (!*cp) + goto err; + *cp++ = '\0'; + while (isspace(*cp)) + cp++; + if (!*cp) + goto err; + gpf_rx_control(1); + send_gpf_sysprim(np, cp); +}