예제 #1
0
int main(int argc, char **argv)
{
  int fd,i;

  if (argc != 3) {
    fprintf(stderr, "Usage: %s <host> <port> - print received packets\n", argv[0]);
    exit(2);
  }

  fd = open_sf_source(argv[1], atoi(argv[2]));

  if (fd < 0) {
    fprintf(stderr, "Couldn't open serial forwarder at %s:%s\n",
	    argv[1], argv[2]);
    exit(1);
  }

  for (;;) {
    int len, i;
    const unsigned char *packet = read_sf_packet(fd, &len);
    char* myPacket = (char*)malloc(len);
    memcpy(myPacket, packet, len);
    free((void*)packet);

    if (!packet)
      exit(0);
    else {
      tmsg_t* serialMsg = new_tmsg(myPacket, len);
      void* payload = (void*)myPacket + (spacket_data_offsetbits(0) / 8);
      tmsg_t* dataMsg = new_tmsg(payload, len - SPACKET_SIZE);
      void* data = payload + (dissemination_message_data_offsetbits(0) / 8);


      for (i = 0; i < len; i++)
	printf("%02x ", packet[i]);
      putchar('\n');
      fflush(stdout);
      free((void *)myPacket);
    }
  }
}
예제 #2
0
uint8_t spacket_data_get(tmsg_t *msg, size_t index1)
{
	return tmsg_read_ube(msg, spacket_data_offsetbits(index1), 8);
}
예제 #3
0
void spacket_data_set(tmsg_t *msg, size_t index1, uint8_t value)
{
	tmsg_write_ube(msg, spacket_data_offsetbits(index1), 8, value);
}
예제 #4
0
size_t spacket_data_offset(size_t index1)
{
	return spacket_data_offsetbits(index1) / 8;
}