Sensix Wireless Sensor Network Middleware    Home    Project Page    Download    CVS  Hosted by

/home/brennan/Software/sensix/source/C^4/corba/gov/lanl/isr/sensix/TinyOSClient.java Go to the documentation of this file. /* * Copyright 2008. Los Alamos National Security, LLC. This material * was produced under U.S. Government contract DE-AC52-06NA25396 for * Los Alamos National Laboratory (LANL), which is operated by Los * Alamos National Security, LLC, for the Department of Energy. The * U.S. Government has rights to use, reproduce, and distribute this * software. NEITHER THE GOVERNMENT NOR LOS ALAMOS NATIONAL SECURITY, * LLC, MAKES ANY WARRANTY, EXPRESS OR IMPLIED, OR ASSUMES ANY LEGAL * LIABILITY FOR THE USE OF THIS SOFTWARE. If software is modified to * produce derivative works, such modified software should be clearly * marked, so as not to confuse it with the version available from LANL. * * Additionally, 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; version 2 of * the License. Accordingly, this program is distributed in the hope * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ package gov.lanl.isr.sensix; import java.net.*; import java.io.*; import java.util.*; import gov.lanl.isr.sensix.discovery.*; import gov.lanl.isr.sensix.sensing.*; import org.omg.CORBA.*; import org.omg.PortableServer.*; public class TinyOSClient extends RequestPOA implements Runnable, LevelOneClient, net.tinyos.message.MessageListener { class TosMessenger implements net.tinyos.util.Messenger { public void message(String message) { log(Logger.LOG.DEBUG, message); } } class TosProcessing extends Thread { private SensixMsg msg; private TinyOSClient tos; public TosProcessing(TinyOSClient t, SensixMsg m) { tos = t; msg = m; } public void run() { byte[] data = new byte[SensixMsg.DEFAULT_MESSAGE_SIZE]; for (int i = 0; i < data.length; i++) data[i] = (byte)msg.getElement_bytes(i); // parse header // note: not using SensixMarshalling here for detailed control boolean little_endian = false; if (data[0] != SensixMarshalling.MAGIC) return; if (data[1] != SensixMarshalling.VERSION) return; int wordsize = (data[2] & 0xff); if (wordsize >= SensixMarshalling.LITTLE_ENDIAN) { little_endian = true; wordsize &= (~SensixMarshalling.LITTLE_ENDIAN & 0xff); } int what = (data[3] & 0xff); int data_size = (data[4] & 0xff); // parse L1 discovery messages if (what == SensixMarshalling.METADATA) { int idx = SensixMarshalling.HEADER_SIZE; if (data[idx] != SenseCorba.DESCENDANTS) return; // ignore sibling/ancestor msgs idx += 2; byte[] id_bytes = new byte[wordsize]; System.arraycopy(data, idx, id_bytes, 0, wordsize); int node_id = 0; if (little_endian) node_id = DiscoveryService.b2i_le(id_bytes, wordsize); else node_id = DiscoveryService.b2i(id_bytes, wordsize); idx += wordsize; System.err.println("Metadata from " + node_id); int csize = (data[idx] & 0xff); idx++; for (int i = 0; i < csize; i++) { try { org.omg.CORBA.Object ref = tos.poa.servant_to_reference(tos); gov.lanl.isr.sensix.Request req = RequestHelper.narrow(ref); Share out = new Share(node_id, (byte)1, (byte)(data[idx + i] & 0xff), tos.orb.object_to_string(req)); discover.sendDiscovery(out); } catch (org.omg.CORBA.UserException e) { log(Logger.LOG.DEBUG, "CORBA exception on share"); } catch (java.lang.ArrayIndexOutOfBoundsException ae) { log(Logger.LOG.DEBUG, "Oversized capability array: " + csize); return; } } idx += csize; if (data[idx] != SenseCorba.ENERGY) return; idx++; byte[] energy_bytes = new byte[wordsize]; System.arraycopy(data, idx, energy_bytes, 0, wordsize); int energy = 0; if (little_endian) energy = DiscoveryService.b2i_le(energy_bytes, wordsize); else energy = DiscoveryService.b2i(energy_bytes, wordsize); idx += wordsize; marshal.xmit_metadata(SenseCorba.ANCESTORS); } // parse L1 data messages else if (what == SensixMarshalling.DATA) { log(Logger.LOG.DEBUG, "Processing data message"); int idx = SensixMarshalling.HEADER_SIZE; byte[] id_bytes = new byte[wordsize]; System.arraycopy(data, idx, id_bytes, 0, wordsize); int node_id = 0; if (little_endian) node_id = DiscoveryService.b2i_le(id_bytes, wordsize); else node_id = DiscoveryService.b2i(id_bytes, wordsize); idx += wordsize; if (data[idx] != SenseCorba.ENERGY) return; idx++; byte[] energy_bytes = new byte[wordsize]; System.arraycopy(data, idx, energy_bytes, 0, wordsize); double energy = 0; if (little_endian) energy = DiscoveryService.b2i_le(energy_bytes, wordsize); else energy = DiscoveryService.b2i(energy_bytes, wordsize); idx += wordsize; if (data[idx] != SenseCorba.TIME) return; idx++; byte[] time_bytes = new byte[wordsize]; System.arraycopy(data, idx, time_bytes, 0, wordsize); long time = 0; if (little_endian) time = DiscoveryService.b2i_le(time_bytes, wordsize); else time = DiscoveryService.b2i(time_bytes, wordsize); idx += wordsize; byte ftype = (byte)(data[idx] & 0xff); byte fid = (byte)(data[idx+1] & 0xff); idx += 2; byte[] count_bytes = new byte[wordsize]; System.arraycopy(data, idx, count_bytes, 0, wordsize); int num = 0; if (little_endian) num = DiscoveryService.b2i_le(count_bytes, wordsize); else num = DiscoveryService.b2i(count_bytes, wordsize); idx += wordsize; Data[] array = new Data[num]; for (int i = 0; i < num; i++) { byte[] res_bytes = new byte[wordsize]; System.arraycopy(data, idx, res_bytes, 0, wordsize); idx += wordsize; int result = 0; if (little_endian) result = DiscoveryService.b2i_le(res_bytes, wordsize); else result = DiscoveryService.b2i(res_bytes, wordsize); array[i] = new Data(); array[i].iresult(result); } TaskImpl task = track.tree.get((int)fid); if (task == null) return; Functor f = task.f(); if (f == null) return; Sensory target = SensoryHelper.narrow(f); target.energyused(energy + target.energyused()); if (time < target.timeused()) time = target.timeused(); target.timeused(time); target.results(array); task.callback().aggregate(target); } else log(Logger.LOG.DEBUG, "Dropping command message"); // ignore command messages from L1 } } protected Logger logger; protected DiscoveryService discover; protected SensixMarshalling marshal; protected ThreadGroup my_grp; protected SenseServer parent; protected String serial_port; protected Thread t; protected TaskTracking track; protected ORB orb; protected POA poa; protected String simulator; protected net.tinyos.message.MoteIF mote; public TinyOSClient(SenseServer serv, String app, byte debug, String sim) { this(serv, "/dev/ttyS0", app, debug, sim); } // Linux serial port default public TinyOSClient(SenseServer serv, String serial, String app, byte debug, String sim) { t = new Thread(new ThreadGroup("tinyos"), this, "tinyos_proc"); parent = serv; marshal = new SensixMarshalling(this, app, debug); discover = serv.discover; serial_port = serial; initLogger(app, debug); track = new TaskTracking(); orb = serv.orb; poa = serv.poa; simulator = sim; t.start(); } public void run() { // isolates child threads into our ThreadGroup my_grp = t.getThreadGroup(); startLevelOneInterface(); } public void startLevelOneInterface() { String default_baud = ":38400"; String portname = "serial@" + serial_port; if (portname.indexOf(':') == -1) portname += default_baud; if (simulator != "") portname = "tossim-radio@" + simulator; //"tossim-serial"; int group_id = 125; TosMessenger msgr = new TosMessenger(); net.tinyos.packet.PhoenixSource source = net.tinyos.packet.BuildSource.makePhoenix(portname, msgr); source.setResurrection(); mote = new net.tinyos.message.MoteIF(source, group_id); mote.registerListener(new SensixMsg(), this); mote.start(); log(Logger.LOG.DEBUG, "Spawning TinyOS interface at " + portname); } public void messageReceived(int dest, net.tinyos.message.Message m) { if (!(m instanceof SensixMsg)) return; SensixMsg msg = (SensixMsg)m; TosProcessing p = new TosProcessing(this, msg); p.start(); } public void initLogger(String app, byte debug_level) { logger = new Logger(app, debug_level); } public void log(Logger.LOG type, String msg) { logger.log(type, msg); } public void shutdown() { log(Logger.LOG.DEBUG, "TinyOS shutdown"); my_grp.interrupt(); // ensures clean exit } public int identity() { return discover.identifier(); } public DiscoveryService discovery() { return discover; } public double check_energy() { return 1.0; } public TaskTracking tracker() { return track; } public SortedMap<Byte,Capability> capabilities() { return parent.local_capabilities; } public org.omg.CORBA.ORB orb() { return orb; } public org.omg.PortableServer.POA poa() { return poa; } public void send_up(int what, int size, byte msg[]) { log(Logger.LOG.ERROR, "Interface error: invalid call to send_up"); } public void bcast(int what, int size, byte msg[]) { log(Logger.LOG.ERROR, "Interface error: invalid call to bcast"); } public void send_dn(int what, int size, byte msg[]) { byte[] hdr = marshal.load_header((byte)(what & 0xff), (byte)(size & 0xff)); short[] total = new short[size + SensixMarshalling.HEADER_SIZE]; SensixMarshalling.byte2short_arraycopy(hdr, 0, total, 0, SensixMarshalling.HEADER_SIZE); SensixMarshalling.byte2short_arraycopy(msg, 0, total, SensixMarshalling.HEADER_SIZE, size); if (mote != null) { try { SensixMsg sm = new SensixMsg(); for (int i = 0; i < total.length; i++) sm.setElement_bytes(i, total[i]); mote.send(net.tinyos.message.MoteIF.TOS_BCAST_ADDR, (net.tinyos.message.Message)sm); } catch (java.io.IOException e) { log(Logger.LOG.ERROR, "Error sending to TinyOS nodes: " + e); } } } public void addCapability(byte cap, Capability obj) { log(Logger.LOG.ERROR, "Invalid attempt to add " + SenseUtil.capabilityToString(cap) + " capability to TinyOS mote"); } public void apply(Functor funct, Response callback) { if (funct == null) { log(Logger.LOG.ERROR, "Apply on a null functor"); return; } TaskImpl task = new TaskImpl(null, funct, callback); log(Logger.LOG.DEBUG, "apply: " + funct.asString()); synchronized(this) { track.add(task); track.num_peers(funct, 1); marshal.xmit_command(funct); } } public synchronized void cancel(Functor funct) { if (funct == null) { log(Logger.LOG.ERROR, "Cancel on a null functor"); return; } log(Logger.LOG.DEBUG, "cancel: " + funct.asString()); track.cancelled(funct, true); track.remove(funct); } public void dataready(Functor funct) {} }

© 2008, Los Alamos National Security, LLC.