From a8eb521f94848a627a3fe470e34f62b13c157d34 Mon Sep 17 00:00:00 2001
From: Leo C
Date: Sat, 30 May 2015 11:47:03 +0200
Subject: return timestamp diff

---
 avr/z180-serv.c | 5 ++---
 1 file changed, 2 insertions(+), 3 deletions(-)

diff --git a/avr/z180-serv.c b/avr/z180-serv.c
index c7869a6..af1d8e0 100644
--- a/avr/z180-serv.c
+++ b/avr/z180-serv.c
@@ -114,10 +114,9 @@ void do_msg_echo(uint8_t subf, int len, uint8_t * msg)
 /* get timer */
 void do_msg_get_timer(uint8_t subf, int len, uint8_t * msg)
 {
-	(void)len; (void)msg;
-
-	uint32_t time_ms = get_timer(0);
+	uint32_t time_ms = (len >= 4) ? *(uint32_t *) msg : 0;
 
+	time_ms = get_timer(time_ms);
 	msg_xmit(3, subf, sizeof(time_ms), (uint8_t *) &time_ms);
 }
 
-- 
cgit v1.2.3