qi-hardware/antorcha
1
0
Fork 0
mirror of git://projects.qi-hardware.com/antorcha.git synced 2025-04-21 12:27:27 +03:00
Code Activity

properly implement "ping" and invoke it with antorcha -P

Browse Source
This commit is contained in:
Werner Almesberger
2012-06-20 11:31:56 -03:00
parent 823fdcfcb1
commit ea2cd37c04
3 changed files with 62 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
fw/dispatch.c
View File

@@ -14,7 +14,9 @@
#include <stddef.h>
#include <stdbool.h>
#include <stdint.h>
#include <string.h>
#include "version.h"
#include "rf.h"
#include "proto.h"
#include "dispatch.h"
@@ -36,11 +38,27 @@ static void send_ack(const uint8_t *buf)
static bool answer_ping(const uint8_t *buf)
{
uint8_t pong[] = { PONG, 0, 0 };
char num[6]; /* let's hope we won't need more than 9999 versions */
char *num_end = num+sizeof(num);
int date_len = strlen(build_date);
int num_len;
uint8_t pong[3] = { PONG, 0, 0 };
uint8_t tmp[3+6+date_len+1];
char *s;
int n;
if (buf[1])
return 0;
rf_send(pong, sizeof(pong));
s = num_end-1;
*s = ' ';
for (n = build_number; n; n /= 10)
*--s = '0'+n % 10;
*--s = '#';
num_len = num_end-s;
memcpy(tmp, pong, 3);
memcpy(tmp+3, s, num_len);
memcpy(tmp+3+num_len, build_date, date_len);
rf_send(tmp, 3+num_len+date_len);
return 1;
}