Server: get_time command/response

[z180-stamp.git] / avr / z180-serv.c

diff --git a/avr/z180-serv.c b/avr/z180-serv.c
index bf49a6c7fb49332ff5c2bf878b8b31b1542a7275..c7869a68f310e0c38d484887e5488ec03ecf66ee 100644 (file)
--- a/avr/z180-serv.c
+++ b/avr/z180-serv.c
@@ -111,6 +111,16 @@ void do_msg_echo(uint8_t subf, int len, uint8_t * msg)
        msg_xmit(1, 3, len, 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);
+
+       msg_xmit(3, subf, sizeof(time_ms), (uint8_t *) &time_ms);
+}
+
 /* ---------------------------------------------------------------------------*/
 
 #define MAX_DRIVE      4
@@ -381,6 +391,9 @@ const FLASH struct msg_item z80_messages[] =
        { 2,
          1, 2,
          do_msg_cpm_rw},
+       { 3,
+         1, 1,
+         do_msg_get_timer},
        { 0xff,                         /* end mark */
          0, 0,
          0},