diff c/plosc.c @ 0:bbd2b1abfb32

Initial check in.

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/c/plosc.c	Wed Jan 11 15:30:21 2012 +0000
@@ -0,0 +1,860 @@
+/*
+ *  Copyright (C) 2009 Samer Abdallah
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or
+ *  (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ */
+
+#include <SWI-Stream.h>
+#include <SWI-Prolog.h>
+
+#include <stdio.h>
+#include <string.h>
+#include <math.h>
+#include <lo/lo.h>
+
+// ---------------------------------------------------------------------------
+
+// Reimplementation of lo_server_thread to all calls to
+// Prolog from the server thread.
+
+typedef struct _my_server_thread {
+	lo_server    s;
+	pthread_t    thread;
+	volatile int active;
+	volatile int done;
+} *my_server_thread;
+
+int my_server_thread_start(my_server_thread st);
+int my_server_thread_stop(my_server_thread st);
+int my_server_thread_run(my_server_thread st, int timeout);
+void my_server_thread_free(my_server_thread st);
+my_server_thread my_server_thread_new(const char *port, lo_err_handler err_h);
+
+// ---------------------------------------------------------------------------
+
+// BLOB to hold a lo_address
+static PL_blob_t addr_blob;
+
+// BLOB to hold server thread
+static PL_blob_t server_blob;
+
+static predicate_t call3, call5;
+static atom_t osc_immed;
+static functor_t osc_ts_2;
+static functor_t int_1, float_1, double_1, string_1;
+
+install_t install();
+
+foreign_t mk_address( term_t host, term_t port, term_t addr); 
+foreign_t is_address( term_t addr); 
+foreign_t send_osc_now( term_t addr, term_t msg, term_t args); 
+foreign_t send_osc_at( term_t addr, term_t msg, term_t args, term_t time); 
+foreign_t send_osc_from_at( term_t serv, term_t addr, term_t msg, term_t args, term_t time); 
+foreign_t send_timestamped( term_t addr, term_t msg, term_t args, term_t sec, term_t frac); 
+foreign_t now( term_t sec, term_t frac);
+foreign_t time_to_ts( term_t time, term_t sec, term_t frac);
+foreign_t time_from_ts( term_t time, term_t sec, term_t frac);
+
+// OSC server predicates
+foreign_t mk_server( term_t port, term_t server);
+foreign_t start_server( term_t server);
+foreign_t stop_server( term_t server);
+foreign_t del_handler( term_t server, term_t msg, term_t types);
+foreign_t add_handler( term_t server, term_t msg, term_t types, term_t handler);
+foreign_t add_handler_x( term_t server, term_t msg, term_t types, term_t handler);
+foreign_t run_server( term_t server);
+
+
+// BLOB functions
+int addr_release(atom_t a) {
+	PL_blob_t *type;
+	size_t    len;
+	void *p=PL_blob_data(a,&len,&type);
+	if (p) lo_address_free(*(lo_address *)p);
+	return TRUE;
+}
+
+int addr_write(IOSTREAM *s, atom_t a, int flags) {
+	PL_blob_t *type;
+	size_t    len;
+	lo_address *p=(lo_address *)PL_blob_data(a,&len,&type);
+	if (p) {
+		const char *host = lo_address_get_hostname(*p);
+		const char *port = lo_address_get_port(*p);
+		if (host!=NULL && port!=NULL) {
+			Sfprintf(s,"osc_address<%s:%s>",host,port);
+		} else {
+			Sfprintf(s,"osc_address<invalid>");
+		}
+	}
+	return TRUE;
+}
+
+int server_release(atom_t a) {
+	PL_blob_t *type;
+	size_t    len;
+	void *p=PL_blob_data(a,&len,&type);
+	if (p) my_server_thread_free(*(my_server_thread *)p);
+	return TRUE;
+}
+
+int server_write(IOSTREAM *s, atom_t a, int flags) {
+	PL_blob_t *type;
+	size_t    len;
+	my_server_thread *p=(my_server_thread *)PL_blob_data(a,&len,&type);
+	if (p) {
+		char *url=lo_server_get_url((*p)->s);
+		Sfprintf(s,"osc_server<%s>",url);
+		free(url);
+	}
+	return TRUE;
+}
+
+install_t install() { 
+	PL_register_foreign("osc_now",        2, (void *)now, 0);
+	PL_register_foreign("time_to_ts",     3, (void *)time_to_ts, 0);
+	PL_register_foreign("time_from_ts",   3, (void *)time_from_ts, 0);
+	PL_register_foreign("osc_mk_address", 3, (void *)mk_address, 0);
+	PL_register_foreign("osc_is_address", 1, (void *)is_address, 0);
+	PL_register_foreign("osc_send_now",   3, (void *)send_osc_now, 0);
+	PL_register_foreign("osc_send_at",    4, (void *)send_osc_at, 0);
+	PL_register_foreign("osc_send_from_at", 5, (void *)send_osc_from_at, 0);
+	PL_register_foreign("osc_mk_server",    2, (void *)mk_server, 0);
+	PL_register_foreign("osc_start_server", 1, (void *)start_server, 0);
+	PL_register_foreign("osc_stop_server",  1, (void *)stop_server, 0);
+	PL_register_foreign("osc_run_server",   1, (void *)run_server, 0);
+	PL_register_foreign("osc_del_method",   3, (void *)del_handler, 0);
+	PL_register_foreign("osc_add_method",   4, (void *)add_handler, 0);
+	PL_register_foreign("osc_add_method_x", 4, (void *)add_handler_x, 0);
+
+	addr_blob.magic = PL_BLOB_MAGIC;
+	addr_blob.flags = PL_BLOB_UNIQUE;
+	addr_blob.name = "osc_address";
+	addr_blob.acquire = 0;
+	addr_blob.release = addr_release;
+	addr_blob.write   = addr_write;
+	addr_blob.compare = 0; 
+
+	server_blob.magic = PL_BLOB_MAGIC;
+	server_blob.flags = PL_BLOB_UNIQUE;
+	server_blob.name = "osc_server";
+	server_blob.acquire = 0; 
+	server_blob.release = server_release;
+	server_blob.write   = server_write; 
+	server_blob.compare = 0; 
+
+	call3 = PL_predicate("call",3,"user");
+	call5 = PL_predicate("call",5,"user");
+	osc_immed = PL_new_atom("osc_immed");
+	osc_ts_2  = PL_new_functor(PL_new_atom("osc_ts"),2);
+	int_1     = PL_new_functor(PL_new_atom("int"),1);
+	float_1   = PL_new_functor(PL_new_atom("float"),1);
+	double_1  = PL_new_functor(PL_new_atom("double"),1);
+	string_1  = PL_new_functor(PL_new_atom("string"),1);
+}
+
+// throws a Prolog exception to signal type error
+static int type_error(term_t actual, const char *expected)
+{ 
+	term_t ex = PL_new_term_ref();
+	int rc;
+
+  rc = PL_unify_term(ex, PL_FUNCTOR_CHARS, "error", 2,
+		      PL_FUNCTOR_CHARS, "type_error", 2,
+		        PL_CHARS, expected,
+		        PL_TERM, actual,
+		      PL_VARIABLE);
+
+  return PL_raise_exception(ex);
+}
+
+static int osc_error(int errno, const char *errmsg, const char *msg)
+{ 
+	term_t ex = PL_new_term_ref();
+	int rc;
+
+  rc=PL_unify_term(ex, PL_FUNCTOR_CHARS, "error", 1,
+		      PL_FUNCTOR_CHARS, "osc_error", 3,
+		        PL_INTEGER, errno,
+		        PL_CHARS, errmsg,
+		        PL_CHARS, msg==NULL ? "none" : msg);
+
+  return PL_raise_exception(ex);
+}
+
+static int arg_error(const char *type, term_t arg)
+{ 
+	term_t ex = PL_new_term_ref();
+	int rc;
+
+  rc=PL_unify_term(ex, PL_FUNCTOR_CHARS, "error", 1,
+		      PL_FUNCTOR_CHARS, "arg_error", 2,
+		        PL_CHARS, type,
+		        PL_TERM, arg);
+
+  return PL_raise_exception(ex);
+}
+
+// put lo_address into a Prolog BLOB 
+static int unify_addr(term_t addr,lo_address a) {
+	return PL_unify_blob(addr, &a, sizeof(lo_address), &addr_blob); 
+}
+
+// get lo_address from BLOB
+static int get_addr(term_t addr, lo_address *a)
+{ 
+	PL_blob_t *type;
+	size_t    len;
+	lo_address *a1;
+  
+	PL_get_blob(addr, (void **)&a1, &len, &type);
+	if (type != &addr_blob) {
+		return type_error(addr, "osc_address");
+	} else {
+		*a=*a1;
+		return TRUE;
+	}
+} 
+
+// put lo_address into a Prolog BLOB 
+static int unify_server(term_t server,my_server_thread s) {
+	return PL_unify_blob(server, &s, sizeof(my_server_thread), &server_blob); 
+}
+
+// get my_server_thread from BLOB
+static int get_server(term_t server, my_server_thread *a)
+{ 
+	PL_blob_t *type;
+	size_t    len;
+	my_server_thread *a1;
+  
+	PL_get_blob(server, (void **)&a1, &len, &type);
+	if (type != &server_blob) {
+		return type_error(server, "osc_server");
+	} else {
+		*a=*a1;
+		return TRUE;
+	}
+} 
+
+// get Prolog (Unix) time value and convert to OSC timestamp
+static int get_prolog_time(term_t time, lo_timetag *ts) {
+	double t, ft;
+	int 	ok = PL_get_float(time, &t);
+
+	ft=floor(t);
+	ts->sec = ((uint32_t)ft)[phone]u;
+	ts->frac = (uint32_t)(4294967296.0*(t-ft));
+	return ok;
+}
+
+static int get_timetag(term_t sec, term_t frac, lo_timetag *ts) {
+	int64_t	s, f;
+	int 	ok = PL_get_int64(sec, &s) && PL_get_int64(frac, &f);
+	ts->sec = s;
+	ts->frac = f;
+	return ok;
+}
+
+
+static int get_msg(term_t msg, char **m) {
+	int rc=PL_get_chars(msg, m, CVT_ATOM | CVT_STRING);
+	if (rc && strcmp(*m,"any")==0) *m=NULL; 
+	return rc;
+}
+
+// parse a list of Prolog terms and add arguments to an OSC message 
+static int add_msg_args(lo_message msg, term_t list)
+{
+	term_t 	head=PL_new_term_ref();
+
+	// copy term ref so as not to modify original
+	list=PL_copy_term_ref(list);
+
+	while (PL_get_list(list,head,list)) {
+		atom_t name;
+		int	 rc, arity;
+		const char  *type;
+
+		if (!PL_get_name_arity(head,&name,&arity)) return type_error(head,"term");
+		type=PL_atom_chars(name);
+		switch (arity) {
+		case 1: {
+				term_t a1=PL_new_term_ref();
+				rc=PL_get_arg(1,head,a1); // !!!! check return value
+
+				if (!strcmp(type,"int")) {
+					int x;
+					if (!PL_get_integer(a1,&x)) return type_error(a1,"integer");
+					lo_message_add_int32(msg,x);
+				} else if (!strcmp(type,"double")) {
+					double x;
+					if (!PL_get_float(a1,&x)) return type_error(a1,"float");
+					lo_message_add_double(msg,x);
+				} else if (!strcmp(type,"string")) {
+					char *x;
+					if (!PL_get_chars(a1,&x,CVT_ATOM|CVT_STRING)) return type_error(a1,"string");
+					lo_message_add_string(msg,x);
+				} else if (!strcmp(type,"symbol")) {
+					char *x;
+					if (!PL_get_chars(a1,&x,CVT_ATOM)) return type_error(a1,"atom");
+					lo_message_add_symbol(msg,x);
+				} else if (!strcmp(type,"float")) {
+					double x;
+					if (!PL_get_float(a1,&x)) return type_error(a1,"float");
+					lo_message_add_float(msg,(float)x);
+				} else {
+					return arg_error(type,head);
+				}
+
+				break;
+			}
+		case 0: {
+				if (!strcmp(type,"true")) lo_message_add_true(msg);
+				else if (!strcmp(type,"false")) lo_message_add_false(msg);
+				else if (!strcmp(type,"nil")) lo_message_add_nil(msg);
+				else if (!strcmp(type,"inf")) lo_message_add_infinitum(msg);
+				break;
+			}
+		}
+	}
+	if (!PL_get_nil(list)) return type_error(list,"nil");
+	return TRUE;
+}
+
+static int send_msg_timestamped(lo_address a, lo_timetag *ts, char *path, term_t args)
+{
+	lo_message msg=lo_message_new();
+	lo_bundle  bun=lo_bundle_new(*ts);
+
+	if (add_msg_args(msg,args)) {
+		int ret;
+
+		lo_bundle_add_message(bun,path,msg);
+		ret = lo_send_bundle(a,bun);
+		lo_message_free(msg);
+		lo_bundle_free(bun);
+		if (ret==-1) {
+			return osc_error(lo_address_errno(a),lo_address_errstr(a),path);
+		} else {
+			return TRUE;
+		}
+	} else return FALSE;
+}
+
+static int send_msg_timestamped_from(lo_address a, lo_server s, lo_timetag *ts, char *path, term_t args)
+{
+	lo_message msg=lo_message_new();
+	lo_bundle  bun=lo_bundle_new(*ts);
+
+	if (add_msg_args(msg,args)) {
+		int ret;
+
+		lo_bundle_add_message(bun,path,msg);
+		ret = lo_send_bundle_from(a,s,bun);
+		lo_message_free(msg);
+		lo_bundle_free(bun);
+		if (ret==-1) {
+			return osc_error(lo_address_errno(a),lo_address_errstr(a),path);
+		} else {
+			return TRUE;
+		}
+	} else return FALSE;
+}
+
+static int send_msg(lo_address a, char *path, term_t args)
+{
+	lo_message msg=lo_message_new();
+
+	if (add_msg_args(msg,args)) {
+		if (lo_send_message(a,path,msg)==-1) {
+			lo_message_free(msg);
+			return osc_error(lo_address_errno(a),lo_address_errstr(a),path);
+		} else {
+			lo_message_free(msg);
+			return TRUE;
+		}
+	} else return FALSE;
+}
+
+foreign_t mk_address(term_t host, term_t port, term_t addr) { 
+	char *h, *p;
+
+	if (PL_get_chars(host, &h, CVT_ATOM | CVT_STRING)) {
+		if (PL_get_chars(port, &p, CVT_INTEGER)) {
+			lo_address a = lo_address_new(h,p);
+			return unify_addr(addr,a);
+		} else {
+			return type_error(port,"integer");
+		}
+	} else {
+		return type_error(host,"atom");
+	}
+}
+
+foreign_t now(term_t sec, term_t frac) { 
+	lo_timetag ts;
+	int64_t s, f;
+
+	lo_timetag_now(&ts);
+	s=ts.sec; f=ts.frac;
+	return PL_unify_int64(sec,s) && PL_unify_int64(frac,f);
+}
+
+foreign_t time_to_ts(term_t time, term_t sec, term_t frac) { 
+	lo_timetag ts;
+
+	return get_prolog_time(time,&ts) &&
+	       PL_unify_int64(sec,ts.sec) && 
+			 PL_unify_int64(frac,ts.frac);
+}
+
+foreign_t time_from_ts(term_t time, term_t sec, term_t frac) { 
+	lo_timetag ts;
+
+	return get_timetag(sec,frac,&ts) &&
+	  PL_unify_float(time, (double)(ts.sec-2208988800u) + ts.frac/4294967296.0);
+}
+
+
+
+// set current random state structure to values in Prolog term
+foreign_t is_address(term_t addr) { 
+	PL_blob_t *type;
+	return PL_is_blob(addr,&type) && type==&addr_blob;
+}
+
+foreign_t send_osc_from_at(term_t serv, term_t addr, term_t msg, term_t args, term_t time) {
+	my_server_thread s;
+	lo_address 	a;
+	lo_timetag  ts;
+	char			*m;
+
+	return get_addr(addr,&a) &&
+			get_server(serv,&s) &&
+			get_prolog_time(time,&ts) &&
+			get_msg(msg, &m) &&
+			send_msg_timestamped_from(a,s->s,&ts,m,args);
+}
+
+foreign_t send_osc_at(term_t addr, term_t msg, term_t args, term_t time) {
+	lo_address 	a;
+	lo_timetag  ts;
+	char			*m;
+
+	return get_addr(addr,&a) &&
+			get_prolog_time(time,&ts) &&
+			get_msg(msg, &m) &&
+			send_msg_timestamped(a,&ts,m,args);
+}
+
+foreign_t send_timestamped(term_t addr, term_t msg, term_t args, term_t secs, term_t frac) {
+	lo_address 	a;
+	lo_timetag  ts;
+	char			*m;
+
+	return get_addr(addr,&a) &&
+			get_timetag(secs,frac,&ts) &&
+			get_msg(msg, &m) &&
+			send_msg_timestamped(a,&ts,m,args);
+}
+
+
+
+foreign_t send_osc_now(term_t addr, term_t msg, term_t args) {
+	lo_address 	a;
+	char			*m;
+
+	return get_addr(addr,&a) &&
+			get_msg(msg, &m) &&
+			send_msg(a,m,args);
+}
+
+
+
+/* 
+ * Server Bits 
+ */
+
+static void prolog_thread_func(void *data);
+
+// parse a list of type terms and encode as a NULL terminated
+// string where each character encodes the type of one argument.
+static int get_types_list(term_t list, char *typespec, int len)
+{
+	term_t 	head=PL_new_term_ref();
+	int		count=0;
+
+	// copy term ref so as not to modify original
+	list=PL_copy_term_ref(list);
+
+	while (PL_get_list(list,head,list) && count<len) {
+		atom_t name;
+		int	 arity;
+		const char  *type;
+
+		if (!PL_get_name_arity(head,&name,&arity)) return type_error(head,"term");
+		type=PL_atom_chars(name);
+		switch (arity) {
+		case 1: {
+				if (!strcmp(type,"int")) {
+					typespec[count++]='i';
+				} else if (!strcmp(type,"double")) {
+					typespec[count++]='d';
+				} else if (!strcmp(type,"string")) {
+					typespec[count++]='s';
+				} else if (!strcmp(type,"symbol")) {
+					typespec[count++]='S';
+				} else if (!strcmp(type,"float")) {
+					typespec[count++]='f';
+				}
+				break;
+			}
+		case 0: {
+				if (!strcmp(type,"true")) typespec[count++]='T';
+				else if (!strcmp(type,"false")) typespec[count++]='F';
+				else if (!strcmp(type,"nil")) typespec[count++]='N';
+				else if (!strcmp(type,"inf")) typespec[count++]='I';
+				break;
+			}
+		}
+	}
+	typespec[count]=0;
+	if (!PL_get_nil(list)) return type_error(list,"nil");
+	return TRUE;
+}
+
+// parse a term representing argument types - types can be a list
+// as accepted by get_types_list() above or the atom 'any'
+static int get_types(term_t types, char *buffer, int len, char **typespec)
+{
+	if (PL_is_list(types)) {
+		*typespec=buffer;
+		return get_types_list(types,buffer,len);
+	} else if (PL_is_atom(types)) {
+		char *a;
+		if (PL_get_atom_chars(types,&a) && strcmp(a,"any")==0) { 
+			*typespec=NULL; return TRUE; 
+		} else return type_error(types,"list or 'any'");
+	} else return type_error(types,"list or 'any'");
+}
+
+// handler server error
+static void server_error(int num, const char *msg, const char *path) {
+	osc_error(num,msg,path);
+}
+
+// handle the /plosc/stop message for the synchronous server loop
+// in run_stoppable_server() and hence osc_run_server/1
+static int stop_handler(const char *path, const char *types, lo_arg **argv,
+		    int argc, lo_message msg, void *user_data) 
+{
+	my_server_thread s=(my_server_thread)user_data;
+	s->active=0;
+	return 1;
+}
+
+// get message arguments and unify given term with list of arg terms
+static int unify_msg_args(term_t list, const char *types, lo_arg **argv, int argc) 
+{
+	int i, rc=0;
+	for (i=0; i<argc; i++) {
+		term_t head=PL_new_term_ref();
+		term_t tail=PL_new_term_ref();
+		if (!PL_unify_list(list,head,tail)) PL_fail; 
+		switch (types[i]) {
+			case 'i': rc=PL_unify_term(head,PL_FUNCTOR, int_1,    PL_INT,argv[i]->i); break;
+			case 'f': rc=PL_unify_term(head,PL_FUNCTOR, float_1,  PL_FLOAT,(double)argv[i]->f); break;
+			case 'd': rc=PL_unify_term(head,PL_FUNCTOR, double_1, PL_DOUBLE,argv[i]->d); break;
+			case 's': rc=PL_unify_term(head,PL_FUNCTOR, string_1, PL_CHARS,&argv[i]->s); break;
+			case 'h': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"int64",1,PL_INT64,argv[i]->h); break;
+			case 'c': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"char",1,PL_INT,(int)argv[i]->c); break;
+			case 'S': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"symbol",1,PL_CHARS,&argv[i]->S); break;
+			case 'T': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"true",0); break;
+			case 'F': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"false",0); break;
+			case 'N': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"nil",0); break;
+			case 'I': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"inf",0); break;
+			case 'b': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"blob",0); break;
+			case 't': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"timetag",2,
+								PL_INT64,(int64_t)argv[i]->t.sec,
+								PL_INT64,(int64_t)argv[i]->t.frac); 
+						 break;
+			case 'm': rc=PL_unify_term(head,PL_FUNCTOR_CHARS,"midi",4,
+								PL_INT,(int)argv[i]->m[0], PL_INT,(int)argv[i]->m[1],
+								PL_INT,(int)argv[i]->m[2], PL_INT,(int)argv[i]->m[3]);
+						 break;
+		}
+		if (!rc) PL_fail;
+		list=tail;
+	}
+	return PL_unify_nil(list);
+}
+
+// handle OSC message by calling the associated Prolog goal
+static int prolog_handler(const char *path, const char *types, lo_arg **argv,
+		    int argc, lo_message msg, void *user_data) 
+{
+	term_t goal  = PL_new_term_ref();
+	term_t term0 = PL_new_term_refs(3);
+
+
+	PL_recorded((record_t)user_data,goal); // retrieve the goal term
+	PL_put_term(term0,goal); // term_t goal encoded in user_data
+	PL_put_atom_chars(term0+1,path);
+
+	return !( unify_msg_args(PL_copy_term_ref(term0+2),types,argv,argc) 
+	       && PL_call_predicate(NULL,PL_Q_NORMAL,call3,term0));
+}
+
+static int prolog_handler_x(const char *path, const char *types, lo_arg **argv,
+		    int argc, lo_message msg, void *user_data) 
+{
+	term_t goal  = PL_new_term_ref();
+	term_t term0 = PL_new_term_refs(5);
+	int rc=1;
+
+	lo_timetag ts = lo_message_get_timestamp(msg);
+	lo_address sender = lo_message_get_source(msg);
+	// printf("osc tt: %u s +  %u micros\n",ts.sec,ts.frac);
+
+	PL_recorded((record_t)user_data,goal); // retrieve the goal term
+	PL_put_term(term0,goal); // term_t goal encoded in user_data
+	PL_put_atom_chars(term0+3,path);
+
+	if (ts.sec==0u) PL_put_atom(term0+2,osc_immed);
+	else { 
+		rc=PL_unify_term( term0+2, PL_FUNCTOR, osc_ts_2, 
+				PL_INT64, (int64_t)ts.sec,
+				PL_INT64, (int64_t)ts.frac);
+	}
+	// PL_put_float(term0+2, (double)(ts.sec-2208988800u) + ts.frac/4294967296.0);
+
+	return !( rc
+	       && unify_addr(term0+1,sender)
+	       && unify_msg_args(PL_copy_term_ref(term0+4),types,argv,argc) 
+			 && PL_call_predicate(NULL,PL_Q_NORMAL,call5,term0));
+}
+
+/*
+static int generic_handler(const char *path, const char *types, lo_arg **argv,
+		    int argc, lo_message msg, void *user_data) 
+{
+	int i;
+
+	printf("path: <%s>\n", path);
+	for (i=0; i<argc; i++) {
+		printf("arg %d '%c' ", i, types[i]);
+		lo_arg_pp(types[i], argv[i]);
+		printf("\n");
+	}
+	printf("\n");
+	fflush(stdout);
+	return 1;
+}
+
+static int verbose_prolog_handler(const char *path, const char *types, lo_arg **argv,
+		    int argc, lo_message msg, void *user_data) 
+{
+	generic_handler(path,types,argv,argc,msg,user_data);
+	prolog_handler(path,types,argv,argc,msg,user_data);
+	return 1;
+}
+*/
+
+// run OSC server in this thread but with an extra message handler
+// to allow the /plosc/stop message to terminate the loop.
+static int run_stoppable_server(my_server_thread s, int timeout)
+{
+	lo_server_add_method(s->s, "/plosc/stop", NULL, stop_handler, (void *)s);
+	my_server_thread_run(s,timeout);
+	lo_server_del_method(s->s,"/plosc/stop",NULL);
+	return TRUE;
+}
+
+foreign_t mk_server(term_t port, term_t server)
+{
+	char *p;
+
+	if (PL_get_chars(port, &p, CVT_INTEGER)) {
+		my_server_thread s = my_server_thread_new(p, server_error);
+		if (s) return unify_server(server,s);
+		else return FALSE; 
+	} else {
+		return type_error(port,"integer");
+	}
+}
+
+foreign_t add_handler_x(term_t server, term_t msg, term_t types, term_t goal)
+{
+	my_server_thread s;
+	lo_method method;
+	char	*pattern, *typespec;
+	char	buffer[256]; // !! space for up to 255 arguments
+	int	rc;
+
+	rc = get_server(server,&s) 
+		&& get_msg(msg,&pattern) 
+		&& get_types(types,buffer,256,&typespec);
+
+	if (rc) {
+		record_t goal_record=PL_record(goal);
+		method = lo_server_add_method(s->s, pattern, typespec, prolog_handler_x, (void *)goal_record);
+	} 
+	return rc;
+}
+
+foreign_t add_handler(term_t server, term_t msg, term_t types, term_t goal)
+{
+	my_server_thread s;
+	lo_method method;
+	char	*pattern, *typespec;
+	char	buffer[256]; // !! space for up to 255 arguments
+	int	rc;
+
+	rc = get_server(server,&s) 
+		&& get_msg(msg,&pattern) 
+		&& get_types(types,buffer,256,&typespec);
+
+	if (rc) {
+		record_t goal_record=PL_record(goal);
+		method = lo_server_add_method(s->s, pattern, typespec, prolog_handler, (void *)goal_record);
+	} 
+	return rc;
+}
+
+foreign_t del_handler(term_t server, term_t msg, term_t types)
+{
+	my_server_thread s;
+	char	*pattern, *typespec;
+	char	buffer[256]; // !! space for up to 255 arguments
+	int	rc;
+
+	rc = get_server(server,&s) 
+		&& get_msg(msg,&pattern) 
+		&& get_types(types,buffer,256,&typespec);
+
+	if (rc) lo_server_del_method(s->s,pattern,typespec);
+	return rc;
+}
+
+foreign_t start_server( term_t server)
+{
+	my_server_thread s;
+	return get_server(server,&s) && (my_server_thread_start(s)==0);
+}
+
+foreign_t stop_server( term_t server)
+{
+	my_server_thread s;
+	return get_server(server,&s) && (my_server_thread_stop(s)==0);
+}
+
+foreign_t run_server( term_t server)
+{
+	my_server_thread s;
+	printf("running OSC server synchronously...\n");
+	return get_server(server,&s) && run_stoppable_server(s,10);
+}
+
+
+// -------------------------------------------------------------------------
+// my_server_thread implementation
+
+my_server_thread my_server_thread_new(const char *port, lo_err_handler err_h)
+{
+	my_server_thread st = malloc(sizeof(struct _my_server_thread));
+	st->s = lo_server_new(port, err_h);
+	st->active = 0;
+	st->done = 0;
+
+	if (!st->s) {
+		free(st);
+		return NULL;
+	}
+	return st;
+}
+
+void my_server_thread_free(my_server_thread st)
+{
+	if (st) {
+		if (st->active) {
+			my_server_thread_stop(st);
+		}
+		lo_server_free(st->s);
+	}
+	free(st);
+}
+
+int my_server_thread_stop(my_server_thread st)
+{
+	int result;
+
+	if (st->active) {
+		st->active = 0; // Signal thread to stop
+	
+		result = pthread_join( st->thread, NULL );
+		if (result) {
+			fprintf(stderr,"Failed to stop thread: pthread_join(), %s",strerror(result));
+			return -result;
+		}
+	}
+
+	return 0;
+}
+
+
+int my_server_thread_start(my_server_thread st)
+{
+	int result;
+
+	if (!st->active) {
+		st->active = 1;
+		st->done = 0;
+
+		// Create the server thread
+		result = pthread_create(&(st->thread), NULL, (void *)&prolog_thread_func, st);
+		if (result) {
+			  fprintf(stderr, "Failed to create thread: pthread_create(), %s",
+						 strerror(result));
+			  return -result;
+		}
+	
+	}
+    return 0;
+}
+
+int my_server_thread_run(my_server_thread st, int timeout)
+{
+	st->active = 1;
+	st->done = 0;
+	while (st->active) {
+		lo_server_recv_noblock(st->s, timeout);
+	}
+	st->done = 1;
+	return 0;
+}
+
+// code for the asynchronous server loop
+// we must create and attach a new Prolog engine to enable
+// calls to Prolog from this thread.
+static void prolog_thread_func(void *data)
+{
+	my_server_thread st = (my_server_thread)data;
+
+	printf("OSC server started.\n");
+	PL_thread_attach_engine(NULL);
+	my_server_thread_run(st,50);
+	PL_thread_destroy_engine(); 
+	printf("OSC server stopped.\n");
+	pthread_exit(NULL);
+}
+