/* send an echo message: expect a reply */
int8_t rc_proto_send_echo_ans(uint64_t addr, void *data, uint8_t data_len,
- int8_t power)
+ int8_t power, uint16_t timestamp)
{
struct rc_proto_echo_ans hdr;
struct xbee_msg msg;
hdr.type = RC_PROTO_ECHO_ANS;
hdr.datalen = data_len;
+ hdr.timestamp = timestamp;
msg.iovlen = 2;
msg.iov[0].buf = &hdr;
stats.echo_req_rx++;
if (rc_proto_send_echo_ans(ntohll(recvframe->srcaddr),
- rce->data, rce->datalen, power) < 0)
+ rce->data, rce->datalen, power,
+ rce->timestamp) < 0)
return -1;
return 0;
printf_P(PSTR(" servo_tx: %"PRIu32"\r\n"), peer_stats.servo_tx);
printf_P(PSTR(" stats_rx: %"PRIu32"\r\n"), peer_stats.stats_rx);
printf_P(PSTR(" stats_tx: %"PRIu32"\r\n"), peer_stats.stats_tx);
- if (stats.echo_ans_rx != 0) {
+ if (peer_stats.echo_ans_rx != 0) {
printf_P(PSTR(" echo_ans_latency_ms: %"PRIu32"\r\n"),
peer_stats.echo_ans_latency_sum / peer_stats.echo_ans_rx);
}