+++ /dev/null
-#include <stdio.h>
-#include <stdlib.h>
-
-#include "serialsource.h"
-
-static char *msgs[] = {
- "unknown_packet_type",
- "ack_timeout" ,
- "sync" ,
- "too_long" ,
- "too_short" ,
- "bad_sync" ,
- "bad_crc" ,
- "closed" ,
- "no_memory" ,
- "unix_error"
-};
-
-void stderr_msg(serial_source_msg problem)
-{
- fprintf(stderr, "Note: %s\n", msgs[problem]);
-}
-
-enum {
- TOS_SERIAL_802_15_4_ID = 2,
-};
-
-int main(int argc, char **argv)
-{
- serial_source src;
-
- if (argc != 3)
- {
- fprintf(stderr, "Usage: %s <device> <rate> - dump packets from a serial port\n", argv[0]);
- exit(2);
- }
- src = open_serial_source(argv[1], platform_baud_rate(argv[2]), 0, stderr_msg);
- if (!src)
- {
- fprintf(stderr, "Couldn't open serial port at %s:%s\n",
- argv[1], argv[2]);
- exit(1);
- }
- for (;;)
- {
- int len, i, plen;
- short fcf;
- const unsigned char *packet = read_serial_packet(src, &len);
- int intraPan = 0;
-
- if (!packet)
- exit(0);
- else if (packet[0] != TOS_SERIAL_802_15_4_ID) {
- printf("bad packet (serial type is %02x, not %02x)\n", packet[0], TOS_SERIAL_802_15_4_ID);
- }
-
- plen = packet[1];
- printf("Received packet of length %i: \n", plen);
- if (plen != len) {
- printf("Packet format error: read packet length (%hhx) is different than expected from frame (%hhx).\n", plen, len);
- }
-
- i = 2;
- // Read in FCF and i+=2
- fcf = packet[i+1] << 8 | packet[i];
- i += 2;
-
-
- {
- if ((fcf & 0x7) == 0x01) {
- printf(" Frame type: data\n");
- }
- else if ((fcf & 0x7) == 0x02) {
- printf(" Frame type: acknowledgement\n");
- }
- else {
- printf(" Frame type: other\n");
- }
-
- printf(" Security: %s\n", (fcf & (1 << 3)) ? "enabled":"disabled");
- printf(" Frame pending: %s\n", (fcf & (1 << 4)) ? "yes":"no");
- printf(" Ack request: %s\n", (fcf & (1 << 5)) ? "yes":"no");
- printf(" Intra-PAN: %s\n", (fcf & (1 << 6)) ? "yes":"no");
- intraPan = (fcf & (1 << 6));
- }
-
-
- {
- char seqno = packet[i++];
- printf(" Sequence number: %hhx\n", seqno);
- }
-
- {
- char addrLen = (fcf >> 10) & 0x3;
- short saddr = 0;
- long long laddr = 0;
-
- // 16- and 64-bit destinations have a PAN ID
- if (addrLen == 2 || addrLen == 3) {
- short destPan = packet[i++] << 8 | packet[i++];
- printf(" Destination PAN: %hx\n", destPan);
- }
-
- switch (addrLen) {
- case 0:
- printf(" Destination address: none\n");
- break;
- case 1:
- printf(" Destination address: invalid? (0x01)\n");
- break;
- case 2:
- saddr = (packet[i++] << 8 | packet[i++]);
- printf(" Destination address: %hx\n", saddr);
- break;
- case 3: {
- int j;
- for (j = 0; j < 8; j++) {
- laddr = laddr << 8;
- laddr |= packet[i++];
- }
- printf(" Destination address: %llx\n", laddr);
- break;
- }
- default:
- printf(" Destination address: parse serror\n");
- }
- }
-
-
- {
- char addrLen = (fcf >> 14) & 0x3;
- short saddr = 0;
- long long laddr = 0;
-
- if (!intraPan) { // Intra-PAN packet
- short srcPan = packet[i++] << 8 | packet[i++];
- printf(" Source PAN: %hx\n", srcPan);
- }
-
- switch (addrLen) {
- case 0:
- printf(" Source address: none\n");
- break;
- case 1:
- printf(" Source address: invalid? (0x01)\n");
- break;
- case 2:
- saddr = (packet[i++] << 8 | packet[i++]);
- printf(" Source address: %hx\n", saddr);
- break;
- case 3: {
- int j;
- for (j = 0; j < 8; j++) {
- laddr = laddr << 8;
- laddr |= packet[i++];
- }
- printf(" Source address: %llx\n", laddr);
- break;
- }
- default:
- printf(" Source address: parse serror\n");
- }
- }
-
- printf(" AM type: %hhx\n", packet[i++]);
-
- if (i >= plen) {
- printf("Packet format error: read packet is shorter than expected.\n");
- }
- else {
- printf(" Payload: ");
- for (; i < plen; i++) {
- printf("%hhx ", packet[i]);
- }
- printf("\n\n");
- putchar('\n');
- }
- free((void *)packet);
- }
-}