mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
112 lines
2.3 KiB
C
112 lines
2.3 KiB
C
/**
|
|
* Ping: low level ping pong
|
|
*
|
|
* Copyright (C) 2013, Igor Merkulow <igor.merkulow@gmail.com>
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU Lesser
|
|
* General Public License v2.1. See the file LICENSE in the top level
|
|
* directory for more details.
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* @author Igor Merkulow <igor.merkulow@gmail.com>
|
|
*
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include "thread.h"
|
|
#include "msg.h"
|
|
|
|
#include "cc110x/cc1100.h"
|
|
#include "lpc2387.h"
|
|
|
|
#include "vtimer.h"
|
|
#include "timex.h"
|
|
#include "gpioint.h"
|
|
#include "ping.h"
|
|
|
|
ping_payload *pipa;
|
|
protocol_t protocol_id = 0;
|
|
radio_address_t r_address = 0;
|
|
timex_t start = 0;
|
|
float rtt = 0;
|
|
|
|
void ping_handler(void *payload, int payload_size,
|
|
packet_info_t *packet_info)
|
|
{
|
|
pong(packet_info->phy_src);
|
|
}
|
|
|
|
void pong_handler(void *payload, int payload_size,
|
|
packet_info_t *packet_info)
|
|
{
|
|
calc_rtt();
|
|
print_success();
|
|
}
|
|
|
|
void pong(uint16_t src)
|
|
{
|
|
int trans_ok = cc1100_send_csmaca(src, protocol_id, 2, pipa->payload,
|
|
sizeof(pipa->payload));
|
|
|
|
if (trans_ok < 0) {
|
|
print_failed();
|
|
}
|
|
}
|
|
|
|
void ping_init(protocol_t protocol, uint8_t channr, radio_address_t addr)
|
|
{
|
|
protocol_id = protocol;
|
|
r_address = addr;
|
|
cc1100_set_packet_handler(protocol, ping_handler);
|
|
cc1100_set_channel(channr);
|
|
cc1100_set_address(r_address);
|
|
init_payload();
|
|
}
|
|
|
|
void ping(radio_address_t addr, uint8_t channr)
|
|
{
|
|
cc1100_set_packet_handler(protocol_id, pong_handler);
|
|
cc1100_set_channel(channr);
|
|
cc1100_set_address(r_address);
|
|
|
|
while (1) {
|
|
vtimer_now(&start);
|
|
int trans_ok = cc1100_send_csmaca(addr,
|
|
protocol_id, 2, pipa->payload, sizeof(pipa->payload));
|
|
|
|
if (trans_ok < 0) {
|
|
print_failed();
|
|
}
|
|
|
|
hwtimer_wait(HWTIMER_TICKS(500 * 1000));
|
|
}
|
|
}
|
|
|
|
void calc_rtt(void)
|
|
{
|
|
timex_t end;
|
|
vtimer_now(&end);
|
|
timex_t result = timex_sub(end, start);
|
|
|
|
rtt = result.seconds + (float)result.microseconds / (1000.0 * 1000.0);
|
|
}
|
|
|
|
void print_success(void)
|
|
{
|
|
printf("%s%f%s\n", "time=", rtt, "ms");
|
|
}
|
|
|
|
void print_failed(void)
|
|
{
|
|
printf("%s\n", "ping failed");
|
|
}
|
|
|
|
void init_payload(void)
|
|
{
|
|
pipa = malloc(sizeof(*pipa));
|
|
pipa->payload = NULL;
|
|
}
|