From 0529f61465173366becf5ea71dacc210e2e60fcf Mon Sep 17 00:00:00 2001
From: Guenter  Geiger <ggeiger@users.sourceforge.net>
Date: Tue, 10 Jun 2003 20:32:14 +0000
Subject: time master code by klaus@epy.co.at

svn path=/trunk/externals/OSCx/; revision=693
---
 OSC/dumpOSC.c | 90 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++---
 1 file changed, 86 insertions(+), 4 deletions(-)

(limited to 'OSC/dumpOSC.c')

diff --git a/OSC/dumpOSC.c b/OSC/dumpOSC.c
index 1d82a2c..cbb4514 100644
--- a/OSC/dumpOSC.c
+++ b/OSC/dumpOSC.c
@@ -108,7 +108,7 @@ void sys_addpollfn(int fd, t_fdpollfn fn, void *ptr);
 	#include <signal.h>
 	#include <grp.h>
 	#include <sys/file.h>
-	#include <sys/prctl.h>
+	//#include <sys/prctl.h>
 
 	#ifdef NEED_SCHEDCTL_AND_LOCK
 	#include <sys/schedctl.h>
@@ -127,6 +127,8 @@ typedef struct ClientAddressStruct {
         int sockfd;
 } *ClientAddr;
 
+typedef unsigned long long osc_time_t;
+
 Boolean ShowBytes = FALSE;
 Boolean Silent = FALSE;
 
@@ -173,6 +175,7 @@ typedef struct _dumpOSC
 } t_dumpOSC;
 
 void dumpOSC_ParsePacket(t_dumpOSC *x, char *buf, int n, ClientAddr returnAddr);
+Boolean dumpOSC_SendReply(char *buf, int n, void *clientDesc, int clientDescLenght, int fd);
 static void dumpOSC_Smessage(t_dumpOSC *x, char *address, void *v, int n, ClientAddr returnAddr);
 static void dumpOSC_PrintTypeTaggedArgs(t_dumpOSC *x, void *v, int n);
 static void dumpOSC_PrintHeuristicallyTypeGuessedArgs(t_dumpOSC *x, void *v, int n, int skipComma);
@@ -213,8 +216,11 @@ static void dumpOSC_read(t_dumpOSC *x, int sockfd) {
 		#ifdef DEBUG
 		printf("dumpOSC_read: received UDP packet of length %d\n",  n);
 		#endif
-		dumpOSC_ParsePacket(x, mbuf, n, ra);
-
+		
+		if(!dumpOSC_SendReply(mbuf, n, &x->x_server, clilen, sockfd))
+		{
+			dumpOSC_ParsePacket(x, mbuf, n, ra);
+		}
 		//r = Synthmessage(mbuf, n, &x->x_server, clilen, sockfd);
 		//post ("%d", r);
 		//outlet_anything(x->x_msgout, at[msg].a_w.w_symbol,
@@ -490,6 +496,74 @@ void PrintClientAddr(ClientAddr CA) {
     printf("\n");
 }
 
+//*******************
+
+void WriteTime(char* dst, osc_time_t osctime)
+{
+	*(int32_t*)dst = htonl((int32_t)(osctime >> 32));
+	*(int32_t*)(dst+4) = htonl((int32_t)osctime);
+}
+
+void WriteMode(char* dst)
+{
+	*(int32_t*)dst = htonl(0);
+}
+
+osc_time_t ReadTime(const char* src)
+{
+  osc_time_t osctime = ntohl(*(int32_t*)src);
+  return (osctime << 32) + ntohl(*(int32_t*)(src+4));
+}
+
+double TimeToSeconds(osc_time_t osctime)
+{
+  return (double)osctime * 2.3283064365386962890625e-10 /* 1/2^32 */;
+}
+
+int timeRound(double x)
+{	
+	return x >= 0.0 ? x+0.5 : x-0.5;
+}
+
+void WriteLogicalTime(char* dst)
+{
+	double sTime = clock_gettimesince(19230720) / 1000.0;
+	double tau = sTime - timeRound(sTime);
+	
+	//fprintf(stderr, "sSec = %f tau = %f\n", sTime, tau);
+	
+	*(int32_t*)dst = htonl((int32_t)(sTime));
+	*(int32_t*)(dst+4) = htonl((int32_t)(4294967296 * tau));
+}
+
+Boolean dumpOSC_SendReply(char *buf, int n, void *clientDesc, int clientDescLenght, int fd)
+{
+	if((n == 24) && (strcmp(buf, "#time") == 0))
+	{		
+		osc_time_t t0, t1, t2;
+		double dt0, dt1, dt2;		
+
+		WriteMode(buf+6);
+		
+		t0 = ReadTime(buf+8);		
+		    
+		WriteLogicalTime(buf+16);
+		t1 = ReadTime(buf+16); // reverse
+		dt0 = TimeToSeconds(t0); // client time
+		dt1 = TimeToSeconds(t1); // server time	
+		
+		fprintf(stderr, "%f\t%f\t%f\n", dt0, dt1, dt0 - dt1);
+
+		sendto(fd, buf, n, 0, (struct sockaddr *)clientDesc, clientDescLenght);		
+		return TRUE;
+	}
+	else
+	{
+		return FALSE;
+	}
+}
+
+//**********************
 
 void dumpOSC_ParsePacket(t_dumpOSC *x, char *buf, int n, ClientAddr returnAddr) {
   //  t_dumpOSC *x;
@@ -553,7 +627,15 @@ void dumpOSC_ParsePacket(t_dumpOSC *x, char *buf, int n, ClientAddr returnAddr)
 			printf("]\n");
 		#endif
 
-  } else {
+  } 
+  else if ((n == 24) && (strcmp(buf, "#time") == 0))
+  {
+ 		complain("Time message: %s\n :).\n", htm_error_string);
+		return; 	
+
+  }
+  else
+  {
 		/* This is not a bundle message */
 
 		messageName = buf;
-- 
cgit v1.2.1