X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/ad9bc17c8ecab1f0bbd26f2270d4d396f4bc5e52..845cbdbdd011f875219542dc5916f390cd952514:/avr/z180-serv.c

diff --git a/avr/z180-serv.c b/avr/z180-serv.c
index 7193495..0712d8d 100644
--- a/avr/z180-serv.c
+++ b/avr/z180-serv.c
@@ -19,7 +19,9 @@
 #include "print-utils.h"
 #include "z180-serv.h"
 #include "timer.h"
-
+#include "time.h"
+#include "bcd.h"
+#include "rtc.h"
 
 #define DEBUG_CPM_SDIO	0	/* set to 1 to debug */
 
@@ -122,6 +124,110 @@ void do_msg_get_timer(uint8_t subf, int len, uint8_t * msg)
 
 /* ---------------------------------------------------------------------------*/
 
+#define CPM_DAY_OFFSET ((1978-1900) * 365 + 19)		/* 19 leap years */
+
+/*
+ * Convert CP/M time stamp to a broken-down time structure
+ *
+ */
+int mk_date_time (int len, uint8_t *msg, struct tm *tmp)
+{
+	time_t stamp;
+
+	if (len != 5)
+		return -1;
+
+	/* days since 2000-01-01 */
+	long days = msg[3] + (msg[4] << 8) - 8036;
+
+	if (days < 0)
+		return -1;
+
+	stamp = days * ONE_DAY;
+	stamp += bcd2bin(msg[0]);
+	stamp += bcd2bin(msg[1]) * 60 ;
+	stamp += bcd2bin(msg[2]) * 3600;
+	gmtime_r(&stamp, tmp);
+	return 0;
+}
+
+void mk_cpm_time(struct tm *tmp, uint8_t cpm_time[5])
+{
+	uint16_t days = 1;
+	uint_fast8_t leap=2;
+
+	for (int year=78; year < tmp->tm_year; year++) {
+		days = days + 365 + (leap == 0);
+		leap = (leap+1)%4;
+	}
+	days += tmp->tm_yday;
+
+	cpm_time[0] = bin2bcd(tmp->tm_sec);
+	cpm_time[1] = bin2bcd(tmp->tm_min);
+	cpm_time[2] = bin2bcd(tmp->tm_hour);
+	cpm_time[3] = days;
+	cpm_time[4] = days >> 8;
+
+	debug("## mk_cpmtime: tm_year: %d, tm_yday: %d, days: %d\n",
+	tmp->tm_year, tmp->tm_yday, days);
+}
+
+/* get/set cp/m time */
+void do_msg_get_set_time(uint8_t subf, int len, uint8_t * msg)
+{
+	struct tm t;
+	uint8_t cpm_time[5];
+	int rc;
+
+	memset(cpm_time, 0, ARRAY_SIZE(cpm_time));
+
+	switch (subf) {
+	case 3:			/* set date & time */
+		/* initialize t with current time */
+		rc = rtc_get (&t);
+
+		if (rc == 0) {
+			/* insert new date & time */
+			if (mk_date_time (len, msg, &t) != 0) {
+				my_puts_P(PSTR("## set_time: Bad date format\n"));
+				break;
+			}
+
+			time_t time;
+			time = mk_gmtime(&t);
+			gmtime_r(&time, &t);
+
+			/* and write to RTC */
+			rc = rtc_set (&t);
+			if(rc)
+				my_puts_P(PSTR("## set_time: Set date failed\n"));
+		} else {
+			my_puts_P(PSTR("## set_time: Get date failed\n"));
+		}
+		/* FALL TROUGH */
+	case 2:			/* get date & time */
+		rc = rtc_get (&t);
+
+		if (rc) {
+			my_puts_P(PSTR("## get_time: Get date failed\n"));
+			break;
+		}
+
+		time_t time;
+		time = mk_gmtime(&t);
+		//mktime(&t);
+		gmtime_r(&time, &t);
+
+
+		mk_cpm_time(&t, cpm_time);
+		break;
+	}
+
+	msg_xmit(3, subf, sizeof(cpm_time), cpm_time);
+}
+
+/* ---------------------------------------------------------------------------*/
+
 #define MAX_DRIVE	4
 #define BLOCK_SIZE	512
 #define TPA_BASE	0x10000
@@ -393,6 +499,9 @@ const FLASH struct msg_item z80_messages[] =
 	{ 3,
 	  1, 1,
 	  do_msg_get_timer},
+	{ 3,
+	  2, 3,				/* 2: get, 3: set time and date */
+	  do_msg_get_set_time},
 	{ 0xff,				/* end mark */
 	  0, 0,
 	  0},
@@ -550,6 +659,7 @@ void restart_z180_serv(void)
 
 }
 
+#if 0
 /*--------------------------------------------------------------------------*/
 
 const FLASH uint8_t iniprog[] = {
@@ -601,3 +711,4 @@ const FLASH uint8_t test1[] = {
 	0x00,              //	db	0		;dst
 	0x00, 0x00,        //	dw 	0		;count (64k)
 };
+#endif