msg_xmit(1, 3, len, msg);
}
+/* get timer */
+void do_msg_get_timer(uint8_t subf, int len, uint8_t * msg)
+{
+ 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);
+}
+
/* ---------------------------------------------------------------------------*/
#define MAX_DRIVE 4
{ 2,
1, 2,
do_msg_cpm_rw},
+ { 3,
+ 1, 1,
+ do_msg_get_timer},
{ 0xff, /* end mark */
0, 0,
0},
pending = (Stat & S_MSG_PENDING) != 0;
Stat &= ~S_MSG_PENDING;
}
+/*
+ * TODO: if pending but no message chr --> special condition. ie init,...
+ */
if (pending) {
switch (state) {