class OSCPlotter(object):
"""Set up OSC server and other handlers."""
def __init__(self, port, scope):
host="localhost"
logger.info( "Initializing server at %s:%d"%(host,port))
try:
self.m_oscserver = OSCServer( (host, port) )
except:
logger.fatal("System:Unable to create OSC handler at %s:%d"%(host,port),exc_info=True)
sys.exit(1)
self.m_oscserver.timeout = 0
self.m_oscserver.print_tracebacks = True
self.m_scope = scope
self.m_fnum = 0
# add a method to an instance of the class
self.m_oscserver.handle_timeout = types.MethodType(handle_timeout,self.m_oscserver)
# this registers a 'default' handler (for unmatched messages),
# an /'error' handler, an '/info' handler.
# And, if the client supports it, a '/subscribe' &
# '/unsubscribe' handler
self.m_oscserver.addDefaultHandlers()
self.m_oscserver.addMsgHandler("default", self.default_handler)
self.m_oscserver.addMsgHandler("/pf/frame", self.pf_frame)
# self.m_oscserver.addMsgHandler("/pf/update", self.pf_update)
self.m_oscserver.addMsgHandler("/conductor/attr", self.cond_attr)
def handle(self):
self.m_oscserver.handle_request()
def cond_attr(self, path, tags, args, source):
attr=args[0]
uid=args[1]
value=args[2]
logger.info("%d.%s=%f"%(uid,attr,value))
if attr=="kinetic":
self.m_scope.append(uid,self.m_fnum,value)
def pf_update(self, path, tags, args, source):
t=args[1]
uid=args[2]
x=args[3]
logger.debug("uid=%d,t=%f, x=%f"%(uid,t,x))
# self.m_scope.append(uid,t,x)
def pf_frame(self, path, tags, args, source):
self.m_fnum=args[0]
if self.m_fnum%5==0:
self.m_scope.update(self.m_fnum)
def default_handler(self, path, tags, args, source):
# logger.debug("got message for "+path+" with tags "+tags)
return None
def initOSCServer(ip='127.0.0.1', port=9001, mode=0) :
""" mode 0 for basic server, 1 for threading server, 2 for forking server
"""
global server, st
if mode == 0 :
server = OSCServer( (ip ,port) ) # basic
elif mode == 1 :
server = ThreadingOSCServer( (ip ,port) ) # threading
elif mode == 2 :
server = ForkingOSCServer( (ip ,port) ) # forking
server.addDefaultHandlers()
class OscServer:
def __init__(self, port, cbks=None):
self.server = OSCServer(("localhost", port))
self.server.addDefaultHandlers()
self.thread = threading.Thread(target=self.server.serve_forever)
if cbks is not None:
for path, cbk in cbks:
self.on_msg(path, cbk)
def on_msg(self, path, f):
def go_zero(path, tags, args, source):
f()
def go_args(path, tags, args, source):
f(*args)
if f.func_code.co_argcount == 0:
go = go_zero
else:
go = go_args
self.server.addMsgHandler(path, go)
def start(self):
self.thread.start()
try:
while 1:
time.sleep(10)
except KeyboardInterrupt:
print "\nClosing OSCServer."
self.server.close()
print "Waiting for Server-thread to finish"
self.thread.join()
print "Done"
def close(self):
self.server.close()
try:
self.thread.join()
except:
pass
print "Done"
class OscServer:
def __init__(self, port, cbks = None):
self.server = OSCServer( ("localhost", port) )
self.server.addDefaultHandlers()
self.thread = threading.Thread(target = self.server.serve_forever)
if cbks is not None:
for path, cbk in cbks:
self.on_msg(path, cbk)
def on_msg(self, path, f):
def go_zero(path, tags, args, source):
f()
def go_args(path, tags, args, source):
f(*args)
if f.func_code.co_argcount == 0:
go = go_zero
else:
go = go_args
self.server.addMsgHandler(path, go)
def start(self):
self.thread.start()
try :
while 1 :
time.sleep(10)
except KeyboardInterrupt :
print "\nClosing OSCServer."
self.server.close()
print "Waiting for Server-thread to finish"
self.thread.join()
print "Done"
def close(self):
self.server.close()
try:
self.thread.join()
except:
pass
print "Done"
def main():
#incoming(HOST,PORT)
server = OSCServer(('127.0.0.1',42003))
client = OSC.OSCClient()
client.connect(('127.0.0.1',42002))
server.addDefaultHandlers()
server.addMsgHandler("/exo/hand/gesture",handler_func)
st = threading.Thread( target = server.serve_forever )
st.start()
try :
while 1 :
time.sleep(10)
except KeyboardInterrupt :
print "\nClosing OSCServer."
s.close()
print "Waiting for Server-thread to finish"
st.join()
print "Done"
server.close()
class OSCHandler(object):
"""Set up OSC server and other handlers."""
def __init__(self, field):
self.m_field = field
self.m_server = OSCServer( (OSCHOST, OSCPORT) )
self.m_server.timeout = OSCTIMEOUT
self.m_run = True
self.m_xmin = 0
self.m_ymin = 0
self.m_xmax = 0
self.m_ymax = 0
self.eventfunc = {
'ping': self.event_tracking_ping,
'ack': self.event_tracking_ack,
'start': self.event_tracking_start,
'entry': self.event_tracking_entry,
'exit': self.event_tracking_exit,
'frame': self.event_tracking_frame,
'stop': self.event_tracking_stop,
'minx': self.event_tracking_set,
'miny': self.event_tracking_set,
'maxx': self.event_tracking_set,
'maxy': self.event_tracking_set,
'npeople': self.event_tracking_set,
'groupdist': self.event_tracking_set,
'ungroupdist': self.event_tracking_set,
'fps': self.event_tracking_set,
'update': self.event_tracking_update,
'leg': self.event_tracking_leg,
'body': self.event_tracking_body,
}
# add a method to an instance of the class
self.m_server.handle_timeout = types.MethodType(handle_timeout, self.m_server)
for i in self.eventfunc:
self.m_server.addMsgHandler(OSCPATH[i], self.eventfunc[i])
# this registers a 'default' handler (for unmatched messages),
# an /'error' handler, an '/info' handler.
# And, if the client supports it, a '/subscribe' &
# '/unsubscribe' handler
self.m_server.addDefaultHandlers()
self.m_server.addMsgHandler("default", self.default_handler)
# TODO: Handle errors from OSCServer
#self.m_server.addErrorHandlers()
#self.m_server.addMsgHandler("error", self.default_handler)
self.honey_im_home()
def honey_im_home(self):
"""Broadcast a hello message to the network."""
# TODO: Broadcast hello message
return True
def each_frame(self):
# clear timed_out flag
self.m_server.timed_out = False
# handle all pending requests then return
while not self.m_server.timed_out:
self.m_server.handle_request()
def user_callback(self, path, tags, args, source):
# which user will be determined by path:
# we just throw away all slashes and join together what's left
user = ''.join(path.split("/"))
# tags will contain 'fff'
# args is a OSCMessage with data
# source is where the message came from (in case you need to reply)
if dbug.LEV & dbug.MSGS: print ("Now do something with", user,args[2],args[0],1-args[1])
def quit_callback(self, path, tags, args, source):
# don't do this at home (or it'll quit blender)
self.m_run = False
# Event handlers
def default_handler(self, path, tags, args, source):
if dbug.LEV & dbug.MORE: print "OSC:default_handler:No handler registered for ", path
return None
def event_tracking_ping(self, path, tags, args, source):
if dbug.LEV & dbug.MSGS: print "OSC:event_ping:code",args[0]
return None
def event_tracking_ack(self, path, tags, args, source):
if dbug.LEV & dbug.MSGS: print "OSC:event_ack:code",args[0]
return None
def event_tracking_start(self, path, tags, args, source):
"""Tracking system is starting.
Sent before first /pf/update message for that target
args:
[ aparently no params now]
samp - sample number
t - time of sample (elapsed time in seconds since beginning of run)
target - UID of target
channel - channel number assigned
"""
#samp = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_start"
def event_tracking_set(self, path, tags, args, source):
"""Tracking subsystem is setting params.
Send value of various parameters.
args:
minx, miny, maxx, maxy - bounds of PF in units
npeople - number of people currently present
"""
if dbug.LEV & dbug.MSGS: print "OSC:event_set:",path,args,source
if path == OSCPATH['minx']:
self.m_xmin = int(100*args[0])
if dbug.LEV & dbug.MSGS: print "OSC:event_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmin_field=(self.m_xmin,self.m_field.m_ymin_field))
elif path == OSCPATH['miny']:
self.m_ymin = int(100*args[0])
if dbug.LEV & dbug.MSGS: print "OSC:event_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmin_field=(self.m_field.m_xmin_field,self.m_ymin))
elif path == OSCPATH['maxx']:
self.m_xmax = int(100*args[0])
if dbug.LEV & dbug.MSGS: print "OSC:event_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmax_field=(self.m_xmax,self.m_field.m_ymax_field))
elif path == OSCPATH['maxy']:
self.m_ymax = int(100*args[0])
if dbug.LEV & dbug.MSGS: print "OSC:event_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmax_field=(self.m_field.m_xmax_field,self.m_ymax))
elif path == OSCPATH['npeople']:
self.m_field.check_people_count(args[0])
return
elif path == OSCPATH['groupdist']:
self.m_field.update(groupdist=args[0])
return
elif path == OSCPATH['ungroupdist']:
self.m_field.update(ungroupdist=args[0])
return
elif path == OSCPATH['fps']:
self.m_field.update(oscfps=args[0])
return
#if self.m_xmin and self.m_ymin and self.m_xmax and self.m_ymax:
#print "set_scaling(",(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
#self.m_field.set_scaling((self.m_xmin,self.m_ymin),(self.m_xmax,self.m_ymax))
#self.m_field.updateScreen()
def event_tracking_entry(self, path, tags, args, source):
"""Event when person enters field.
Sent before first /pf/update message for that target
args:
samp - sample number
t - time of sample (elapsed time in seconds since
beginning of run)
target - UID of target
channel - channel number assigned
"""
#print "OSC:event_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
samp = args[0]
time = args[1]
id = args[2]
if dbug.LEV & dbug.MSGS: print "OSC:event_entry:cell:",id
self.m_field.create_cell(id)
def event_tracking_exit(self, path, tags, args, source):
"""Event when person exits field.
args:
samp - sample number
t - time of sample (elapsed time in seconds since beginning of run)
target - UID of target
"""
#print "OSC:event_exit:",path,args,source
samp = args[0]
time = args[1]
id = args[2]
if dbug.LEV & dbug.MSGS: print "OSC:event_exit:cell:",id
#print "BEFORE: cells:",self.m_field.m_cell_dict
#print "BEFORE: conx:",self.m_field.m_connector_dict
self.m_field.del_cell(id)
#print "AFTER: cells:",self.m_field.m_cell_dict
#print "AFTER: conx:",self.m_field.m_connector_dict
def event_tracking_body(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
samp - sample number
target - UID of target
x,y - position of person within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of person in m/s, heading in degrees
espd, eheading - SEM of spd, heading
facing - direction person is facing in degees
efacing - SEM of facing direction
diam - estimated mean diameter of legs
sigmadiam - estimated sigma (sqrt(variance)) of diameter
sep - estimated mean separation of legs
sigmasep - estimated sigma (sqrt(variance)) of sep
leftness - measure of how likely leg 0 is the left leg
visibility - number of frames since a fix was found for either leg
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = 0
samp = args[0]
id = args[1]
x = int(100*args[2]) # comes in meters, convert to cm
y = int(100*args[3])
ex = int(100*args[4])
ey = int(100*args[5])
spd = int(100*args[6])
heading = args[7]
espd = int(100*args[8])
eheading = args[9]
facing = args[10]
efacing = args[11]
diam = int(100*args[12])
sigmadiam = int(100*args[13])
sep = int(100*args[14])
sigmasep = int(100*args[15])
leftness = args[16]
vis = args[17]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS: print "OSC:event_body:no id",id,"in registered id list"
if samp%FREQ_REG_REPORT == 0:
if dbug.LEV & dbug.MSGS: print " OSC:event_body:id:",id,"pos:",(x,y)
self.m_field.update_body(id, x, y, ex, ey, spd, espd, facing, efacing,
diam, sigmadiam, sep, sigmasep, leftness, vis)
def event_tracking_leg(self, path, tags, args, source):
"""Information about individual leg movement within field.
Update position of leg.
args:
samp - sample number
id - UID of target
leg - leg number (0..nlegs-1)
nlegs - number of legs target is modeled with
x,y - position within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of leg in m/s, heading in degrees
espd, eheading - SEM of spd, heading
visibility - number of frames since a positive fix
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = 0
samp = args[0]
id = args[1]
leg = args[2]
nlegs = args[3]
x = int(100*args[4]) # comes in meters, convert to cm
y = int(100*args[5])
ex = int(100*args[6])
ey = int(100*args[7])
spd = int(100*args[8])
heading = args[9]
espd = int(100*args[10])
eheading = args[11]
vis = args[12]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS: print "OSC:event_leg:no id",id,"in registered id list"
if samp%FREQ_REG_REPORT == 0:
if dbug.LEV & dbug.MSGS: print " OSC:event_leg:id:",id,"leg:",leg,"pos:",(x,y)
self.m_field.update_leg(id, leg, nlegs, x, y, ex, ey, spd, espd,
heading, eheading, vis)
def event_tracking_update(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
samp - sample number
t - time of sample (elapsed time in seconds since beginning of run)
target - UID of target
x,y - position within field in units - increasing in value towards right and down
vx,vy - estimate of velocity in m/s
major,minor - major/minor axis size in m
groupid - id number of group
groupsize - number of people in group
channel - channel number assigned
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = 0
samp = args[0]
time = args[1]
id = args[2]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS: print "OSC:event_update:no id",id,"in registered id list"
x = int(100*args[3]) # comes in meters, convert to cm
y = int(100*args[4])
vx = int(100*args[5])
vy = int(100*args[6])
major = int(100*args[7]/2)
minor = int(100*args[8]/2)
gid = args[9]
gsize = args[10]
channel = args[11]
#print "OSC:event_update:",path,args,source
if samp%FREQ_REG_REPORT == 0:
#print "OSC:event_update:",path,args,source
if dbug.LEV & dbug.MSGS: print " OSC:event_update:id:",id,"pos:",(x,y),"axis:",major
#print "field.update_cell(",id,",",(x,y),",",major,")"
self.m_field.update_cell(id,(x,y),major)
#print "OSC:event_update: Done"
def event_tracking_frame(self, path, tags, args, source):
"""New frame event.
args:
samp - sample number
"""
#print "OSC:event_frame:",path,args,source
samp = args[0]
if samp%FREQ_REG_REPORT == 0:
#print "OSC:event_update:",path,args,source
if dbug.LEV & dbug.MSGS: print " OSC:event_frame::",samp
return None
def event_tracking_stop(self, path, tags, args, source):
"""Tracking has stopped."""
if dbug.LEV & dbug.MSGS: print "OSC:event_stop:",path,args,source
return None
colorWipe(strip, Color(b, r, g))
def hsv(addr, tags, stuff, source):
h, s, v = stuff
r, g, b = [int(c * 255) for c in colorsys.hsv_to_rgb(h, s, v)]
print(r, g, b)
colorWipe(strip, Color(b, r, g))
# assign server ip and port
server = OSCServer((server_ip, 9090))
# script start dialogue
print('Listening for incoming OSC messages...')
# message handlers
server.addDefaultHandlers() #for dealing with unmatched messages
server.addMsgHandler("/rgb", hsv)
# start thread
server_thread= Thread(target= server.serve_forever)
server_thread.daemon= True
server_thread.start()
# clean exit
try:
while True:
sleep(1)
except KeyboardInterrupt:
print 'Closing...'
server.close()
def serve(tree, wavdata, ps_correl_port, n_results, sc_synth_port, bus_num):
all_corrs = wavdata['all_corrs']
sample_times = wavdata['sample_times']
amps = wavdata['amp']
sc_synth_facing_server = OSCServer(("127.0.0.1", ps_correl_port))
sc_synth_client = sc_synth_facing_server.client
sc_synth_facing_server.addDefaultHandlers()
def transect_handler(osc_path=None, osc_tags=None, osc_args=None, osc_source=None):
node = osc_args[0]
idx = osc_args[1]
curr_amp = float(osc_args[2])
lookup = osc_args[3:] #ignores the amplitude
dists, indices = tree.query(lookup, k=n_results, return_distance=True)
dists = dists.flatten()
indices = indices.flatten()
print "hunting", lookup
times = sample_times[indices]
makeup_gains = (curr_amp/amps[indices])
# send scsynth bus messages
print "dispatching", bus_num, n_results*3, times, makeup_gains, dists
msg = OSCMessage("/c_setn", [bus_num, n_results*3])
#msg.extend()
msg.extend(times)
msg.extend(makeup_gains)
msg.extend(dists)
sc_synth_client.sendto(msg, ("127.0.0.1", sc_synth_port))
# This currently never gets called as pyOSC will ignore everything
# apart from the scsynth instance, in defiance of my understanding of UDP
# Need to set up an additional OSC server on a new port
# or somehow relay through scsynth
def quit_handler(path=None, tags=None, args=None, source=None):
print "quit", path, tags, args, source
sc_synth_facing_server.close()
def null_handler(path=None, tags=None, args=None, source=None):
pass
sc_synth_facing_server.addMsgHandler("/transect", transect_handler )
sc_synth_facing_server.addMsgHandler("/quit", quit_handler )
#sc_synth_facing_server.print_tracebacks = True
sc_synth_client.sendto(OSCMessage("/notify", 1),("127.0.0.1", sc_synth_port))
print sc_synth_facing_server.server_address, sc_synth_client.address(), sc_synth_facing_server.getOSCAddressSpace()
sc_synth_facing_server.running = True
# i = 0
# ptime = time.time()
# while True:
# i=i+1
# ntime = time.time()
# deltime = ntime - ptime
# if deltime>=1.0:
# print i, deltime
# ptime = ntime
# sc_synth_facing_server.handle_request()
# sc_lang_facing_server.handle_request()
#
# print "NOOOOOO"
# sc_synth_facing_server.close()
# sc_lang_facing_server.close()
return sc_synth_facing_server
class OSCHandler(object):
"""Set up OSC server and other handlers."""
def __init__(self, osc_server, osc_clients, field=None):
self.m_field = field
self.m_run = True
try:
(name, host, port) = osc_server[0]
except:
print "System:Unable to create OSC handler with server=", osc_server
sys.exit(1)
self.m_oscserver = OSCServer((host, port))
print "System:init server: %s:%s" % (host, port)
self.m_oscserver.timeout = OSCTIMEOUT
self.m_oscserver.print_tracebacks = True
self.m_osc_clients = {}
for i in range(len(osc_clients)):
(name, host, port) = osc_clients[i]
for j in range(i):
(oldname, oldhost, oldport) = osc_clients[j]
if host == oldhost and port == oldport:
self.m_osc_clients[name] = self.m_osc_clients[oldname]
print "System:init %s:same as %s" % (name, oldname)
break
if not name in self.m_osc_clients:
try:
self.m_osc_clients[name] = OSCClient()
except:
print "System:Unable to create OSC handler with client=", (
name, host, port)
self.m_osc_clients[name].connect((host, port))
print "System:init %s: %s:%s" % (name, host, port)
self.send_to(name, OSCPATH['ping'], [0])
self.m_xmin = 0
self.m_ymin = 0
self.m_xmax = 0
self.m_ymax = 0
"""
self.eventfunc = update({
# common
'ping': self.event_ping,
'ack': self.event_ack,
})
"""
self.eventfunc.update({
# common
'ping': self.event_ping,
'ack': self.event_ack,
# from tracker
'track_start': self.event_tracking_start,
'track_stop': self.event_tracking_stop,
'track_entry': self.event_tracking_entry,
'track_exit': self.event_tracking_exit,
'track_frame': self.event_tracking_frame,
'track_minx': self.event_tracking_set,
'track_miny': self.event_tracking_set,
'track_maxx': self.event_tracking_set,
'track_maxy': self.event_tracking_set,
'track_npeople': self.event_tracking_set,
'track_groupdist': self.event_tracking_set,
'track_ungroupdist': self.event_tracking_set,
'track_fps': self.event_tracking_set,
'track_update': self.event_tracking_update,
'track_leg': self.event_tracking_leg,
'track_body': self.event_tracking_body,
'track_group': self.event_tracking_group,
'track_geo': self.event_tracking_geo,
})
# add a method to an instance of the class
self.m_oscserver.handle_timeout = types.MethodType(
handle_timeout, self.m_oscserver)
# How to make this match partial paths?
# Esp /ui/cond/type/param match /ui/cond/
for i in self.eventfunc:
self.m_oscserver.addMsgHandler(OSCPATH[i], self.eventfunc[i])
# We are enumerating paths
# Esp /ui/cond/type/param match /ui/cond/
try:
for path in self.eventfunc_enum:
self.m_oscserver.addMsgHandler(path, self.eventfunc_enum[path])
except NameError:
pass
# this registers a 'default' handler (for unmatched messages),
# an /'error' handler, an '/info' handler.
# And, if the client supports it, a '/subscribe' &
# '/unsubscribe' handler
self.m_oscserver.addDefaultHandlers()
self.m_oscserver.addMsgHandler("default", self.default_handler)
# TODO: Handle errors from OSCServer
#self.m_oscserver.addErrorHandlers()
#self.m_oscserver.addMsgHandler("error", self.default_handler)
self.honey_im_home()
def each_frame(self):
# clear timed_out flag
self.m_oscserver.timed_out = False
# handle all pending requests then return
while not self.m_oscserver.timed_out:
self.m_oscserver.handle_request()
def user_callback(self, path, tags, args, source):
# which user will be determined by path:
# we just throw away all slashes and join together what's left
user = ''.join(path.split("/"))
# tags will contain 'fff'
# args is a OSCMessage with data
# source is where the message came from (in case you need to reply)
if dbug.LEV & dbug.MSGS:
print("Now do something with", user, args[2], args[0], 1 - args[1])
def quit_callback(self, path, tags, args, source):
# don't do this at home (or it'll quit blender)
self.m_run = False
#
# General OUTGOING
#
def send_to(self, clientkey, path, args):
"""Send OSC Message to one client."""
try:
self.m_osc_clients[clientkey].send(OSCMessage(path, args))
if (dbug.LEV & dbug.MSGS) and args:
print "OSC:Send to %s: %s %s" % (clientkey, path, args)
except:
if dbug.LEV & dbug.MSGS:
print "OSC:Send:Unable to reach host", clientkey
return False
return True
def send_laser(self, path, args):
"""Send OSC Message to one client."""
self.send_to('laser', path, args)
self.send_to('recorder', path, args)
def send_downstream(self, path, args):
"""Send OSC Message to one client."""
self.send_to('visual', path, args)
self.send_to('sound', path, args)
self.send_to('recorder', path, args)
self.send_to('laser', path, args)
def send_to_all_clients(self, path, args):
"""Broadcast to all the clients."""
for clientkey, client in self.m_osc_clients.iteritems():
self.send_to(clientkey, path, args)
def honey_im_home(self):
"""Broadcast a hello message to the network."""
pass
#
# General INCOMING
#
def default_handler(self, path, tags, args, source):
if dbug.LEV & dbug.MORE:
print "OSC:default_handler:No handler registered for ", path
return None
def event_ping(self, path, tags, args, source):
if len(args) < 1:
# Possibly ping from touchosc which doesn't include code
return
ping_code = args[0]
source_ip = source[0]
if dbug.LEV & dbug.MSGS:
print "OSC:ping from %s:code:%s" % (source_ip, ping_code)
for clientkey, client in self.m_osc_clients.iteritems():
target_ip = client.address()[0]
if target_ip == source_ip:
try:
self.sendto(clientkey, OSCPATH('ack'), ping_code)
except:
if dbug.LEV & dbug.MSGS:
print "OSC:event_ping:unable to ack to", clientkey
def event_ack(self, path, tags, args, source):
if dbug.LEV & dbug.MSGS: print "OSC:event_ack:code", args[0]
return None
#
# Tracking INCOMING
#
def event_tracking_start(self, path, tags, args, source):
"""Tracking system is starting.
Sent before first /pf/update message for that target
args:
no args
"""
#frame = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_start"
def event_tracking_set(self, path, tags, args, source):
"""Tracking subsystem is setting params.
Send value of various parameters.
args:
minx, miny, maxx, maxy - bounds of PF in units
npeople - number of people currently present
"""
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_set:", path, args, source
if path == OSCPATH['track_minx']:
self.m_xmin = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmin_field=(self.m_xmin,
self.m_field.m_ymin_field))
elif path == OSCPATH['track_miny']:
self.m_ymin = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmin_field=(self.m_field.m_xmin_field,
self.m_ymin))
elif path == OSCPATH['track_maxx']:
self.m_xmax = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmax_field=(self.m_xmax,
self.m_field.m_ymax_field))
elif path == OSCPATH['track_maxy']:
self.m_ymax = args[0]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_set:set_scaling(",\
(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
# we might not have everything yet, but we udate with what we have
self.m_field.set_scaling(pmax_field=(self.m_field.m_xmax_field,
self.m_ymax))
elif path == OSCPATH['track_npeople']:
self.m_field.check_people_count(args[0])
return
elif path == OSCPATH['track_groupdist']:
self.m_field.update(groupdist=args[0])
return
elif path == OSCPATH['track_ungroupdist']:
self.m_field.update(ungroupdist=args[0])
return
elif path == OSCPATH['track_fps']:
self.m_field.update(oscfps=args[0])
return
#if self.m_xmin and self.m_ymin and self.m_xmax and self.m_ymax:
#print "set_scaling(",(self.m_xmin,self.m_ymin),",",(self.m_xmax,self.m_ymax),")"
#self.m_field.set_scaling((self.m_xmin,self.m_ymin),(self.m_xmax,self.m_ymax))
#self.m_field.updateScreen()
def event_tracking_entry(self, path, tags, args, source):
"""Event when person enters field.
Sent before first /pf/update message for that target
args:
frame - frame number
t - time of frame (elapsed time in seconds since
beginning of run)
target - UID of target
channel - channel number assigned
"""
#print "OSC:event_track_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
frame = args[0]
time = args[1]
id = args[2]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_entry:cell:", id
self.m_field.create_cell(id)
def event_tracking_exit(self, path, tags, args, source):
"""Event when person exits field.
args:
frame - frame number
t - time of frame (elapsed time in seconds since beginning of run)
target - UID of target
"""
#print "OSC:event_track_exit:",path,args,source
frame = args[0]
time = args[1]
id = args[2]
if dbug.LEV & dbug.MSGS: print "OSC:event_track_exit:cell:", id
#print "BEFORE: cells:",self.m_field.m_cell_dict
#print "BEFORE: conx:",self.m_field.m_conx_dict
self.m_field.del_cell(id)
#print "AFTER: cells:",self.m_field.m_cell_dict
#print "AFTER: conx:",self.m_field.m_conx_dict
def event_tracking_body(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
frame - frame number
target - UID of target
x,y - position of person within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of person in m/s, heading in degrees
espd, eheading - SEM of spd, heading
facing - direction person is facing in degees
efacing - SEM of facing direction
diam - estimated mean diameter of legs
sigmadiam - estimated sigma (sqrt(variance)) of diameter
sep - estimated mean separation of legs
sigmasep - estimated sigma (sqrt(variance)) of sep
leftness - measure of how likely leg 0 is the left leg
visibility - number of frames since a fix was found for either leg
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
id = args[1]
x = args[2] # comes in meters
y = args[3]
ex = args[4]
ey = args[5]
spd = args[6]
heading = args[7]
espd = args[8]
eheading = args[9]
facing = args[10]
efacing = args[11]
diam = args[12]
sigmadiam = args[13]
sep = args[14]
sigmasep = args[15]
leftness = args[16]
vis = args[17]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_body:no uid", id, "in registered cell list"
if frame % REPORT_FREQ['debug'] == 0:
if dbug.LEV & dbug.MSGS:
print " OSC:event_track_body:id:",id,"pos:", (x, y), "data:", \
ex, ey, spd, espd, facing, efacing, diam, sigmadiam, \
sep, sigmasep, leftness, vis
self.m_field.update_body(id, x, y, ex, ey, spd, espd, facing, efacing,
diam, sigmadiam, sep, sigmasep, leftness, vis)
def event_tracking_leg(self, path, tags, args, source):
"""Information about individual leg movement within field.
Update position of leg.
args:
frame - frame number
id - UID of target
leg - leg number (0..nlegs-1)
nlegs - number of legs target is modeled with
x,y - position within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of leg in m/s, heading in degrees
espd, eheading - SEM of spd, heading
visibility - number of frames since a positive fix
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
id = args[1]
leg = args[2]
nlegs = args[3]
x = args[4] # comes in meters
y = args[5]
ex = args[6]
ey = args[7]
spd = args[8]
heading = args[9]
espd = args[10]
eheading = args[11]
vis = args[12]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_leg:no uid", id, "in registered cell list"
if frame % REPORT_FREQ['debug'] == 0:
if dbug.LEV & dbug.MSGS:
print " OSC:event_track_leg:id:", id, "leg:", leg, "pos:", (x,y), \
"data:", ex, ey, spd, espd, heading, eheading, vis
self.m_field.update_leg(id, leg, nlegs, x, y, ex, ey, spd, espd,
heading, eheading, vis)
def event_tracking_update(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
/pf/update frame t target x y vx vy major minor groupid groupsize channel
frame - frame number
t - time of frame (elapsed time in seconds)
target - UID of target, always increments
x,y - position within field in meters
vx,vy - estimate of velocity in m/s
major,minor - major/minor axis size in m
groupid - id number of group (0 if not in any group)
groupsize - number of people in group (including this person)
channel - channel number assigned
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
time = args[1]
id = args[2]
if id not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_update:no uid", id, "in registered cell list"
x = args[3] # comes in meters
y = args[4]
vx = args[5]
vy = args[6]
major = args[7]
minor = args[8]
gid = args[9]
gsize = args[10]
channel = args[11]
#print "OSC:event_track_update:",path,args,source
if frame % REPORT_FREQ['debug'] == 0:
#print "OSC:event_track_update:",path,args,source
if dbug.LEV & dbug.MSGS:
print " OSC:event_track_update:id:",id,"pos:", (x, y), "data:", \
vx, vy, major, minor, gid, gsize
self.m_field.update_cell(id,
x,
y,
vx,
vy,
major,
minor,
gid,
gsize,
frame=frame)
def event_tracking_group(self, path, tags, args, source):
"""Information about people's movement within field.
Update info about group
/pf/group frame gid gsize duration centroidX centroidY diameter
args:
frame - frame number
gid - group ID
gsize - number of people in group
duration - time since first formed in seconds
centroidX, centroidY - location of centroid of group
diameter - current diameter (mean distance from centroid)
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
gid = args[1]
gsize = args[2] # comes in meters
duration = args[3]
x = args[4]
y = args[5]
diam = args[6]
if gid not in self.m_field.m_group_dict:
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_group:no gid", gid, "in group list"
if frame % REPORT_FREQ['debug'] == 0:
if dbug.LEV & dbug.MSGS:
print " OSC:event_track_group:gid:",gid, "pos:", (x, y), "data:", \
gsize, duration, diam
self.m_field.update_group(gid, gsize, duration, x, y, diam)
def event_tracking_geo(self, path, tags, args, source):
"""Information about people's movement within field.
Update info about group
/pf/geo frame target fromcenter fromothers fromexit
args:
frame - frame number
uid - UID of target
fromcenter -target's distance from geographic center of everyone
fromnearest - target's distance from the nearest other person (-1 if nobody else)
fromexit - This person's distance from nearest exit from tracked area
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
uid = args[1]
fromcenter = args[2] # comes in meters
fromnearest = args[3]
fromexit = args[4]
if uid not in self.m_field.m_cell_dict:
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_geo:no uid", uid, "in registered cell list"
if frame % REPORT_FREQ['debug'] == 0:
if dbug.LEV & dbug.MSGS:
print " OSC:event_track_geo:uid:",uid, "data:", \
fromcenter, fromnearest, fromexit
self.m_field.update_geo(uid, fromcenter, fromnearest, fromexit)
def event_tracking_frame(self, path, tags, args, source):
"""New frame event.
args:
frame - frame number
"""
#print "OSC:event_track_frame:",path,args,source
frame = args[0]
self.m_field.update(frame=frame)
if frame % REPORT_FREQ['debug'] == 0:
#print "OSC:event_track_update:",frame
if dbug.LEV & dbug.MSGS: print " OSC:event_track_frame::", frame
return None
def event_tracking_stop(self, path, tags, args, source):
"""Tracking has stopped."""
if dbug.LEV & dbug.MSGS:
print "OSC:event_track_stop:", path, args, source
return None
def initOSCServer(ip='localhost', port=8885) :
global server, st
server = OSCServer( (ip ,port) ) # basic
server.addDefaultHandlers()
print server
class OSCHandler(object):
"""Set up OSC server and other handlers."""
def __init__(self, field=None, conductor=None):
self.m_conductor = conductor
self.cidkeys={}
self.lastcid=1
self.m_field = field
self.m_run = True
self.m_downClients={}
self.m_missingHandlers={}
self.m_xmin = 0
self.m_ymin = 0
self.m_xmax = 0
self.m_ymax = 0
self.m_health = 0
# Setup OSC server and clients
osc_server = []
osc_clients = []
for host in OSC_IPS:
if host == IAM:
logger.info("setting server for %s to %s: %s",host,OSC_IPS[host],OSC_PORTS[host])
osc_server = [('server', OSC_IPS[host], OSC_PORTS[host])]
elif host == 'localhost' or host == 'default':
continue
else:
logger.info("setting client for %s to %s:%s",host,OSC_IPS[host],OSC_PORTS[host])
osc_clients.append((host, OSC_IPS[host], OSC_PORTS[host]))
(name, host, port) = osc_server[0]
self.m_oscserver = OSCServer( (host, port) )
logger.info( "Initializing server at %s:%s",host, port)
self.m_oscserver.timeout = config.osctimeout
self.m_oscserver.print_tracebacks = True
self.m_osc_clients = {}
for i in range(len(osc_clients)):
(name, host, port) = osc_clients[i]
for j in range(i):
(oldname, oldhost, oldport) = osc_clients[j]
if host == oldhost and port == oldport:
self.m_osc_clients[name] = self.m_osc_clients[oldname]
logger.warning( "%s same as %s",name,oldname)
break
if not name in self.m_osc_clients:
try:
self.m_osc_clients[name] = OSCClient()
except socket.error:
logger.error( "Unable to create OSC handler for client %s at %s:%s",name,host,port,exc_info=True)
self.m_osc_clients[name].connect( (host, port) )
logger.info( "Connecting to %s at %s:%s",name,host,port)
self.send_to(name,"/ping",[0])
# common
self.m_oscserver.addMsgHandler("/ping",self.event_ping)
self.m_oscserver.addMsgHandler( "/ack",self.event_ack)
# from tracker
self.m_oscserver.addMsgHandler("/pf/started",self.event_tracking_start)
self.m_oscserver.addMsgHandler("/pf/stopped",self.event_tracking_stop)
self.m_oscserver.addMsgHandler("/pf/entry",self.event_tracking_entry)
self.m_oscserver.addMsgHandler("/pf/exit",self.event_tracking_exit)
self.m_oscserver.addMsgHandler("/pf/frame",self.event_tracking_frame)
self.m_oscserver.addMsgHandler("/pf/set/minx",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/miny",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/maxx",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/maxy",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/npeople",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/groupdist",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/ungroupdist",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/set/fps",self.event_tracking_set)
self.m_oscserver.addMsgHandler("/pf/update",self.event_tracking_update)
self.m_oscserver.addMsgHandler("/pf/leg",self.event_tracking_leg)
self.m_oscserver.addMsgHandler("/pf/body",self.event_tracking_body)
self.m_oscserver.addMsgHandler("/pf/group",self.event_tracking_group)
self.m_oscserver.addMsgHandler("/pf/geo",self.event_tracking_geo)
# to conductor
self.m_oscserver.addMsgHandler( "/conductor/dump",self.event_conduct_dump)
# global sensitivity for conx attr
self.m_oscserver.addMsgHandler( "/ui/condglobal",self.event_ui_condglobal)
# global sensitivity for cell attr
self.m_oscserver.addMsgHandler( "/ui/cellglobal",self.event_ui_cellglobal)
for atype in CELL_ATTR_TYPES + CONX_ATTR_TYPES:
for param in ("trigger", "memory", "maxage","qual","qualmin","qualmax"):
self.m_oscserver.addMsgHandler("/ui/cond/"+atype+"/"+param,self.event_ui_condparam)
# add a method to an instance of the class
self.m_oscserver.handle_timeout = types.MethodType(handle_timeout, self.m_oscserver)
# this registers a 'default' handler (for unmatched messages),
# an /'error' handler, an '/info' handler.
# And, if the client supports it, a '/subscribe' &
# '/unsubscribe' handler
self.m_oscserver.addDefaultHandlers()
self.m_oscserver.addMsgHandler("default", self.default_handler)
# TODO: Handle errors from OSCServer
#self.m_oscserver.addErrorHandlers()
#self.m_oscserver.addMsgHandler("error", self.default_handler)
self.honey_im_home()
def each_frame(self):
# clear timed_out flag
self.m_oscserver.timed_out = False
# handle all pending requests then return
while not self.m_oscserver.timed_out:
self.m_oscserver.handle_request()
def user_callback(self, path, tags, args, source):
# which user will be determined by path:
# we just throw away all slashes and join together what's left
user = ''.join(path.split("/"))
# tags will contain 'fff'
# args is a OSCMessage with data
# source is where the message came from (in case you need to reply)
logger.debug("user_callback( "+str(user)+" "+str(tags)+" "+str(args)+" "+str(source))
def quit_callback(self, path, tags, args, source):
# don't do this at home (or it'll quit blender)
self.m_run = False
#
# General OUTGOING
#
def send_to(self, clientkey, path, args):
"""Send OSC Message to one client."""
try:
self.m_osc_clients[clientkey].send(OSCMessage(path,args))
if args:
logger.debug( "Send to %s: %s %s" ,clientkey,path,args)
except:
lastError=self.m_downClients.get(clientkey,0)
if time()-lastError >30:
logger.warning("send_to: Unable to reach host %s (will suppress this warning for 30 seconds)",clientkey,exc_info=False)
self.m_downClients[clientkey]=time()
return False
return True
def send_laser(self, path, args):
"""Send OSC Message to one client."""
self.send_to('laser', path, args)
self.send_to('recorder', path, args)
def send_downstream(self, path, args):
"""Send OSC Message to one client."""
self.send_to('sound', path, args)
self.send_to('recorder', path, args)
self.send_to('laser', path, args)
def send_to_all_clients(self, path, args):
"""Broadcast to all the clients."""
for clientkey in self.m_osc_clients:
self.send_to(clientkey, path, args)
#
# General INCOMING
#
def default_handler(self, path, tags, args, source):
if not self.m_missingHandlers.get(path,False):
logger.warning( "default_handler:No handler registered for "+path)
self.m_missingHandlers[path]=True
return None
def event_ping(self, path, tags, args, source):
if len(args)<1:
# Possibly ping from touchosc which doesn't include code
return
ping_code = args[0]
source_ip = source[0]
logger.debug( "ping from %s:code:%s", source_ip, ping_code)
for clientkey, client in self.m_osc_clients.iteritems():
target_ip = client.address()[0]
if target_ip == source_ip:
self.send_to(clientkey, "/ack", ping_code)
def event_ack(self, path, tags, args, source):
logger.debug( "event_ack:code "+str(args[0]))
return None
#
# Tracking INCOMING
#
def event_tracking_start(self, path, tags, args, source):
"""Tracking system is starting.
Sent before first /pf/update message for that target
"""
logger.info( "event_track_start")
def event_tracking_set(self, path, tags, args, source):
"""Tracking subsystem is setting params.
Send value of various parameters.
args:
minx, miny, maxx, maxy - bounds of PF in units
npeople - number of people currently present
"""
logger.debug( "event_track_set:"+str(path)+" "+str(args)+" "+str(source))
if path =="/pf/set/minx":
self.m_xmin = args[0]
elif path == "/pf/set/miny":
self.m_ymin = args[0]
elif path == "/pf/set/maxx":
self.m_xmax = args[0]
elif path == "/pf/set/maxy":
self.m_ymax = args[0]
elif path == "/pf/set/npeople":
self.m_field.check_people_count(args[0])
elif path == "/pf/set/groupdist":
self.m_field.update(groupdist=args[0])
elif path == "/pf/set/ungroupdist":
self.m_field.update(ungroupdist=args[0])
elif path == "/pf/set/fps":
self.m_field.update(oscfps=args[0])
def event_tracking_entry(self, path, tags, args, source):
"""Event when person enters field.
Sent before first /pf/update message for that target
args:
frame - frame number
t - time of frame (elapsed time in seconds since
beginning of run)
target - UID of target
channel - channel number assigned
"""
#print "event_track_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
#frame = args[0]
#etime = args[1]
uid = args[2]
logging.getLogger("cells").info("entry of cell "+str(uid))
self.m_field.create_cell(uid)
def event_tracking_exit(self, path, tags, args, source):
"""Event when person exits field.
args:
frame - frame number
t - time of frame (elapsed time in seconds since beginning of run)
target - UID of target
"""
#print "event_track_exit:",path,args,source
#frame = args[0]
#etime = args[1]
uid = args[2]
logging.getLogger("cells").info("exit of cell "+str(uid))
#print "BEFORE: cells:",self.m_field.m_cell_dict
#print "BEFORE: conx:",self.m_field.m_conx_dict
self.m_field.del_cell(uid)
#print "AFTER: cells:",self.m_field.m_cell_dict
#print "AFTER: conx:",self.m_field.m_conx_dict
def event_tracking_body(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
frame - frame number
target - UID of target
x,y - position of person within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of person in m/s, heading in degrees
espd, eheading - SEM of spd, heading
facing - direction person is facing in degees
efacing - SEM of facing direction
diam - estimated mean diameter of legs
sigmadiam - estimated sigma (sqrt(variance)) of diameter
sep - estimated mean separation of legs
sigmasep - estimated sigma (sqrt(variance)) of sep
leftness - measure of how likely leg 0 is the left leg
visibility - number of frames since a fix was found for either leg
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
uid = args[1]
x = args[2] # comes in meters
y = args[3]
ex = args[4]
ey = args[5]
spd = args[6]
#heading = args[7]
espd = args[8]
#eheading = args[9]
facing = args[10]
efacing = args[11]
diam = args[12]
sigmadiam = args[13]
sep = args[14]
sigmasep = args[15]
leftness = args[16]
vis = args[17]
if uid not in self.m_field.m_cell_dict:
logger.info( "event_track_body:no uid "+str(uid)+" in registered cell list")
if frame%config.report_frequency['debug'] == 0:
logger.debug(" ".join([str(msgpart) for msgpart in [ " event_track_body:id:",uid,"pos:", (x, y), "data:",
ex, ey, spd, espd, facing, efacing, diam, sigmadiam,
sep, sigmasep, leftness, vis]]))
self.m_field.update_body(uid, x, y, ex, ey, spd, espd, facing, efacing,
diam, sigmadiam, sep, sigmasep, leftness, vis)
def event_tracking_leg(self, path, tags, args, source):
"""Information about individual leg movement within field.
Update position of leg.
args:
frame - frame number
id - UID of target
leg - leg number (0..nlegs-1)
nlegs - number of legs target is modeled with
x,y - position within field in m
ex,ey - standard error of measurement (SEM) of position, in meters
spd, heading - estimate of speed of leg in m/s, heading in degrees
espd, eheading - SEM of spd, heading
visibility - number of frames since a positive fix
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
uid = args[1]
leg = args[2]
nlegs = args[3]
x = args[4] # comes in meters
y = args[5]
ex = args[6]
ey = args[7]
spd = args[8]
heading = args[9]
espd = args[10]
eheading = args[11]
vis = args[12]
if uid not in self.m_field.m_cell_dict:
logger.info( "event_track_leg:no uid "+str(uid)+" in registered cell list")
if frame%config.report_frequency['debug'] == 0:
logger.debug(" ".join([str(msgpart) for msgpart in [" event_track_leg:id:", uid, "leg:", leg, "pos:", (x,y),
"data:", ex, ey, spd, espd, heading, eheading, vis]]))
self.m_field.update_leg(uid, leg, nlegs, x, y, ex, ey, spd, espd,
heading, eheading, vis)
def event_tracking_update(self, path, tags, args, source):
"""Information about people's movement within field.
Update position of target.
args:
/pf/update frame t target x y vx vy major minor groupid groupsize channel
frame - frame number
t - time of frame (elapsed time in seconds)
target - UID of target, always increments
x,y - position within field in meters
vx,vy - estimate of velocity in m/s
major,minor - major/minor axis size in m
groupid - id number of group (0 if not in any group)
groupsize - number of people in group (including this person)
channel - channel number assigned
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
# etime = args[1]
uid = args[2]
if uid not in self.m_field.m_cell_dict:
logger.info( "event_track_update:no uid "+str(uid)+" in registered cell list")
x = args[3] # comes in meters
y = args[4]
vx = args[5]
vy = args[6]
major = args[7]
minor = args[8]
gid = args[9]
gsize = args[10]
#channel = args[11]
#print "event_track_update:",path,args,source
if frame%config.report_frequency['debug'] == 0:
#print "event_track_update:",path,args,source
logger.debug(" ".join([str(msgpart) for msgpart in [ " event_track_update:id:",uid,"pos:", (x, y), "data:", \
vx, vy, major, minor, gid, gsize]]))
self.m_field.update_cell(uid, x, y, vx, vy, major, minor, gid, gsize,
frame=frame)
def event_tracking_group(self, path, tags, args, source):
"""Information about people's movement within field.
Update info about group
/pf/group frame gid gsize duration centroidX centroidY diameter
args:
frame - frame number
gid - group ID
gsize - number of people in group
duration - time since first formed in seconds
centroidX, centroidY - location of centroid of group
diameter - current diameter (mean distance from centroid)
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
#frame = args[0]
gid = args[1]
gsize = args[2] # comes in meters
duration = args[3]
x = args[4]
y = args[5]
diam = args[6]
if gid not in self.m_field.m_group_dict:
logger.info( "event_track_group:no gid "+str(gid)+" in group list")
# if frame%config.report_frequency['debug'] == 0:
logger.debug(" ".join([str(msgpart) for msgpart in [" event_track_group:gid:",gid, "pos:", (x, y), "data:",gsize, duration, diam]]))
self.m_field.update_group(gid, gsize, duration, x, y, diam)
def event_tracking_geo(self, path, tags, args, source):
"""Information about people's movement within field.
Update info about group
/pf/geo frame target fromcenter fromothers fromexit
args:
frame - frame number
uid - UID of target
fromcenter -target's distance from geographic center of everyone
fromnearest - target's distance from the nearest other person (-1 if nobody else)
fromexit - This person's distance from nearest exit from tracked area
"""
for index, item in enumerate(args):
if item == 'nan':
args[index] = None
frame = args[0]
uid = args[1]
fromcenter = args[2] # comes in meters
fromnearest = args[3]
fromexit = args[4]
if uid not in self.m_field.m_cell_dict:
logger.info("event_track_geo:no uid "+str(uid)+" in registered cell list")
if frame%config.report_frequency['debug'] == 0:
logger.debug(" ".join([str(x) for x in [" event_track_geo:uid:",uid, "data:",
fromcenter, fromnearest, fromexit]]))
self.m_field.update_geo(uid, fromcenter, fromnearest, fromexit)
def event_tracking_frame(self, path, tags, args, source):
"""New frame event.
args:
frame - frame number
"""
#print "event_track_frame:",path,args,source
frame = args[0]
self.m_field.update(frame=frame)
if frame%config.report_frequency['debug'] == 0:
logger.debug( "event_track_frame::"+str(frame))
return None
def event_tracking_stop(self, path, tags, args, source):
"""Tracking has stopped."""
logger.info(" ".join([str(x) for x in ["event_tracking_stop: ",path,args,source]]))
return None
def update(self, field=None, conductor=None):
self.m_field = field
self.m_conductor = conductor
#
# INCOMING to Conductor
#
def event_conduct_dump(self, path, tags, args, source):
source_ip = source[0]
logger.debug( "dump req:from"+str(source_ip))
for clientkey, client in self.m_osc_clients.iteritems():
target_ip = client.address()[0]
if target_ip == source_ip:
#TODO: Decide what we dump and dump it
#self.sendto(clientkey, '/ping', ping_code)
logger.debug( "dump to "+str(clientkey))
def event_ui_condglobal(self, path, tags, args, source):
"""Receive condglobal from UI.
Sent from UI.
args:
frame - frame number
cg - conx global
"""
#print "event_track_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
#frame = args[0]
cg = args[0]
logger.debug("event_ui_condglobal:cg ="+str(cg))
self.m_conductor.update(condglobal=cg)
def event_ui_cellglobal(self, path, tags, args, source):
"""Receive cellglobal from UI.
Sent from UI.
args:
frame - frame number
cg - cell global
"""
#print "event_track_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
#frame = args[0]
cg = args[0]
logger.debug("event_ui_cellglobal:cg ="+str(cg))
self.m_conductor.update(cellglobal=cg)
def event_ui_condparam(self, path, tags, args, source):
"""Receive condparam from UI.
Sent from UI.
args:
type - type of attr
param - conductor param
value - value to change to
"""
#print "event_track_entry:",path,args,source
#print "args:",args,args[0],args[1],args[2]
#frame = args[0]
pathsplit = path.split('/')
atype = pathsplit[len(pathsplit)-2]
param = pathsplit[len(pathsplit)-1]
value = args[0]
# if I received the type and attr as args, I'd use these 3 lines
#type = args[0]
#param = args[1]
#value = args[2]
logger.debug("event_ui_condparam: type=%s,param=%s,value=%.2f",atype,param,value)
if atype in CELL_ATTR_TYPES:
self.m_conductor.update_cell_param(atype,param, value)
elif atype in CONX_ATTR_TYPES:
self.m_conductor.update_conx_param(atype,param, value)
#
# OUTGOING from Conductor
#
# Startup
def honey_im_home(self):
"""Broadcast a hello message to the network."""
self.send_to_all_clients('/conductor/start',[])
# Regular Reports
def send_regular_reports(self):
"""Send all the reports that are send every cycle."""
frame = self.m_field.m_frame
if frame%config.report_frequency['rollcall'] == 0:
self.send_rollcall()
if frame%config.report_frequency['attrs'] == 0:
self.send_cell_attrs()
if frame%config.report_frequency['conxs'] == 0:
self.send_conx_attr()
if frame%config.report_frequency['gattrs'] == 0:
self.send_group_attrs()
if frame%config.report_frequency['uisettings'] == 0:
self.send_uisettings()
if frame%config.report_frequency['health'] == 0:
self.send_health()
def send_health(self):
self.m_field.m_osc.send_to("touchosc","/health/COND",self.m_health)
self.m_health=1-self.m_health
def send_uisettings(self):
#print "Sending ui settings"
fd=open("settings.py","w")
for key in config.connector_avg_triggers:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/trigger",config.connector_avg_triggers[key])
print >>fd,"config.connector_avg_triggers['"+key+"']=",config.connector_avg_triggers[key]
for key in config.connector_memory_time:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/memory",config.connector_memory_time[key])
print >>fd,"config.connector_memory_time['"+key+"']=",config.connector_memory_time[key]
for key in config.connector_max_age:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/maxage",config.connector_max_age[key])
print >>fd,"config.connector_max_age['"+key+"']=",config.connector_max_age[key]
for key in config.connector_qualifying_triggers:
if key.endswith("-min"):
k=key[:len(key)-4]
a="qualmin"
elif key.endswith("-max"):
k=key[:len(key)-4]
a="qualmax"
else:
k=key
a="qual"
# print "Setting ","/ui/cond/"+k+"/"+a+" to ", config.connector_qualifying_triggers[key]
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+k+"/"+a,config.connector_qualifying_triggers[key])
print >>fd,"config.connector_qualifying_triggers['"+key+"']=",config.connector_qualifying_triggers[key]
# Same for cells
for key in config.cell_avg_triggers:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/trigger",config.cell_avg_triggers[key])
print >>fd,"config.cell_avg_triggers['"+key+"']=",config.cell_avg_triggers[key]
for key in config.cell_memory_time:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/memory",config.cell_memory_time[key])
print >>fd,"config.cell_memory_time['"+key+"']=",config.cell_memory_time[key]
for key in config.cell_max_age:
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+key+"/maxage",config.cell_max_age[key])
print >>fd,"config.cell_max_age['"+key+"']=",config.cell_max_age[key]
for key in config.cell_qualifying_triggers:
if key.endswith("-min"):
k=key[:len(key)-4]
a="qualmin"
elif key.endswith("-max"):
k=key[:len(key)-4]
a="qualmax"
else:
k=key
a="qual"
# print "Setting ","/ui/cond/"+k+"/"+a+" to ", config.cell_qualifying_triggers[key]
self.m_field.m_osc.send_to("touchosc","/ui/cond/"+k+"/"+a,config.cell_qualifying_triggers[key])
print >>fd,"config.cell_qualifying_triggers['"+key+"']=",config.cell_qualifying_triggers[key]
fd.close()
def send_rollcall(self):
"""Sends the currently highlighted cells via OSC.
/conductor/rollcall [uid,action,numconx]
"""
for uid,cell in self.m_field.m_cell_dict.iteritems():
if cell.m_visible:
action = "visible"
else:
action = "hidden"
#TODO: Should the connector count only show visble connectors?
self.m_field.m_osc.send_downstream("/conductor/rollcall",[uid, action, len(cell.m_conx_dict)])
def send_cell_attrs(self):
"""Sends the current attributes of visible cells.
/conductor/attr ["type",uid,value,time]
"""
for uid, cell in self.m_field.m_cell_dict.iteritems():
if cell.m_visible:
for atype, attr in cell.m_attr_dict.iteritems():
duration = time() - attr.m_createtime
self.m_field.m_osc.send_downstream("/conductor/attr",
[atype, uid, attr.m_value, attr.m_freshness, duration])
def send_conx_attr(self):
"""Sends the current descriptions of connectors.
/conductor/conx [cid,"type",uid0,uid1,value,time]
"""
for cid,conx in self.m_field.m_conx_dict.iteritems():
if conx.m_cell0.m_visible and conx.m_cell1.m_visible:
for atype, attr in conx.m_attr_dict.iteritems():
duration = time() - attr.m_createtime
self.send_conx_downstream(cid, atype, conx.m_cell0.m_id,
conx.m_cell1.m_id, attr.m_value, attr.m_freshness,duration)
def send_group_attrs(self):
"""Sends the current attributes of visible groups.
/conductor/gattr ["type",gid,value,time]
"""
for gid,group in self.m_field.m_group_dict.iteritems():
if group.m_visible:
for atype,attr in group.m_attr_dict.iteritems():
duration = time() - attr.m_createtime
self.m_field.m_osc.send_downstream("/conductor/gattr",
[atype, gid, attr.m_value, attr.m_freshness,duration])
def send_event(self,event):
"""Sends notification of an event
"""
self.m_field.m_osc.send_downstream("/conductor/event",[event.m_type, event.m_id, event.m_uid0, event.m_uid1, event.m_value])
# On-Call Messages
def send_conx_downstream(self, cid, atype, uid0, uid1, value, freshness, duration):
key=cid+atype
if key not in self.cidkeys:
self.cidkeys[key]=self.lastcid
self.lastcid=self.lastcid+1
cc=self.cidkeys[key]
cid="%d"%cc
if atype in HAPPENING_TYPES:
logger.debug( "send:"+str( ["happening", atype, cid, uid0, uid1, value, duration]))
self.m_field.m_osc.send_downstream("/conductor/conx",
["happening", atype, cid, uid0, uid1, 1.0*value, 1.0*freshness, duration])
elif atype in EVENT_TYPES:
self.m_field.m_osc.send_downstream("/conductor/event",
[atype, cid, uid0, uid1, 1.0*value])
else:
self.m_field.m_osc.send_downstream("/conductor/conx",
["persistent", atype, cid, uid0, uid1, 1.0*value, 1.0*freshness, duration])
def nix_cell_attr(self, uid, atype):
"""Sends OSC messages to announce the removal of cell attr.
/conductor/attr ["type",uid,0.0,time]"""
if uid in self.m_field.m_cell_dict:
cell = self.m_field.m_cell_dict[uid]
if atype in cell.m_attr_dict:
attr = cell.m_attr_dict[atype]
duration = time() - attr.m_createtime
self.m_field.m_osc.send_downstream("/conductor/attr",
[atype, uid, attr.m_value,0.0, duration])
def nix_conx_attr(self, cid, atype):
"""Sends OSC messages to announce the removal of connection attr.
/conductor/conx ["type","subtype",cid,uid0,uid1,value,0.0,time]"""
if cid in self.m_field.m_conx_dict:
conx = self.m_field.m_conx_dict[cid]
if atype in conx.m_attr_dict:
attr = conx.m_attr_dict[atype]
duration = time() - attr.m_createtime
self.send_conx_downstream(cid, atype, conx.m_cell0.m_id,
conx.m_cell1.m_id, attr.m_value, 0.0,duration)
# TODO - FIXME - this is never called; do we need it at all?
def nix_conxs(self, cid):
"""Sends OSC messages to announce the removal of a connection.
/conductor/conxbreak [cid,uid0,uid1]
"""
if cid in self.m_field.m_conx_dict:
conx = self.m_field.m_conx_dict[cid]
for atype,attr in conx.m_attr_dict.iteritems():
duration = time() - attr.m_createtime
self.send_conx_downstream(cid, atype, conx.m_cell0.m_id,
conx.m_cell1.m_id, conx.m_value,0.0, duration)
self.m_field.m_osc.send_downstream("/conductor/conxbreak",
[cid, conx.m_cell0.m_id, conx.m_cell1.m_id])
