Server: get_time command/responsehexrel-6.1

1 files changed, 13 insertions, 0 deletions

diff --git a/avr/z180-serv.c b/avr/z180-serv.c
index bf49a6c..c7869a6 100644
--- 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},