/*
* Copyright (c) 2008, Swedish Institute of Computer Science.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of the Institute nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $Id: NativeIPGateway.java,v 1.4 2009/04/23 08:59:22 fros4943 Exp $
*/
package se.sics.cooja.plugins;
import java.awt.BorderLayout;
import java.awt.Component;
import java.awt.Dimension;
import java.awt.event.ActionEvent;
import java.awt.event.ActionListener;
import java.awt.event.ItemEvent;
import java.awt.event.ItemListener;
import java.util.Collection;
import java.util.Observable;
import java.util.Observer;
import java.util.Vector;
import java.io.*;
import javax.swing.BorderFactory;
import javax.swing.Box;
import javax.swing.BoxLayout;
import javax.swing.JCheckBox;
import javax.swing.JComboBox;
import javax.swing.JInternalFrame;
import javax.swing.JLabel;
import javax.swing.JPanel;
import javax.swing.JScrollPane;
import javax.swing.event.InternalFrameEvent;
import javax.swing.event.InternalFrameListener;
import jpcap.JpcapCaptor;
import jpcap.JpcapSender;
import jpcap.NetworkInterface;
import jpcap.packet.EthernetPacket;
import jpcap.packet.IPPacket;
import org.apache.log4j.Logger;
import org.jdom.Element;
import se.sics.cooja.ClassDescription;
import se.sics.cooja.GUI;
import se.sics.cooja.Mote;
import se.sics.cooja.Plugin;
import se.sics.cooja.PluginType;
import se.sics.cooja.Simulation;
import se.sics.cooja.interfaces.SerialPort;
import se.sics.cooja.util.StringUtils;
@ClassDescription("Open Native IP Gateway")
@PluginType(PluginType.MOTE_PLUGIN)
public class NativeIPGateway implements Plugin {
private static Logger logger = Logger.getLogger(NativeIPGateway.class);
private static final long serialVersionUID = 1L;
private final static int IP_HEADER_LEN = 20;
private final static byte SLIP_END = (byte)0300;
private final static byte SLIP_ESC = (byte)0333;
private final static byte SLIP_ESC_END = (byte)0334;
private final static byte SLIP_ESC_ESC = (byte)0335;
private final static int LABEL_WIDTH = 170;
private final static int LABEL_HEIGHT = 20;
private Object coojaTag = null; /* Used by Cooja for book-keeping */
private Mote mote;
private SerialPort serialPort = null;
private boolean registeredGateway = false;
private NetworkInterface[] networkInterfacesAll;
private NetworkInterface networkInterface = null;
private NetworkInterface loopbackInterface = null;
private Thread captureThread = null;
private JpcapCaptor captor = null;
private JpcapSender sender = null;
private String moteIP = null;
private byte[] networkInterfaceMAC = new byte[6];
private boolean shutdownCaptureThread = false;
private int inPkts = 0, outPkts = 0;
private JInternalFrame pluginGUI = null;
private JLabel gatewayLabel = null;
private JLabel interfaceLabel = null;
private JLabel macLabel = null;
private JLabel ipLabel = null;
private JLabel inLabel = null;
private JLabel outLabel = null;
private JComboBox selectNICComboBox;
private JCheckBox autoRegisterRoutes;
private final boolean ON_WINDOWS;
private final String NETMASK = "255.255.0.0";
private String restoreRoutesCmd = null;
private Process tunProcess = null;
private final static String TUNNEL_APP_TARGET = "minimal-net";
private boolean shouldDisableLoopbackForwarding = false;
private boolean shouldEnableRPFilter = false;
private SlipState readSlipState = SlipState.STATE_OK;
private int readSlipLength = 0;
private final int READ_SLIP_BUFFER_SIZE = 256;
private byte[] readSlipBuffer = new byte[READ_SLIP_BUFFER_SIZE];
public NativeIPGateway(Mote mote, Simulation simulation, final GUI gui) {
this.mote = mote;
/* Native OS - plugin depends on platform specific commands */
String osName = System.getProperty("os.name").toLowerCase();
if (osName.startsWith("win")) {
ON_WINDOWS = true;
} else {
ON_WINDOWS = false;
}
/* Mote serial port */
serialPort = (SerialPort) mote.getInterfaces().getLog();
if (serialPort == null) {
throw new RuntimeException("No mote serial port");
}
/* Mote IP address */
if (mote.getInterfaces().getIPAddress() == null) {
throw new RuntimeException("No IP address interface found (need IP address)");
}
moteIP = mote.getInterfaces().getIPAddress().getIPString();
mote.getInterfaces().getIPAddress().addObserver(new Observer() {
public void update(Observable obs, Object obj) {
moteIP = NativeIPGateway.this.mote.getInterfaces().getIPAddress().getIPString();
try {
if (captor != null) {
String[] ipSplit = moteIP.split("\\.");
String filter = "ip and dst net " + ipSplit[0] + "." + ipSplit[1];
if (autoRegisterRoutes.isSelected()) {
updateNativeRoute();
}
captor.setFilter(filter, true);
if (ipLabel != null) {
ipLabel.setText(moteIP);
}
}
} catch (IOException e) {
e.printStackTrace();
}
}
});
/* Observe serial port for outgoing IP packets */
serialPort.addSerialDataObserver(new Observer() {
public void update(Observable obs, Object obj) {
readSlipAccumulated(serialPort.getLastSerialData());
}
});
autoRegisterRoutes = new JCheckBox("", true);
autoRegisterRoutes.addActionListener(new ActionListener() {
public void actionPerformed(ActionEvent e) {
if (autoRegisterRoutes.isSelected()) {
updateNativeRoute();
}
}
});
/* Create tunnel interface to capture packet on (default) */
createTunInterface();
/* Configure loopback interface */
configureLoopbackInterface();
/* Network interfaces list */
networkInterfacesAll = JpcapCaptor.getDeviceList();
if (networkInterfacesAll == null || networkInterfacesAll.length == 0) {
throw new RuntimeException("No network interfaces found");
}
selectNICComboBox = new JComboBox();
NetworkInterface tunnelInterface = null;
for (NetworkInterface intf : networkInterfacesAll) {
if (!ON_WINDOWS && intf.name.equals("lo")) {
loopbackInterface = intf;
}
if ((intf.name != null && intf.name.equals("tap0")) ||
(intf.description != null && intf.description.contains("VMware Virtual Ethernet Adapter"))) {
tunnelInterface = intf;
}
selectNICComboBox.addItem(intf.description + " (" + intf.name + ")");
}
selectNICComboBox.addItemListener(new ItemListener() {
public void itemStateChanged(ItemEvent e) {
if (e.getStateChange() != ItemEvent.SELECTED) {
return;
}
/* Detect selected network interface */
String descr = (String) ((JComboBox)e.getSource()).getSelectedItem();
NetworkInterface selected = null;
for (NetworkInterface networkInterface2 : networkInterfacesAll) {
String label = networkInterface2.description + " (" + networkInterface2.name + ")";
if (label.equals(descr)) {
selected = networkInterface2;
break;
}
}
if (selected == null) {
logger.fatal("Unknown network interface: " + descr);
return;
}
/* Activate network interface */
if (selected == networkInterface) {
return;
}
startCapturingPackets(selected);
}
});
/* GUI components */
if (GUI.isVisualized()) {
pluginGUI = new JInternalFrame(
"Native IP Gateway (" + mote + ")",
true, true, true, true);
pluginGUI.addInternalFrameListener(new InternalFrameListener() {
public void internalFrameClosing(InternalFrameEvent e) {
gui.removePlugin(NativeIPGateway.this, true);
}
public void internalFrameClosed(InternalFrameEvent e) { }
public void internalFrameOpened(InternalFrameEvent e) { }
public void internalFrameIconified(InternalFrameEvent e) { }
public void internalFrameDeiconified(InternalFrameEvent e) { }
public void internalFrameActivated(InternalFrameEvent e) {
/* Highlight mote in COOJA */
if (NativeIPGateway.this.coojaTag != null && coojaTag instanceof Mote) {
gui.signalMoteHighlight((Mote) coojaTag);
}
}
public void internalFrameDeactivated(InternalFrameEvent e) { }
}
);
JPanel mainPane = new JPanel();
mainPane.setBorder(BorderFactory.createEmptyBorder(10, 10, 10, 10));
mainPane.setLayout(new BoxLayout(mainPane, BoxLayout.Y_AXIS));
ipLabel = addInfo(mainPane, "Mote IP Address:", moteIP);
ipLabel.setToolTipText(null);
addComponent(mainPane, "Route to/Capture on: ", selectNICComboBox);
addComponent(mainPane, "Auto-register native route: ", autoRegisterRoutes);
addInfo(mainPane, "", "");
interfaceLabel = addInfo(mainPane, "Network Interface:", "?");
gatewayLabel = addInfo(mainPane, "Network Gateway:", "?");
macLabel = addInfo(mainPane, "Network MAC: ", "?");
inLabel = addInfo(mainPane, "Packets to simulation:", "0");
inLabel.setToolTipText(null);
outLabel = addInfo(mainPane, "Packets from simulation:", "0");
outLabel.setToolTipText(null);
pluginGUI.getContentPane().add(BorderLayout.CENTER,
new JScrollPane(mainPane,
JScrollPane.VERTICAL_SCROLLBAR_AS_NEEDED,
JScrollPane.HORIZONTAL_SCROLLBAR_AS_NEEDED));
pluginGUI.pack();
pluginGUI.setSize(pluginGUI.getWidth()+10, pluginGUI.getHeight()+10);
}
/* Start capturing network traffic for simulated network */
if (tunnelInterface != null) {
startCapturingPackets(tunnelInterface);
} else {
startCapturingPackets(networkInterfacesAll[0]);
}
}
public JInternalFrame getGUI() {
return pluginGUI;
}
private void startCapturingPackets(NetworkInterface intf) {
/* Wait for old capture thread to exit */
if (captureThread != null &&
captureThread.isAlive()) {
shutdownCaptureThread = true;
try {
captureThread.join();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
captureThread = null;
/* Start listening on selected network interface */
networkInterface = intf;
/* Capture thread for incoming IP packets */
captureThread = new Thread() {
public void run() {
/*logger.info("Capture thread started");*/
try {
captor = JpcapCaptor.openDevice(networkInterface, 65535, true, 20);
captor.setNonBlockingMode(false);
captor.setPacketReadTimeout(20);
String[] ipSplit = moteIP.split("\\.");
if (ipSplit.length != 4) {
logger.fatal("Bad mote IP address: " + moteIP);
}
String filter = "ip and dst net " + ipSplit[0] + "." + ipSplit[1];
captor.setFilter(filter, true);
} catch (IOException e) {
e.printStackTrace();
return;
}
while (!shutdownCaptureThread) {
IPPacket packet = (IPPacket) captor.getPacket();
if (packet == null) {
continue;
}
if (!moteIP.equals("0.0.0.0")) {
handleIncomingPacket(packet);
}
}
/*logger.info("Capture thread terminated");*/
}
};
shutdownCaptureThread = false;
captureThread.start();
/* Prepare packet sender */
try {
if (sender != null) {
sender.close();
sender = null;
}
if (sender == null) {
if (loopbackInterface != null) {
sender = JpcapSender.openDevice(loopbackInterface);
} else {
sender = JpcapSender.openDevice(networkInterface);
}
}
} catch (IOException e) {
if (!e.getMessage().contains("The operation completed successfully")) {
logger.fatal("Can not send packets on this network interface: " + e.getMessage());
if (sender != null) {
sender.close();
}
sender = null;
}
}
System.arraycopy(networkInterface.mac_address, 0, networkInterfaceMAC, 0, 6);
if (autoRegisterRoutes.isSelected()) {
updateNativeRoute();
}
/* Update GUI */
if (GUI.isVisualized()) {
interfaceLabel.setText(networkInterface.description);
interfaceLabel.setToolTipText(networkInterface.description);
if (networkInterface.addresses.length > 0) {
gatewayLabel.setText(networkInterface.addresses[0].address.getHostAddress());
gatewayLabel.setToolTipText(networkInterface.addresses[0].address.getHostAddress());
} else {
gatewayLabel.setText("[no gateway]");
gatewayLabel.setToolTipText("");
}
macLabel.setText(Integer.toHexString(networkInterfaceMAC[0]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[1]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[2]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[3]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[4]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[5]&0xFF));
macLabel.setToolTipText(Integer.toHexString(networkInterfaceMAC[0]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[1]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[2]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[3]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[4]&0xFF) +
":" + Integer.toHexString(networkInterfaceMAC[5]&0xFF));
selectNICComboBox.setSelectedItem(networkInterface.description + " (" + networkInterface.name + ")");
}
}
private void configureLoopbackInterface() {
if (ON_WINDOWS) {
/* Nothing to configure */
} else {
configureLoopbackInterfaceLinux();
}
}
private void configureLoopbackInterfaceLinux() {
enableLoopbackForwardingLinux();
disableLoopbackRPFilterLinux();
}
private void enableLoopbackForwardingLinux() {
try {
File forwardingFile = new File("/proc/sys/net/ipv4/conf/lo/forwarding");
if (!forwardingFile.exists() || !forwardingFile.canWrite()) {
logger.warn("No access to " + forwardingFile.getPath());
return;
}
Process process = Runtime.getRuntime().exec("cat " + forwardingFile.getPath());
process.waitFor();
char forwardingValue = (char) process.getInputStream().read();
/*logger.debug(forwardingFile.getPath() + " has value: " + forwardingValue);*/
if (forwardingValue != '1' && forwardingValue != '0') {
logger.fatal("Unknown value in " + forwardingFile.getPath() + ": " + forwardingValue);
return;
}
if (forwardingValue == '1') {
logger.info("Forwarding already enabled on loopback interface. No action.");
return;
}
process = Runtime.getRuntime().exec(new String[] { "bash", "-c", "echo 1 > " + forwardingFile.getPath() });
process.waitFor();
logger.info("Enabled forwarding on loopback interface.");
shouldDisableLoopbackForwarding = true;
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void disableLoopbackForwardingLinux() {
try {
File forwardingFile = new File("/proc/sys/net/ipv4/conf/lo/forwarding");
if (!forwardingFile.exists() || !forwardingFile.canWrite()) {
logger.warn("No access to " + forwardingFile.getPath());
return;
}
Process process = Runtime.getRuntime().exec(new String[] { "bash", "-c", "echo 0 > " + forwardingFile.getPath() });
process.waitFor();
logger.info("Disabled forwarding on loopback interface.");
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void disableLoopbackRPFilterLinux() {
try {
File filterFile = new File("/proc/sys/net/ipv4/conf/lo/rp_filter");
if (!filterFile.exists() || !filterFile.canWrite()) {
logger.warn("No access to " + filterFile.getPath());
return;
}
Process process = Runtime.getRuntime().exec("cat " + filterFile.getPath());
process.waitFor();
char filterValue = (char) process.getInputStream().read();
/*logger.debug(filterFile.getPath() + " has value: " + filterValue);*/
if (filterValue != '1' && filterValue != '0') {
logger.fatal("Unknown value in " + filterFile.getPath() + ": " + filterValue);
return;
}
if (filterValue == '0') {
logger.info("RP filter already disabled on loopback interface. No action.");
return;
}
process = Runtime.getRuntime().exec(new String[] { "bash", "-c", "echo 0 > " + filterFile.getPath() });
process.waitFor();
logger.info("Disabled RP filter on loopback interface.");
shouldEnableRPFilter = true;
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void enableLoopbackRPFilterLinux() {
try {
File filterFile = new File("/proc/sys/net/ipv4/conf/lo/rp_filter");
if (!filterFile.exists() || !filterFile.canWrite()) {
logger.warn("No access to " + filterFile.getPath());
return;
}
Process process = Runtime.getRuntime().exec(new String[] { "bash", "-c", "echo 1 > " + filterFile.getPath() });
process.waitFor();
logger.info("Enabled RP filter on loopback interface.");
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void createTunInterface() {
if (ON_WINDOWS) {
/*logger.warn("Cannot create tunnel network interface on Windows. Try using VMware interfaces.");*/
} else {
createTunInterfaceLinux();
}
}
private void createTunInterfaceLinux() {
try {
/* Create tunnel interface by starting any Contiki minimal-net application.
* We use the hello-world application.
*
* The Contiki node should have the IP address 192.168.1.2. */
String tunContikiApp = "hello-world." + TUNNEL_APP_TARGET;
File tunContikiAppDir =
new File(GUI.getExternalToolsSetting("PATH_CONTIKI"), "examples/hello-world");
/*logger.info("Creating tap0 via " + tunContikiAppDir + "/" + tunContikiApp);*/
String[] compileCmd = new String[3];
compileCmd[0] = "make";
compileCmd[1] = tunContikiApp;
compileCmd[2] = "TARGET=" + TUNNEL_APP_TARGET;
logger.info("> " + compileCmd[0] + " " + compileCmd[1] + " " + compileCmd[2]);
Process compileProcess = Runtime.getRuntime().exec(compileCmd, null, tunContikiAppDir);
compileProcess.waitFor();
boolean compileOK = compileProcess.exitValue() == 0;
if (!compileOK) {
throw new Exception(tunContikiAppDir + "/" + tunContikiApp + " compilation failed");
}
String[] tunAppCmd = new String[1];
tunAppCmd[0] = "./" + tunContikiApp;
logger.info("> " + tunAppCmd[0]);
tunProcess = Runtime.getRuntime().exec(tunAppCmd, null, tunContikiAppDir);
/* Waiting some time - otherwise pcap may not discover the new interface */
Thread.sleep(250);
logger.info("Created tap0 via " + tunContikiAppDir + "/" + tunContikiApp);
} catch (Exception e) {
logger.fatal("Error when creating tap0: " + e.getMessage());
logger.fatal("Try using an already existing network interface");
}
}
private void deleteTunInterface() {
if (ON_WINDOWS) {
/*deleteTunInterfaceWindows();*/
} else {
deleteTunInterfaceLinux();
}
}
private void deleteTunInterfaceLinux() {
if (tunProcess == null) {
return;
}
try {
tunProcess.destroy();
logger.debug("Closed tap0 process");
} catch (Exception e) {
logger.fatal("Error when deleting tap0: " + e.getMessage());
}
}
private void updateNativeRoute() {
if (mote.getInterfaces().getIPAddress().getIPString().equals("0.0.0.0")) {
/*logger.info("Not adding route, mote has no IP: " +
mote.getInterfaces().getIPAddress().getIPString());*/
return;
}
if (networkInterface.addresses.length <= 0) {
return;
}
if (ON_WINDOWS) {
updateNativeRouteWindows();
} else {
updateNativeRouteLinux();
}
}
private void updateNativeRouteWindows() {
if (restoreRoutesCmd != null) {
/*logger.info("Deleting old route: '" + restoreRoutesCmd + "'");*/
try {
logger.info("> " + restoreRoutesCmd);
Process routeProcess = Runtime.getRuntime().exec(restoreRoutesCmd);
routeProcess.waitFor();
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
restoreRoutesCmd = null;
}
String moteNetIP =
mote.getInterfaces().getIPAddress().getIPString().split("\\.")[0] + "." +
mote.getInterfaces().getIPAddress().getIPString().split("\\.")[1] + "." +
"0.0";
/*logger.info("Simulation IP net : " + moteNetIP);*/
String gatewayIP =
(0xFF&networkInterface.addresses[0].address.getAddress()[0]) + "." +
(0xFF&networkInterface.addresses[0].address.getAddress()[1]) + "." +
(0xFF&networkInterface.addresses[0].address.getAddress()[2]) + "." +
"254"; /* Non-existing gateway - just make the packets go away */
/*logger.info("Gateway IP: " + gatewayIP);*/
/*logger.info("Netmask: " + NETMASK);*/
try {
logger.info("Registering route to simulated network");
String cmd = "route add " + moteNetIP + " mask " + NETMASK + " " + gatewayIP;
logger.info("> " + cmd);
Process routeProcess = Runtime.getRuntime().exec(cmd);
routeProcess.waitFor();
restoreRoutesCmd = "route delete " + moteNetIP;
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void updateNativeRouteLinux() {
String moteNetIP =
mote.getInterfaces().getIPAddress().getIPString().split("\\.")[0] + "." +
mote.getInterfaces().getIPAddress().getIPString().split("\\.")[1] + "." +
"0.0";
/*logger.info("Simulation IP net : " + moteNetIP);*/
String gatewayIP =
(0xFF&networkInterface.addresses[0].address.getAddress()[0]) + "." +
(0xFF&networkInterface.addresses[0].address.getAddress()[1]) + "." +
(0xFF&networkInterface.addresses[0].address.getAddress()[2]) + "." +
"2";
/*logger.info("Gateway IP: " + gatewayIP);*/
/*logger.info("Netmask: " + NETMASK);*/
try {
logger.info("Registering route to simulated network");
restoreRoutesCmd = "route del -net " + moteNetIP + " netmask 255.255.0.0";
logger.info("> " + restoreRoutesCmd);
Process process = Runtime.getRuntime().exec(restoreRoutesCmd);
process.waitFor();
String cmd = "route add -net " + moteNetIP + " netmask " + NETMASK + " gw " + gatewayIP;
logger.info("> " + cmd);
process = Runtime.getRuntime().exec(cmd);
process.waitFor();
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
}
private void handleIncomingPacket(IPPacket packet) {
if (!registeredGateway) {
/* Make mote register as gateway (only needed once) */
writeAsSlip("?IPA".getBytes(), serialPort);
registeredGateway = true;
}
/*logger.debug("tot length : " + packet.len);
logger.debug("ip proto: " + packet.protocol);
logger.debug("ip length : " + packet.length);
logger.debug("ip header length : " + packet.header.length);
logger.debug("ip data length : " + packet.data.length);*/
/* Send IP packet data (without captured non-IP header) */
int offset = packet.len - packet.length;
byte[] packetData = new byte[packet.header.length + packet.data.length - offset];
System.arraycopy(packet.header, offset, packetData, 0, packet.header.length-offset);
System.arraycopy(packet.data, 0, packetData, packet.header.length-offset, packet.data.length);
writeAsSlip(packetData, serialPort);
inPkts++;
/* Update GUI */
if (GUI.isVisualized()) {
inLabel.setText("" + inPkts);
}
}
private void handleOutgoingPacket(byte[] packetData) {
/* Sanity check outgoing data */
if (packetData.length < IP_HEADER_LEN) {
/*logger.warn("Ignoring small packet:\n" + StringUtils.hexDump(packetData));*/
return;
}
if (packetData[0] != 0x45) {
/*logger.warn("Ignoring bad header:\n" + StringUtils.hexDump(packetData));*/
return;
}
if (sender == null) {
logger.warn("No sender instance, dropping outgoing packet");
return;
}
/* Create packet */
jpcap.packet.Packet packet = new jpcap.packet.Packet();
packet.header = new byte[0];
packet.data = packetData;
packet.len = packetData.length;
/* Link ethernet frame */
EthernetPacket ether = new EthernetPacket();
ether.frametype = EthernetPacket.ETHERTYPE_IP;
ether.dst_mac = networkInterfaceMAC;
ether.src_mac = networkInterfaceMAC;
if (loopbackInterface != null) {
/* Use zeroed destination MAC (loopback) */
ether.dst_mac = new byte[6];
ether.dst_mac[0] = 0x0;
ether.dst_mac[1] = 0x0;
ether.dst_mac[2] = 0x0;
ether.dst_mac[3] = 0x0;
ether.dst_mac[4] = 0x0;
ether.dst_mac[5] = 0x0;
}
packet.datalink = ether;
/*logger.info("Sending packet (" + packet.len + " bytes) to native network: " + sender);*/
sender.sendPacket(packet);
outPkts++;
/* Update GUI */
if (GUI.isVisualized()) {
outLabel.setText("" + outPkts);
}
}
/**
* Wraps packet as SLIP.
*
* @param packet Packet data
*/
private static void writeAsSlip(byte[] packet, SerialPort serialPort) {
serialPort.writeByte(SLIP_END);
for (byte b: packet) {
if (b == SLIP_END) {
serialPort.writeByte(SLIP_ESC);
serialPort.writeByte(SLIP_ESC_END);
} else if (b == SLIP_ESC) {
serialPort.writeByte(SLIP_ESC);
serialPort.writeByte(SLIP_ESC_ESC);
} else {
serialPort.writeByte(b);
}
}
serialPort.writeByte(SLIP_END);
}
public enum SlipState {
STATE_OK,
STATE_ESC,
STATE_RUBBISH
}
private boolean readSlipAccumulated(byte b) {
switch (readSlipState) {
case STATE_RUBBISH:
readSlipLength = 0;
if(b == SLIP_END) {
readSlipState = SlipState.STATE_OK;
}
return false;
case STATE_ESC:
if(b == SLIP_ESC_END) {
b = SLIP_END;
} else if (b == SLIP_ESC_ESC) {
b = SLIP_ESC;
} else {
readSlipState = SlipState.STATE_RUBBISH;
readSlipLength = 0;
return false;
}
readSlipState = SlipState.STATE_OK;
break;
case STATE_OK:
if(b == SLIP_ESC) {
readSlipState = SlipState.STATE_ESC;
return false;
} else if (b == SLIP_END) {
/* Handle outgoing packet */
byte[] packet = new byte[readSlipLength];
System.arraycopy(readSlipBuffer, 0, packet, 0, readSlipLength);
handleOutgoingPacket(packet);
readSlipLength = 0;
return true;
}
}
/* Receive byte */
readSlipBuffer[readSlipLength] = b;
readSlipLength++;
if (readSlipLength >= READ_SLIP_BUFFER_SIZE) {
readSlipState = SlipState.STATE_RUBBISH;
readSlipLength = 0;
}
return false;
}
private JLabel addInfo(JPanel pane, String desc, String value) {
JPanel smallPane = new JPanel(new BorderLayout());
JLabel label = new JLabel(desc);
label.setPreferredSize(new Dimension(LABEL_WIDTH,LABEL_HEIGHT));
smallPane.add(BorderLayout.WEST, label);
label = new JLabel(value);
label.setPreferredSize(new Dimension(LABEL_WIDTH,LABEL_HEIGHT));
label.setToolTipText(value);
smallPane.add(BorderLayout.CENTER, label);
pane.add(smallPane);
pane.add(Box.createRigidArea(new Dimension(0,10)));
return label;
}
private Component addComponent(JPanel pane, String desc, Component comp) {
JPanel smallPane = new JPanel(new BorderLayout());
JLabel label = new JLabel(desc);
label.setPreferredSize(new Dimension(LABEL_WIDTH,LABEL_HEIGHT));
smallPane.add(BorderLayout.WEST, label);
comp.setPreferredSize(new Dimension(LABEL_WIDTH,LABEL_HEIGHT));
smallPane.add(BorderLayout.CENTER, comp);
pane.add(smallPane);
pane.add(Box.createRigidArea(new Dimension(0,10)));
return comp;
}
public boolean setConfigXML(Collection<Element> configXML, boolean visAvailable) {
for (Element element : configXML) {
if (element.getName().equals("network_interface")) {
boolean ok = false;
for (NetworkInterface intf: networkInterfacesAll) {
if (intf.name.equals(element.getText())) {
startCapturingPackets(intf);
ok = true;
break;
}
}
if (!ok) {
logger.warn("Network interface not available: " + element.getText());
logger.warn("Instead capturing on default network interface: " + networkInterface.name);
}
} else if (element.getName().equals("register_routes")) {
autoRegisterRoutes.setSelected(Boolean.parseBoolean(element.getText()));
} else {
return false;
}
}
return true;
}
public Collection<Element> getConfigXML() {
Vector<Element> config = new Vector<Element>();
Element element;
element = new Element("network_interface");
element.setText(networkInterface.name);
config.add(element);
element = new Element("register_routes");
element.setText("" + autoRegisterRoutes.isSelected());
config.add(element);
return config;
}
public void closePlugin() {
if (sender != null) {
sender.close();
}
shutdownCaptureThread = true;
if (shouldDisableLoopbackForwarding) {
disableLoopbackForwardingLinux();
}
if (shouldEnableRPFilter) {
enableLoopbackRPFilterLinux();
}
if (restoreRoutesCmd != null) {
/*logger.info("Deleting old route: '" + restoreRoutesCmd + "'");*/
try {
logger.info("> " + restoreRoutesCmd);
Process routeProcess = Runtime.getRuntime().exec(restoreRoutesCmd);
routeProcess.waitFor();
} catch (IOException e) {
e.printStackTrace();
} catch (InterruptedException e) {
e.printStackTrace();
}
restoreRoutesCmd = null;
}
deleteTunInterface();
}
public void tagWithObject(Object tag) {
this.coojaTag = tag;
}
public Object getTag() {
return coojaTag;
}
}