zigbee_controller/display.c at master · miko53/zigbee_controller · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103

#include "display.h"
#include <stdio.h>
#include <assert.h>
#include "unused.h"

void display_decodedType(zigbee_decodedFrame* decodedData)
{
#ifdef TRACE_ACTIVATED
  assert(decodedData != NULL);

  fprintf(stdout, "decodedData.type = %.2x\n", decodedData->type);
  switch (decodedData->type)
  {
    case ZIGBEE_AT_COMMAND_RESPONSE:
      fprintf(stdout, "decodedData.atCmd.frameID = %d\n", decodedData->atCmd.frameID);
      fprintf(stdout, "decodedData.atCmd.ATcmd = %c %c\n", decodedData->atCmd.ATcmd[0], decodedData->atCmd.ATcmd[1]);
      fprintf(stdout, "decodedData.atCmd.status = 0x%x\n", decodedData->atCmd.status);
      fprintf(stdout, "decodedData.atCmd.data = %p\n", decodedData->atCmd.data);
      fprintf(stdout, "decodedData.atCmd.size = %d\n", decodedData->atCmd.size);
      for (uint32_t i = 0; i < decodedData->atCmd.size; i++)
      {
        fprintf(stdout, "%.2x ", decodedData->atCmd.data[i]);
      }
      fprintf(stdout, "\n");
      break;

    case ZIGBEE_TRANSMIT_STATUS:
      fprintf(stdout, "decodedData.transmitStatus.frameID = %d\n", decodedData->transmitStatus.frameID);
      fprintf(stdout, "decodedData.transmitStatus.destAddr = 0x%x\n", decodedData->transmitStatus.destAddr);
      fprintf(stdout, "decodedData.transmitStatus.transmitRetryCount = %d\n", decodedData->transmitStatus.transmitRetryCount);
      fprintf(stdout, "decodedData.transmitStatus.deliveryStatus = 0x%x\n", decodedData->transmitStatus.deliveryStatus);
      fprintf(stdout, "decodedData.transmitStatus.discoveryStatus = 0x%x\n", decodedData->transmitStatus.discoveryStatus);
      fprintf(stdout, "\n");
      break;

    case ZIGBEE_MODEM_STATUS:
      fprintf(stdout, "decodedData.modemStatus = %d\n", decodedData->modemStatus);
      break;

    case ZIGBEE_RECEIVE_PACKET:
      {
        uint32_t i;
        fprintf(stdout, "decodedData.receivedPacket.receiver64bAddr = ");
        for (i = 0; i < 8; i++)
        {
          fprintf(stdout, "0x%x, ", decodedData->receivedPacket.receiver64bAddr[i]);
        }
        fprintf(stdout, "\n");
        fprintf(stdout, "decodedData.receivedPacket.receiver16bAddr = 0x%x\n", decodedData->receivedPacket.receiver16bAddr);
        fprintf(stdout, "decodedData.receivedPacket.receiveOptions  = 0x%x\n", decodedData->receivedPacket.receiveOptions);
        fprintf(stdout, "decodedData.receivedPacket.payloadSize  = %d\n", decodedData->receivedPacket.payloadSize);
        fprintf(stdout, "decodedData.receivedPacket.payload  = %p\n", decodedData->receivedPacket.payload);
        if (decodedData->receivedPacket.payload != NULL)
        {
          fprintf(stdout, "payload = %s\n", decodedData->receivedPacket.payload);
          for (i = 0; i < decodedData->receivedPacket.payloadSize; i++)
          {
            fprintf(stdout, "0x%x, ", decodedData->receivedPacket.payload[i]);
          }
          fprintf(stdout, "\n");
        }
      }
      break;

    default:
      fprintf(stdout, "no known type\n");
      break;
  }
#else
  UNUSED(decodedData);
#endif /* TRACE_ACTIVATED */
}


void display_frame(char* displayTextHeader, uint8_t* frame, uint32_t size)
{
#ifdef TRACE_ACTIVATED
  bool bAtCommandResponse = false;
  fprintf(stdout, "(%s) frame : \n", displayTextHeader);
  for (uint32_t i = 0; i < size; i++)
  {
    if ((i == 3) && ((frame[i] == ZIGBEE_AT_COMMAND_RESPONSE) || (frame[i] == ZIGBEE_API_AT_CMD)))
    {
      bAtCommandResponse = true;
    }

    if ((bAtCommandResponse == true) && ((i == 5) || (i == 6)))
    {
      fprintf(stdout, "'%c' ", frame[i]);
    }
    else
    {
      fprintf(stdout, "%.2x ", frame[i]);
    }
  }
  fprintf(stdout, "\n");
#else
  UNUSED(displayTextHeader);
  UNUSED(frame);
  UNUSED(size);
#endif /* TRACE_ACTIVATED */
}