deac/osd-contiki
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

Merge pull request #763 from ejoerns/pull-req/cooja-analyzers

Browse source 
[Cooja] Fixes and enhancements for 6lowpan analyzers
This commit is contained in:
Fredrik Österlind 2014-08-06 08:55:29 +02:00
parent 648d3576a0 d894390f3e
commit cb6cb3fc13
7 changed files with 1159 additions and 1002 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

457
tools/cooja/java/org/contikios/cooja/plugins/RadioLogger.java
View file

@ -27,7 +27,6 @@
* SUCH DAMAGE. * SUCH DAMAGE.
* *
*/ */
package org.contikios.cooja.plugins; package org.contikios.cooja.plugins;
import java.awt.BorderLayout; import java.awt.BorderLayout;
@ -111,6 +110,7 @@ import org.contikios.cooja.util.StringUtils;
@ClassDescription("Radio messages") @ClassDescription("Radio messages")
@PluginType(PluginType.SIM_PLUGIN) @PluginType(PluginType.SIM_PLUGIN)
public class RadioLogger extends VisPlugin { public class RadioLogger extends VisPlugin {
private static Logger logger = Logger.getLogger(RadioLogger.class); private static Logger logger = Logger.getLogger(RadioLogger.class);
private static final long serialVersionUID = -6927091711697081353L; private static final long serialVersionUID = -6927091711697081353L;
@ -141,7 +141,7 @@ public class RadioLogger extends VisPlugin {
private Observer radioMediumObserver; private Observer radioMediumObserver;
private AbstractTableModel model; private AbstractTableModel model;
private HashMap<String,Action> analyzerMap = new HashMap<String,Action>(); private HashMap<String, Action> analyzerMap = new HashMap<String, Action>();
private String analyzerName = null; private String analyzerName = null;
private ArrayList<PacketAnalyzer> analyzers = null; private ArrayList<PacketAnalyzer> analyzers = null;
private IEEE802154Analyzer analyzerWithPcap; private IEEE802154Analyzer analyzerWithPcap;
@ -187,6 +187,7 @@ public class RadioLogger extends VisPlugin {
private static final long serialVersionUID = 1692207305977527004L; private static final long serialVersionUID = 1692207305977527004L;
@Override
public String getColumnName(int col) { public String getColumnName(int col) {
if (col == COLUMN_TIME && formatTimeString) { if (col == COLUMN_TIME && formatTimeString) {
return "Time"; return "Time";
@ -194,14 +195,17 @@ public class RadioLogger extends VisPlugin {
return COLUMN_NAMES[col]; return COLUMN_NAMES[col];
} }
@Override
public int getRowCount() { public int getRowCount() {
return connections.size(); return connections.size();
} }
@Override
public int getColumnCount() { public int getColumnCount() {
return COLUMN_NAMES.length; return COLUMN_NAMES.length;
} }
@Override
public Object getValueAt(int row, int col) { public Object getValueAt(int row, int col) {
if (row < 0 || row >= connections.size()) { if (row < 0 || row >= connections.size()) {
return ""; return "";
@ -247,6 +251,7 @@ public class RadioLogger extends VisPlugin {
return null; return null;
} }
@Override
public boolean isCellEditable(int row, int col) { public boolean isCellEditable(int row, int col) {
if (col == COLUMN_FROM) { if (col == COLUMN_FROM) {
/* Highlight source */ /* Highlight source */
@ -265,6 +270,7 @@ public class RadioLogger extends VisPlugin {
return false; return false;
} }
@Override
public Class<?> getColumnClass(int c) { public Class<?> getColumnClass(int c) {
return getValueAt(0, c).getClass(); return getValueAt(0, c).getClass();
} }
@ -274,6 +280,7 @@ public class RadioLogger extends VisPlugin {
private static final long serialVersionUID = -2199726885069809686L; private static final long serialVersionUID = -2199726885069809686L;
@Override
public String getToolTipText(MouseEvent e) { public String getToolTipText(MouseEvent e) {
java.awt.Point p = e.getPoint(); java.awt.Point p = e.getPoint();
int rowIndex = rowAtPoint(p); int rowIndex = rowAtPoint(p);
@ -290,14 +297,13 @@ public class RadioLogger extends VisPlugin {
/* TODO This entry may represent several hidden connections */ /* TODO This entry may represent several hidden connections */
RadioConnectionLog conn = connections.get(modelRowIndex); RadioConnectionLog conn = connections.get(modelRowIndex);
if (modelColumnIndex == COLUMN_TIME) { if (modelColumnIndex == COLUMN_TIME) {
return return "<html>"
"<html>" + + "Start time (us): " + conn.startTime
"Start time (us): " + conn.startTime + + "<br>"
"<br>" + + "End time (us): " + conn.endTime
"End time (us): " + conn.endTime + + "<br><br>"
"<br><br>" + + "Duration (us): " + (conn.endTime - conn.startTime)
"Duration (us): " + (conn.endTime - conn.startTime) + + "</html>";
"</html>";
} else if (modelColumnIndex == COLUMN_FROM) { } else if (modelColumnIndex == COLUMN_FROM) {
return conn.connection.getSource().getMote().toString(); return conn.connection.getSource().getMote().toString();
} else if (modelColumnIndex == COLUMN_TO) { } else if (modelColumnIndex == COLUMN_TO) {
@ -329,6 +335,7 @@ public class RadioLogger extends VisPlugin {
/* Toggle time format */ /* Toggle time format */
dataTable.getTableHeader().addMouseListener(new MouseAdapter() { dataTable.getTableHeader().addMouseListener(new MouseAdapter() {
@Override
public void mouseClicked(MouseEvent e) { public void mouseClicked(MouseEvent e) {
int colIndex = dataTable.columnAtPoint(e.getPoint()); int colIndex = dataTable.columnAtPoint(e.getPoint());
int columnIndex = dataTable.convertColumnIndexToModel(colIndex); int columnIndex = dataTable.convertColumnIndexToModel(colIndex);
@ -337,25 +344,26 @@ public class RadioLogger extends VisPlugin {
} }
formatTimeString = !formatTimeString; formatTimeString = !formatTimeString;
dataTable.getColumnModel().getColumn(COLUMN_TIME).setHeaderValue( dataTable.getColumnModel().getColumn(COLUMN_TIME).setHeaderValue(
dataTable.getModel().getColumnName(COLUMN_TIME)); dataTable.getModel().getColumnName(COLUMN_TIME));
repaint(); repaint();
} }
}); });
dataTable.addKeyListener(new KeyAdapter() { dataTable.addKeyListener(new KeyAdapter() {
@Override
public void keyPressed(KeyEvent e) { public void keyPressed(KeyEvent e) {
if (e.getKeyCode() == KeyEvent.VK_SPACE) { if (e.getKeyCode() == KeyEvent.VK_SPACE) {
showInAllAction.actionPerformed(null); showInAllAction.actionPerformed(null);
} else if (e.getKeyCode() == KeyEvent.VK_F && } else if (e.getKeyCode() == KeyEvent.VK_F
(e.getModifiers() & KeyEvent.CTRL_MASK) != 0) { && (e.getModifiers() & KeyEvent.CTRL_MASK) != 0) {
searchField.setVisible(true); searchField.setVisible(true);
searchField.requestFocus(); searchField.requestFocus();
searchField.selectAll(); searchField.selectAll();
revalidate(); revalidate();
} else if (e.getKeyCode() == KeyEvent.VK_ESCAPE) { } else if (e.getKeyCode() == KeyEvent.VK_ESCAPE) {
searchField.setVisible(false); searchField.setVisible(false);
dataTable.requestFocus(); dataTable.requestFocus();
revalidate(); revalidate();
} }
} }
}); });
@ -367,21 +375,22 @@ public class RadioLogger extends VisPlugin {
dataTable.setRowSorter(logFilter); dataTable.setRowSorter(logFilter);
dataTable.getSelectionModel().addListSelectionListener(new ListSelectionListener() { dataTable.getSelectionModel().addListSelectionListener(new ListSelectionListener() {
public void valueChanged(ListSelectionEvent e) { @Override
int row = dataTable.getSelectedRow(); public void valueChanged(ListSelectionEvent e) {
if (row < 0) { int row = dataTable.getSelectedRow();
return; if (row < 0) {
} return;
int modelRowIndex = dataTable.convertRowIndexToModel(row);
if (modelRowIndex >= 0) {
RadioConnectionLog conn = connections.get(modelRowIndex);
if (conn.tooltip == null) {
prepareTooltipString(conn);
}
verboseBox.setText(conn.tooltip);
verboseBox.setCaretPosition(0);
}
} }
int modelRowIndex = dataTable.convertRowIndexToModel(row);
if (modelRowIndex >= 0) {
RadioConnectionLog conn = connections.get(modelRowIndex);
if (conn.tooltip == null) {
prepareTooltipString(conn);
}
verboseBox.setText(conn.tooltip);
verboseBox.setCaretPosition(0);
}
}
}); });
// Set data column width greedy // Set data column width greedy
dataTable.setAutoResizeMode(JTable.AUTO_RESIZE_LAST_COLUMN); dataTable.setAutoResizeMode(JTable.AUTO_RESIZE_LAST_COLUMN);
@ -395,11 +404,13 @@ public class RadioLogger extends VisPlugin {
payloadMenu.add(new JMenuItem(aliasAction)); payloadMenu.add(new JMenuItem(aliasAction));
payloadMenu.add(new JCheckBoxMenuItem(showDuplicatesAction) { payloadMenu.add(new JCheckBoxMenuItem(showDuplicatesAction) {
@Override
public boolean isSelected() { public boolean isSelected() {
return showDuplicates; return showDuplicates;
} }
}); });
payloadMenu.add(new JCheckBoxMenuItem(hideNoDestinationAction) { payloadMenu.add(new JCheckBoxMenuItem(hideNoDestinationAction) {
@Override
public boolean isSelected() { public boolean isSelected() {
return hideNoDestinationPackets; return hideNoDestinationPackets;
} }
@ -407,7 +418,6 @@ public class RadioLogger extends VisPlugin {
fileMenu.add(new JMenuItem(saveAction)); fileMenu.add(new JMenuItem(saveAction));
JPopupMenu popupMenu = new JPopupMenu(); JPopupMenu popupMenu = new JPopupMenu();
JMenu focusMenu = new JMenu("Show in"); JMenu focusMenu = new JMenu("Show in");
@ -418,7 +428,6 @@ public class RadioLogger extends VisPlugin {
popupMenu.add(focusMenu); popupMenu.add(focusMenu);
//a group of radio button menu items //a group of radio button menu items
ButtonGroup group = new ButtonGroup(); ButtonGroup group = new ButtonGroup();
JRadioButtonMenuItem rbMenuItem = new JRadioButtonMenuItem( JRadioButtonMenuItem rbMenuItem = new JRadioButtonMenuItem(
createAnalyzerAction("No Analyzer", "none", null, true)); createAnalyzerAction("No Analyzer", "none", null, true));
@ -426,7 +435,7 @@ public class RadioLogger extends VisPlugin {
analyzerMenu.add(rbMenuItem); analyzerMenu.add(rbMenuItem);
rbMenuItem = new JRadioButtonMenuItem(createAnalyzerAction( rbMenuItem = new JRadioButtonMenuItem(createAnalyzerAction(
"6LoWPAN Analyzer", "6lowpan", lowpanAnalyzers, false)); "6LoWPAN Analyzer", "6lowpan", lowpanAnalyzers, false));
group.add(rbMenuItem); group.add(rbMenuItem);
analyzerMenu.add(rbMenuItem); analyzerMenu.add(rbMenuItem);
@ -436,20 +445,20 @@ public class RadioLogger extends VisPlugin {
analyzerMenu.add(rbMenuItem); analyzerMenu.add(rbMenuItem);
/* Load additional analyzers specified by projects (cooja.config) */ /* Load additional analyzers specified by projects (cooja.config) */
String[] projectAnalyzerSuites = String[] projectAnalyzerSuites
gui.getProjectConfig().getStringArrayValue(RadioLogger.class, "ANALYZERS"); = gui.getProjectConfig().getStringArrayValue(RadioLogger.class, "ANALYZERS");
if (projectAnalyzerSuites != null) { if (projectAnalyzerSuites != null) {
for (String suiteName: projectAnalyzerSuites) { for (String suiteName: projectAnalyzerSuites) {
if (suiteName == null || suiteName.trim().isEmpty()) { if (suiteName == null || suiteName.trim().isEmpty()) {
continue; continue;
} }
Class<? extends RadioLoggerAnalyzerSuite> suiteClass = Class<? extends RadioLoggerAnalyzerSuite> suiteClass
gui.tryLoadClass(RadioLogger.this, RadioLoggerAnalyzerSuite.class, suiteName); = gui.tryLoadClass(RadioLogger.this, RadioLoggerAnalyzerSuite.class, suiteName);
try { try {
RadioLoggerAnalyzerSuite suite = suiteClass.newInstance(); RadioLoggerAnalyzerSuite suite = suiteClass.newInstance();
ArrayList<PacketAnalyzer> suiteAnalyzers = suite.getAnalyzers(); ArrayList<PacketAnalyzer> suiteAnalyzers = suite.getAnalyzers();
rbMenuItem = new JRadioButtonMenuItem(createAnalyzerAction( rbMenuItem = new JRadioButtonMenuItem(createAnalyzerAction(
suite.getDescription(), suiteName, suiteAnalyzers, false)); suite.getDescription(), suiteName, suiteAnalyzers, false));
group.add(rbMenuItem); group.add(rbMenuItem);
analyzerMenu.add(rbMenuItem); analyzerMenu.add(rbMenuItem);
logger.debug("Loaded radio logger analyzers: " + suite.getDescription()); logger.debug("Loaded radio logger analyzers: " + suite.getDescription());
@ -472,21 +481,22 @@ public class RadioLogger extends VisPlugin {
/* Search text field */ /* Search text field */
searchField.setVisible(false); searchField.setVisible(false);
searchField.addKeyListener(new KeyAdapter() { searchField.addKeyListener(new KeyAdapter() {
@Override
public void keyPressed(KeyEvent e) { public void keyPressed(KeyEvent e) {
if (e.getKeyCode() == KeyEvent.VK_ENTER) { if (e.getKeyCode() == KeyEvent.VK_ENTER) {
searchSelectNext( searchSelectNext(
searchField.getText(), searchField.getText(),
(e.getModifiers() & KeyEvent.SHIFT_MASK) != 0); (e.getModifiers() & KeyEvent.SHIFT_MASK) != 0);
} else if (e.getKeyCode() == KeyEvent.VK_ESCAPE) { } else if (e.getKeyCode() == KeyEvent.VK_ESCAPE) {
searchField.setVisible(false); searchField.setVisible(false);
dataTable.requestFocus(); dataTable.requestFocus();
revalidate(); revalidate();
} }
} }
}); });
splitPane = new JSplitPane(JSplitPane.VERTICAL_SPLIT, splitPane = new JSplitPane(JSplitPane.VERTICAL_SPLIT,
new JScrollPane(dataTable), new JScrollPane(verboseBox)); new JScrollPane(dataTable), new JScrollPane(verboseBox));
splitPane.setOneTouchExpandable(true); splitPane.setOneTouchExpandable(true);
splitPane.setDividerLocation(150); splitPane.setDividerLocation(150);
add(BorderLayout.NORTH, searchField); add(BorderLayout.NORTH, searchField);
@ -497,6 +507,7 @@ public class RadioLogger extends VisPlugin {
adjuster.packColumns(); adjuster.packColumns();
radioMedium.addRadioMediumObserver(radioMediumObserver = new Observer() { radioMedium.addRadioMediumObserver(radioMediumObserver = new Observer() {
@Override
public void update(Observable obs, Object obj) { public void update(Observable obs, Object obj) {
RadioConnection conn = radioMedium.getLastConnection(); RadioConnection conn = radioMedium.getLastConnection();
if (conn == null) { if (conn == null) {
@ -508,6 +519,7 @@ public class RadioLogger extends VisPlugin {
loggedConn.connection = conn; loggedConn.connection = conn;
loggedConn.packet = conn.getSource().getLastPacketTransmitted(); loggedConn.packet = conn.getSource().getLastPacketTransmitted();
java.awt.EventQueue.invokeLater(new Runnable() { java.awt.EventQueue.invokeLater(new Runnable() {
@Override
public void run() { public void run() {
int lastSize = connections.size(); int lastSize = connections.size();
// Check if the last row is visible // Check if the last row is visible
@ -528,8 +540,8 @@ public class RadioLogger extends VisPlugin {
setTitle("Radio messages: showing " + dataTable.getRowCount() + "/" + connections.size() + " packets"); setTitle("Radio messages: showing " + dataTable.getRowCount() + "/" + connections.size() + " packets");
} }
}); });
} }
}); });
setSize(500, 300); setSize(500, 300);
try { try {
@ -539,45 +551,46 @@ public class RadioLogger extends VisPlugin {
} }
} }
@Override
public void startPlugin() { public void startPlugin() {
super.startPlugin(); super.startPlugin();
rebuildAllEntries(); rebuildAllEntries();
} }
private void searchSelectNext(String text, boolean reverse) { private void searchSelectNext(String text, boolean reverse) {
if (text.isEmpty()) { if (text.isEmpty()) {
return; return;
} }
int row = dataTable.getSelectedRow(); int row = dataTable.getSelectedRow();
if (row < 0) { if (row < 0) {
row = 0; row = 0;
} }
if (!reverse) { if (!reverse) {
row++; row++;
} else { } else {
row--; row--;
} }
int rows = dataTable.getModel().getRowCount(); int rows = dataTable.getModel().getRowCount();
for (int i=0; i < rows; i++) { for (int i = 0; i < rows; i++) {
int r; int r;
if (!reverse) { if (!reverse) {
r = (row + i + rows)%rows; r = (row + i + rows) % rows;
} else { } else {
r = (row - i + rows)%rows; r = (row - i + rows) % rows;
} }
String val = (String) dataTable.getModel().getValueAt(r, COLUMN_DATA); String val = (String) dataTable.getModel().getValueAt(r, COLUMN_DATA);
if (!val.contains(text)) { if (!val.contains(text)) {
continue; continue;
} }
dataTable.setRowSelectionInterval(r,r); dataTable.setRowSelectionInterval(r, r);
dataTable.scrollRectToVisible(dataTable.getCellRect(r, COLUMN_DATA, true)); dataTable.scrollRectToVisible(dataTable.getCellRect(r, COLUMN_DATA, true));
searchField.setBackground(Color.WHITE); searchField.setBackground(Color.WHITE);
return; return;
} }
searchField.setBackground(Color.RED); searchField.setBackground(Color.RED);
} }
/** /**
* Selects a logged radio packet close to the given time. * Selects a logged radio packet close to the given time.
@ -586,11 +599,12 @@ public class RadioLogger extends VisPlugin {
*/ */
public void trySelectTime(final long time) { public void trySelectTime(final long time) {
java.awt.EventQueue.invokeLater(new Runnable() { java.awt.EventQueue.invokeLater(new Runnable() {
@Override
public void run() { public void run() {
if (dataTable.getRowCount() == 0) { if (dataTable.getRowCount() == 0) {
return; return;
} }
for (int ai=0; ai < model.getRowCount(); ai++) { for (int ai = 0; ai < model.getRowCount(); ai++) {
int index = dataTable.convertRowIndexToModel(ai); int index = dataTable.convertRowIndexToModel(ai);
if (connections.get(index).endTime < time) { if (connections.get(index).endTime < time) {
continue; continue;
@ -600,41 +614,42 @@ public class RadioLogger extends VisPlugin {
dataTable.setRowSelectionInterval(ai, ai); dataTable.setRowSelectionInterval(ai, ai);
return; return;
} }
dataTable.scrollRectToVisible(dataTable.getCellRect(dataTable.getRowCount()-1, 0, true)); dataTable.scrollRectToVisible(dataTable.getCellRect(dataTable.getRowCount() - 1, 0, true));
dataTable.setRowSelectionInterval(dataTable.getRowCount()-1, dataTable.getRowCount()-1); dataTable.setRowSelectionInterval(dataTable.getRowCount() - 1, dataTable.getRowCount() - 1);
} }
}); });
} }
private void applyFilter() { private void applyFilter() {
for(RadioConnectionLog conn: connections) { for (RadioConnectionLog conn: connections) {
conn.data = null; conn.data = null;
conn.tooltip = null; conn.tooltip = null;
conn.hides = 0; conn.hides = 0;
conn.hiddenBy = null; conn.hiddenBy = null;
} }
try { try {
logFilter.setRowFilter(null); logFilter.setRowFilter(null);
RowFilter<Object, Object> filter = new RowFilter<Object, Object>() { RowFilter<Object, Object> filter = new RowFilter<Object, Object>() {
@Override
public boolean include(RowFilter.Entry<? extends Object, ? extends Object> entry) { public boolean include(RowFilter.Entry<? extends Object, ? extends Object> entry) {
int row = (Integer) entry.getIdentifier(); int row = (Integer) entry.getIdentifier();
RadioConnectionLog current = connections.get(row); RadioConnectionLog current = connections.get(row);
byte[] currentData = current.packet.getPacketData(); byte[] currentData = current.packet.getPacketData();
if (!showDuplicates && row > 0) { if (!showDuplicates && row > 0) {
RadioConnectionLog previous = connections.get(row-1); RadioConnectionLog previous = connections.get(row - 1);
byte[] previousData = previous.packet.getPacketData(); byte[] previousData = previous.packet.getPacketData();
if (!showDuplicates && if (!showDuplicates
Arrays.equals(previousData, currentData) && && Arrays.equals(previousData, currentData)
previous.connection.getSource() == current.connection.getSource() && && previous.connection.getSource() == current.connection.getSource()
Arrays.equals(previous.connection.getAllDestinations(), current.connection.getAllDestinations())) { && Arrays.equals(previous.connection.getAllDestinations(), current.connection.getAllDestinations())) {
if (connections.get(row-1).hiddenBy == null) { if (connections.get(row - 1).hiddenBy == null) {
connections.get(row-1).hides++; connections.get(row - 1).hides++;
connections.get(row).hiddenBy = connections.get(row-1); connections.get(row).hiddenBy = connections.get(row - 1);
} else { } else {
connections.get(row-1).hiddenBy.hides++; connections.get(row - 1).hiddenBy.hides++;
connections.get(row).hiddenBy = connections.get(row-1).hiddenBy; connections.get(row).hiddenBy = connections.get(row - 1).hiddenBy;
} }
return false; return false;
} }
@ -661,7 +676,7 @@ public class RadioLogger extends VisPlugin {
if (conn.packet == null) { if (conn.packet == null) {
data = null; data = null;
} else if (conn.packet instanceof ConvertedRadioPacket) { } else if (conn.packet instanceof ConvertedRadioPacket) {
data = ((ConvertedRadioPacket)conn.packet).getOriginalPacketData(); data = ((ConvertedRadioPacket) conn.packet).getOriginalPacketData();
} else { } else {
data = conn.packet.getPacketData(); data = conn.packet.getPacketData();
} }
@ -670,63 +685,63 @@ public class RadioLogger extends VisPlugin {
return; return;
} }
StringBuffer brief = new StringBuffer(); StringBuilder brief = new StringBuilder();
StringBuffer verbose = new StringBuffer(); StringBuilder verbose = new StringBuilder();
/* default analyzer */ /* default analyzer */
PacketAnalyzer.Packet packet = new PacketAnalyzer.Packet(data, PacketAnalyzer.MAC_LEVEL); PacketAnalyzer.Packet packet = new PacketAnalyzer.Packet(data, PacketAnalyzer.MAC_LEVEL);
if (analyzePacket(packet, brief, verbose)) { if (analyzePacket(packet, brief, verbose)) {
if (packet.hasMoreData()) { if (packet.hasMoreData()) {
byte[] payload = packet.getPayload(); byte[] payload = packet.getPayload();
brief.append(StringUtils.toHex(payload, 4)); brief.append(StringUtils.toHex(payload, 4));
if (verbose.length() > 0) {
verbose.append("<p>");
}
verbose.append("<b>Payload (")
.append(payload.length).append(" bytes)</b><br><pre>")
.append(StringUtils.hexDump(payload))
.append("</pre>");
}
conn.data = (data.length < 100 ? (data.length < 10 ? " " : " ") : "")
+ data.length + ": " + brief;
if (verbose.length() > 0) { if (verbose.length() > 0) {
conn.tooltip = verbose.toString(); verbose.append("<p>");
} }
verbose.append("<b>Payload (")
.append(payload.length).append(" bytes)</b><br><pre>")
.append(StringUtils.hexDump(payload))
.append("</pre>");
}
conn.data = (data.length < 100 ? (data.length < 10 ? " " : " ") : "")
+ data.length + ": " + brief;
if (verbose.length() > 0) {
conn.tooltip = verbose.toString();
}
} else { } else {
conn.data = data.length + ": 0x" + StringUtils.toHex(data, 4); conn.data = data.length + ": 0x" + StringUtils.toHex(data, 4);
} }
} }
private boolean analyzePacket(PacketAnalyzer.Packet packet, StringBuffer brief, StringBuffer verbose) { private boolean analyzePacket(PacketAnalyzer.Packet packet, StringBuilder brief, StringBuilder verbose) {
if (analyzers == null) return false; if (analyzers == null) return false;
try { try {
boolean analyze = true; boolean analyze = true;
while (analyze) { while (analyze) {
analyze = false; analyze = false;
for (int i = 0; i < analyzers.size(); i++) { for (int i = 0; i < analyzers.size(); i++) {
PacketAnalyzer analyzer = analyzers.get(i); PacketAnalyzer analyzer = analyzers.get(i);
if (analyzer.matchPacket(packet)) { if (analyzer.matchPacket(packet)) {
int res = analyzer.analyzePacket(packet, brief, verbose); int res = analyzer.analyzePacket(packet, brief, verbose);
if (packet.hasMoreData() && brief.length() > 0) { if (packet.hasMoreData() && brief.length() > 0) {
brief.append('|'); brief.append('|');
verbose.append("<br>"); verbose.append("<br>");
} }
if (res != PacketAnalyzer.ANALYSIS_OK_CONTINUE) { if (res != PacketAnalyzer.ANALYSIS_OK_CONTINUE) {
/* this was the final or the analysis failed - no analyzable payload possible here... */ /* this was the final or the analysis failed - no analyzable payload possible here... */
return brief.length() > 0; return brief.length() > 0;
} }
/* continue another round if more bytes left */ /* continue another round if more bytes left */
analyze = packet.hasMoreData(); analyze = packet.hasMoreData();
break; break;
}
} }
}
} }
} catch (Exception e) { } catch (Exception e) {
logger.debug("Error when analyzing packet: " + e.getMessage(), e); logger.debug("Error when analyzing packet: " + e.getMessage(), e);
return false; return false;
} }
return brief.length() > 0; return brief.length() > 0;
} }
private void prepareTooltipString(RadioConnectionLog conn) { private void prepareTooltipString(RadioConnectionLog conn) {
@ -737,38 +752,40 @@ public class RadioLogger extends VisPlugin {
} }
if (packet instanceof ConvertedRadioPacket && packet.getPacketData().length > 0) { if (packet instanceof ConvertedRadioPacket && packet.getPacketData().length > 0) {
byte[] original = ((ConvertedRadioPacket)packet).getOriginalPacketData(); byte[] original = ((ConvertedRadioPacket) packet).getOriginalPacketData();
byte[] converted = ((ConvertedRadioPacket)packet).getPacketData(); byte[] converted = ((ConvertedRadioPacket) packet).getPacketData();
conn.tooltip = "<html><font face=\"Monospaced\">" + conn.tooltip = "<html><font face=\"Monospaced\">"
"<b>Packet data (" + original.length + " bytes)</b><br>" + + "<b>Packet data (" + original.length + " bytes)</b><br>"
"<pre>" + StringUtils.hexDump(original) + "</pre>" + + "<pre>" + StringUtils.hexDump(original) + "</pre>"
"</font><font face=\"Monospaced\">" + + "</font><font face=\"Monospaced\">"
"<b>Cross-level packet data (" + converted.length + " bytes)</b><br>" + + "<b>Cross-level packet data (" + converted.length + " bytes)</b><br>"
"<pre>" + StringUtils.hexDump(converted) + "</pre>" + + "<pre>" + StringUtils.hexDump(converted) + "</pre>"
"</font></html>"; + "</font></html>";
} else if (packet instanceof ConvertedRadioPacket) { } else if (packet instanceof ConvertedRadioPacket) {
byte[] original = ((ConvertedRadioPacket)packet).getOriginalPacketData(); byte[] original = ((ConvertedRadioPacket) packet).getOriginalPacketData();
conn.tooltip = "<html><font face=\"Monospaced\">" + conn.tooltip = "<html><font face=\"Monospaced\">"
"<b>Packet data (" + original.length + " bytes)</b><br>" + + "<b>Packet data (" + original.length + " bytes)</b><br>"
"<pre>" + StringUtils.hexDump(original) + "</pre>" + + "<pre>" + StringUtils.hexDump(original) + "</pre>"
"</font><font face=\"Monospaced\">" + + "</font><font face=\"Monospaced\">"
"<b>No cross-level conversion available</b><br>" + + "<b>No cross-level conversion available</b><br>"
"</font></html>"; + "</font></html>";
} else { } else {
byte[] data = packet.getPacketData(); byte[] data = packet.getPacketData();
conn.tooltip = "<html><font face=\"Monospaced\">" + conn.tooltip = "<html><font face=\"Monospaced\">"
"<b>Packet data (" + data.length + " bytes)</b><br>" + + "<b>Packet data (" + data.length + " bytes)</b><br>"
"<pre>" + StringUtils.hexDump(data) + "</pre>" + + "<pre>" + StringUtils.hexDump(data) + "</pre>"
"</font></html>"; + "</font></html>";
} }
} }
@Override
public void closePlugin() { public void closePlugin() {
if (radioMediumObserver != null) { if (radioMediumObserver != null) {
radioMedium.deleteRadioMediumObserver(radioMediumObserver); radioMedium.deleteRadioMediumObserver(radioMediumObserver);
} }
} }
@Override
public Collection<Element> getConfigXML() { public Collection<Element> getConfigXML() {
ArrayList<Element> config = new ArrayList<Element>(); ArrayList<Element> config = new ArrayList<Element>();
@ -796,7 +813,7 @@ public class RadioLogger extends VisPlugin {
} }
if (aliases != null) { if (aliases != null) {
for (Object key: aliases.keySet()) { for (Object key : aliases.keySet()) {
element = new Element("alias"); element = new Element("alias");
element.setAttribute("payload", (String) key); element.setAttribute("payload", (String) key);
element.setAttribute("alias", (String) aliases.get(key)); element.setAttribute("alias", (String) aliases.get(key));
@ -815,6 +832,7 @@ public class RadioLogger extends VisPlugin {
return config; return config;
} }
@Override
public boolean setConfigXML(Collection<Element> configXML, boolean visAvailable) { public boolean setConfigXML(Collection<Element> configXML, boolean visAvailable) {
for (Element element : configXML) { for (Element element : configXML) {
String name = element.getName(); String name = element.getName();
@ -838,6 +856,7 @@ public class RadioLogger extends VisPlugin {
final Action action; final Action action;
if (analyzerName != null && ((action = analyzerMap.get(analyzerName)) != null)) { if (analyzerName != null && ((action = analyzerMap.get(analyzerName)) != null)) {
java.awt.EventQueue.invokeLater(new Runnable() { java.awt.EventQueue.invokeLater(new Runnable() {
@Override
public void run() { public void run() {
action.putValue(Action.SELECTED_KEY, Boolean.TRUE); action.putValue(Action.SELECTED_KEY, Boolean.TRUE);
action.actionPerformed(null); action.actionPerformed(null);
@ -853,6 +872,7 @@ public class RadioLogger extends VisPlugin {
} }
private class RadioConnectionLog { private class RadioConnectionLog {
long startTime; long startTime;
long endTime; long endTime;
RadioConnection connection; RadioConnection connection;
@ -864,15 +884,15 @@ public class RadioLogger extends VisPlugin {
String data = null; String data = null;
String tooltip = null; String tooltip = null;
@Override
public String toString() { public String toString() {
if (data == null) { if (data == null) {
RadioLogger.this.prepareDataString(this); RadioLogger.this.prepareDataString(this);
} }
return return Long.toString(startTime / Simulation.MILLISECOND) + "\t"
Long.toString(startTime / Simulation.MILLISECOND) + "\t" + + connection.getSource().getMote().getID() + "\t"
connection.getSource().getMote().getID() + "\t" + + getDestString(this) + "\t"
getDestString(this) + "\t" + + data;
data;
} }
} }
@ -888,7 +908,7 @@ public class RadioLogger extends VisPlugin {
for (Radio dest: dests) { for (Radio dest: dests) {
sb.append(dest.getMote().getID()).append(','); sb.append(dest.getMote().getID()).append(',');
} }
sb.setLength(sb.length()-1); sb.setLength(sb.length() - 1);
return sb.toString(); return sb.toString();
} }
@ -905,26 +925,28 @@ public class RadioLogger extends VisPlugin {
} }
private Action createAnalyzerAction(String name, final String actionName, private Action createAnalyzerAction(String name, final String actionName,
final ArrayList<PacketAnalyzer> analyzerList, boolean selected) { final ArrayList<PacketAnalyzer> analyzerList, boolean selected) {
Action action = new AbstractAction(name) { Action action = new AbstractAction(name) {
private static final long serialVersionUID = -608913700422638454L; private static final long serialVersionUID = -608913700422638454L;
public void actionPerformed(ActionEvent event) { @Override
if (analyzers != analyzerList) { public void actionPerformed(ActionEvent event) {
analyzers = analyzerList; if (analyzers != analyzerList) {
analyzerName = actionName; analyzers = analyzerList;
rebuildAllEntries(); analyzerName = actionName;
} rebuildAllEntries();
} }
}; }
action.putValue(Action.SELECTED_KEY, selected ? Boolean.TRUE : Boolean.FALSE); };
analyzerMap.put(actionName, action); action.putValue(Action.SELECTED_KEY, selected ? Boolean.TRUE : Boolean.FALSE);
return action; analyzerMap.put(actionName, action);
return action;
} }
private Action clearAction = new AbstractAction("Clear") { private Action clearAction = new AbstractAction("Clear") {
private static final long serialVersionUID = -6135583266684643117L; private static final long serialVersionUID = -6135583266684643117L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
int size = connections.size(); int size = connections.size();
if (size > 0) { if (size > 0) {
@ -938,6 +960,7 @@ public class RadioLogger extends VisPlugin {
private Action copyAction = new AbstractAction("Copy selected") { private Action copyAction = new AbstractAction("Copy selected") {
private static final long serialVersionUID = 8412062977916108054L; private static final long serialVersionUID = 8412062977916108054L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
Clipboard clipboard = Toolkit.getDefaultToolkit().getSystemClipboard(); Clipboard clipboard = Toolkit.getDefaultToolkit().getSystemClipboard();
@ -957,11 +980,12 @@ public class RadioLogger extends VisPlugin {
private Action copyAllAction = new AbstractAction("Copy all") { private Action copyAllAction = new AbstractAction("Copy all") {
private static final long serialVersionUID = 1905586689441157304L; private static final long serialVersionUID = 1905586689441157304L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
Clipboard clipboard = Toolkit.getDefaultToolkit().getSystemClipboard(); Clipboard clipboard = Toolkit.getDefaultToolkit().getSystemClipboard();
StringBuilder sb = new StringBuilder(); StringBuilder sb = new StringBuilder();
for(int i=0; i < connections.size(); i++) { for (int i = 0; i < connections.size(); i++) {
sb.append(connections.get(i).toString() + "\n"); sb.append(connections.get(i).toString() + "\n");
} }
@ -973,6 +997,7 @@ public class RadioLogger extends VisPlugin {
private Action saveAction = new AbstractAction("Save to file...") { private Action saveAction = new AbstractAction("Save to file...") {
private static final long serialVersionUID = -3942984643211482179L; private static final long serialVersionUID = -3942984643211482179L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
JFileChooser fc = new JFileChooser(); JFileChooser fc = new JFileChooser();
int returnVal = fc.showSaveDialog(Cooja.getTopParentContainer()); int returnVal = fc.showSaveDialog(Cooja.getTopParentContainer());
@ -984,12 +1009,12 @@ public class RadioLogger extends VisPlugin {
if (saveFile.exists()) { if (saveFile.exists()) {
String s1 = "Overwrite"; String s1 = "Overwrite";
String s2 = "Cancel"; String s2 = "Cancel";
Object[] options = { s1, s2 }; Object[] options = {s1, s2};
int n = JOptionPane.showOptionDialog( int n = JOptionPane.showOptionDialog(
Cooja.getTopParentContainer(), Cooja.getTopParentContainer(),
"A file with the same name already exists.\nDo you want to remove it?", "A file with the same name already exists.\nDo you want to remove it?",
"Overwrite existing file?", JOptionPane.YES_NO_OPTION, "Overwrite existing file?", JOptionPane.YES_NO_OPTION,
JOptionPane.QUESTION_MESSAGE, null, options, s1); JOptionPane.QUESTION_MESSAGE, null, options, s1);
if (n != JOptionPane.YES_OPTION) { if (n != JOptionPane.YES_OPTION) {
return; return;
} }
@ -1002,7 +1027,7 @@ public class RadioLogger extends VisPlugin {
try { try {
PrintWriter outStream = new PrintWriter(new FileWriter(saveFile)); PrintWriter outStream = new PrintWriter(new FileWriter(saveFile));
for(int i=0; i < connections.size(); i++) { for (int i = 0; i < connections.size(); i++) {
outStream.print(connections.get(i).toString() + "\n"); outStream.print(connections.get(i).toString() + "\n");
} }
outStream.close(); outStream.close();
@ -1016,6 +1041,8 @@ public class RadioLogger extends VisPlugin {
private Action timeLineAction = new AbstractAction("Timeline") { private Action timeLineAction = new AbstractAction("Timeline") {
private static final long serialVersionUID = -4035633464748224192L; private static final long serialVersionUID = -4035633464748224192L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
int selectedRow = dataTable.getSelectedRow(); int selectedRow = dataTable.getSelectedRow();
if (selectedRow < 0) return; if (selectedRow < 0) return;
@ -1026,12 +1053,12 @@ public class RadioLogger extends VisPlugin {
Plugin[] plugins = simulation.getCooja().getStartedPlugins(); Plugin[] plugins = simulation.getCooja().getStartedPlugins();
for (Plugin p: plugins) { for (Plugin p: plugins) {
if (!(p instanceof TimeLine)) { if (!(p instanceof TimeLine)) {
continue; continue;
} }
/* Select simulation time */ /* Select simulation time */
TimeLine plugin = (TimeLine) p; TimeLine plugin = (TimeLine) p;
plugin.trySelectTime(time); plugin.trySelectTime(time);
} }
} }
@ -1039,6 +1066,8 @@ public class RadioLogger extends VisPlugin {
private Action logListenerAction = new AbstractAction("Mote output") { private Action logListenerAction = new AbstractAction("Mote output") {
private static final long serialVersionUID = 1985006491187878651L; private static final long serialVersionUID = 1985006491187878651L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
int selectedRow = dataTable.getSelectedRow(); int selectedRow = dataTable.getSelectedRow();
if (selectedRow < 0) return; if (selectedRow < 0) return;
@ -1049,12 +1078,12 @@ public class RadioLogger extends VisPlugin {
Plugin[] plugins = simulation.getCooja().getStartedPlugins(); Plugin[] plugins = simulation.getCooja().getStartedPlugins();
for (Plugin p: plugins) { for (Plugin p: plugins) {
if (!(p instanceof LogListener)) { if (!(p instanceof LogListener)) {
continue; continue;
} }
/* Select simulation time */ /* Select simulation time */
LogListener plugin = (LogListener) p; LogListener plugin = (LogListener) p;
plugin.trySelectTime(time); plugin.trySelectTime(time);
} }
} }
@ -1062,9 +1091,12 @@ public class RadioLogger extends VisPlugin {
private Action showInAllAction = new AbstractAction("Timeline and mote output") { private Action showInAllAction = new AbstractAction("Timeline and mote output") {
private static final long serialVersionUID = -3888292108886138128L; private static final long serialVersionUID = -3888292108886138128L;
{ {
putValue(ACCELERATOR_KEY, KeyStroke.getKeyStroke(KeyEvent.VK_SPACE, 0, true)); putValue(ACCELERATOR_KEY, KeyStroke.getKeyStroke(KeyEvent.VK_SPACE, 0, true));
} }
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
timeLineAction.actionPerformed(null); timeLineAction.actionPerformed(null);
logListenerAction.actionPerformed(null); logListenerAction.actionPerformed(null);
@ -1075,6 +1107,7 @@ public class RadioLogger extends VisPlugin {
private Action aliasAction = new AbstractAction("Payload alias...") { private Action aliasAction = new AbstractAction("Payload alias...") {
private static final long serialVersionUID = -1678771087456128721L; private static final long serialVersionUID = -1678771087456128721L;
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
int selectedRow = dataTable.getSelectedRow(); int selectedRow = dataTable.getSelectedRow();
if (selectedRow < 0) return; if (selectedRow < 0) return;
@ -1087,15 +1120,15 @@ public class RadioLogger extends VisPlugin {
} }
String alias = (String) JOptionPane.showInputDialog( String alias = (String) JOptionPane.showInputDialog(
Cooja.getTopParentContainer(), Cooja.getTopParentContainer(),
"Enter alias for all packets with identical payload.\n" + "Enter alias for all packets with identical payload.\n"
"An empty string removes the current alias.\n\n" + + "An empty string removes the current alias.\n\n"
connections.get(selectedRow).data + "\n", + connections.get(selectedRow).data + "\n",
"Create packet payload alias", "Create packet payload alias",
JOptionPane.QUESTION_MESSAGE, JOptionPane.QUESTION_MESSAGE,
null, null,
null, null,
current); current);
if (alias == null) { if (alias == null) {
/* Cancelled */ /* Cancelled */
return; return;
@ -1126,6 +1159,7 @@ public class RadioLogger extends VisPlugin {
private boolean showDuplicates = false; private boolean showDuplicates = false;
private AbstractAction showDuplicatesAction = new AbstractAction("Show duplicates") { private AbstractAction showDuplicatesAction = new AbstractAction("Show duplicates") {
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
showDuplicates = !showDuplicates; showDuplicates = !showDuplicates;
rebuildAllEntries(); rebuildAllEntries();
@ -1134,6 +1168,7 @@ public class RadioLogger extends VisPlugin {
private boolean hideNoDestinationPackets = false; private boolean hideNoDestinationPackets = false;
private AbstractAction hideNoDestinationAction = new AbstractAction("Hide airshots") { private AbstractAction hideNoDestinationAction = new AbstractAction("Hide airshots") {
@Override
public void actionPerformed(ActionEvent e) { public void actionPerformed(ActionEvent e) {
hideNoDestinationPackets = !hideNoDestinationPackets; hideNoDestinationPackets = !hideNoDestinationPackets;
rebuildAllEntries(); rebuildAllEntries();
@ -1141,16 +1176,16 @@ public class RadioLogger extends VisPlugin {
}; };
public String getConnectionsString() { public String getConnectionsString() {
StringBuilder sb = new StringBuilder(); StringBuilder sb = new StringBuilder();
RadioConnectionLog[] cs = connections.toArray(new RadioConnectionLog[0]); RadioConnectionLog[] cs = connections.toArray(new RadioConnectionLog[0]);
for(RadioConnectionLog c: cs) { for (RadioConnectionLog c : cs) {
sb.append(c.toString() + "\n"); sb.append(c.toString() + "\n");
} }
return sb.toString(); return sb.toString();
}; }
public void saveConnectionsToFile(String fileName) { public void saveConnectionsToFile(String fileName) {
StringUtils.saveToFile(new File(fileName), getConnectionsString()); StringUtils.saveToFile(new File(fileName), getConnectionsString());
}; }
} }

171
tools/cooja/java/org/contikios/cooja/plugins/analyzers/ICMPv6Analyzer.java
View file

@ -2,99 +2,110 @@ package org.contikios.cooja.plugins.analyzers;
public class ICMPv6Analyzer extends PacketAnalyzer { public class ICMPv6Analyzer extends PacketAnalyzer {
public static final byte ICMPv6_DISPATCH = 58; public static final byte ICMPv6_DISPATCH = 58;
public static final int ECHO_REQUEST = 128; public static final int ECHO_REQUEST = 128;
public static final int ECHO_REPLY = 129; public static final int ECHO_REPLY = 129;
public static final int GROUP_QUERY = 130; public static final int GROUP_QUERY = 130;
public static final int GROUP_REPORT = 131; public static final int GROUP_REPORT = 131;
public static final int GROUP_REDUCTION = 132; public static final int GROUP_REDUCTION = 132;
public static final int ROUTER_SOLICITATION = 133; public static final int ROUTER_SOLICITATION = 133;
public static final int ROUTER_ADVERTISEMENT = 134; public static final int ROUTER_ADVERTISEMENT = 134;
public static final int NEIGHBOR_SOLICITATION = 135; public static final int NEIGHBOR_SOLICITATION = 135;
public static final int NEIGHBOR_ADVERTISEMENT = 136; public static final int NEIGHBOR_ADVERTISEMENT = 136;
public static final int RPL_CODE_DIS = 0; /* DIS message */ public static final int RPL_CODE_DIS = 0; /* DIS message */
public static final int RPL_CODE_DIO = 1; /* DIO message */ public static final int RPL_CODE_DIO = 1; /* DIO message */
public static final int RPL_CODE_DAO = 2;/* DAO message */ public static final int RPL_CODE_DAO = 2;/* DAO message */
public static final int RPL_CODE_DAO_ACK = 3;/* DAO ACK message */ public static final int RPL_CODE_DAO_ACK = 3;/* DAO ACK message */
public static final int FLAG_ROUTER = 0x80; public static final int FLAG_ROUTER = 0x80;
public static final int FLAG_SOLICITED = 0x40; public static final int FLAG_SOLICITED = 0x40;
public static final int FLAG_OVERRIDE = 0x20; public static final int FLAG_OVERRIDE = 0x20;
public static final int ON_LINK = 0x80; public static final int ON_LINK = 0x80;
public static final int AUTOCONFIG = 0x40; public static final int AUTOCONFIG = 0x40;
public static final int SOURCE_LINKADDR = 1; public static final int SOURCE_LINKADDR = 1;
public static final int TARGET_LINKADDR = 2; public static final int TARGET_LINKADDR = 2;
public static final int PREFIX_INFO = 3; public static final int PREFIX_INFO = 3;
public static final int MTU_INFO = 5; public static final int MTU_INFO = 5;
public static final String[] TYPE_NAME = new String[] { public static final String[] TYPE_NAME = new String[]{
"ECHO_REQUEST", "ECHO_REPLY", "Echo Request", "Echo Reply",
"GROUP_QUERY", "GROUP_REPORT", "GROUP_REDUCTION", "Group Query", "Group Report", "Group Reduction",
"ROUTER_SOLICITATION", "ROUTER_ADVERTISEMENT", "Router Solicitation", "Router Advertisement",
"NEIGHBOR_SOLICITATION", "NEIGHBOR_ADVERTISEMENT", "REDIRECT", "Neighbor Solicitation", "Neighbor Advertisement", "Redirect",
"ROUTER RENUMBER", "NODE INFORMATION QUERY", "NODE INFORMATION RESPONSE"}; "Router Renumber", "Node Information Query", "Node Information Response"};
public static final String[] BRIEF_TYPE_NAME = new String[]{
"ECHO REQ", "ECHO RPLY",
"GRP QUERY", "GRP REPORT", "GRP REDUCTION",
"RS", "RA",
"NS", "NA", "REDIRECT",
"ROUTER RENUMBER", "NODE INFO QUERY", "NODE INFO RESP"};
public int analyzePacket(Packet packet, StringBuffer brief, @Override
StringBuffer verbose) { public int analyzePacket(Packet packet, StringBuilder brief,
int type = packet.get(0) & 0xff; StringBuilder verbose) {
int code = packet.get(1) & 0xff; int type = packet.get(0) & 0xff;
int code = packet.get(1) & 0xff;
// int checksum = ((packet.get(2) & 0xff) << 8) | packet.get(3) & 0xff; // int checksum = ((packet.get(2) & 0xff) << 8) | packet.get(3) & 0xff;
brief.append("ICMPv6 "); brief.append("ICMPv6 ");
if (type >= 128 && (type - 128) < TYPE_NAME.length) { verbose.append("<b>ICMPv6</b>");
brief.append(TYPE_NAME[type - 128]).append(' ').append(code); if (type >= 128 && (type - 128) < TYPE_NAME.length) {
verbose.append("Type: ").append(TYPE_NAME[type - 128]); brief.append(BRIEF_TYPE_NAME[type - 128]).append(' ').append(code);
verbose.append(" Code:").append(code); verbose.append("<br/>Type: ").append(TYPE_NAME[type - 128]);
} else if (type == 155) { verbose.append(", Code:").append(code);
/* RPL */ } else if (type == 155) {
brief.append("RPL "); /* RPL */
verbose.append("Type: RPL Code: "); brief.append("RPL ");
switch(code) { verbose.append("<br/>Type: RPL Code: ");
case RPL_CODE_DIS: switch (code) {
brief.append("DIS"); case RPL_CODE_DIS:
verbose.append("DIS"); brief.append("DIS");
break; verbose.append("DIS");
case RPL_CODE_DIO: break;
brief.append("DIO"); case RPL_CODE_DIO:
verbose.append("DIO<br>"); brief.append("DIO");
verbose.append("DIO<br>");
int instanceID = packet.get(4) & 0xff; int instanceID = packet.get(4) & 0xff;
int version = packet.get(5) & 0xff; int version = packet.get(5) & 0xff;
int rank = ((packet.get(6) & 0xff) << 8) + (packet.get(7) & 0xff); int rank = ((packet.get(6) & 0xff) << 8) + (packet.get(7) & 0xff);
int mop = (packet.get(8) >> 3) & 0x07; int mop = (packet.get(8) >> 3) & 0x07;
int dtsn = packet.get(9); int dtsn = packet.get(9) & 0xFF;
verbose.append(" InstanceID: " + instanceID + " Version: " + version + verbose.append(" InstanceID: ").append(instanceID)
" Rank:" + rank + " MOP: " + mop + " DTSN: " + dtsn); .append(", Version: ").append(version)
packet.consumeBytesStart(8); .append(", Rank: ").append(rank)
.append(", MOP: ").append(mop)
.append(", DTSN: ").append(dtsn);
packet.consumeBytesStart(8);
break; break;
case RPL_CODE_DAO: case RPL_CODE_DAO:
brief.append("DAO"); brief.append("DAO");
verbose.append("DAO"); verbose.append("DAO");
break; break;
case RPL_CODE_DAO_ACK: case RPL_CODE_DAO_ACK:
brief.append("DAO ACK"); brief.append("DAO ACK");
verbose.append("DAO ACK"); verbose.append("DAO ACK");
break; break;
default: default:
brief.append(code); brief.append(code);
verbose.append(code); verbose.append(code);
} }
}
/* remove type, code, crc */
packet.consumeBytesStart(4);
return ANALYSIS_OK_FINAL;
} }
@Override /* remove type, code, crc */
public boolean matchPacket(Packet packet) { packet.consumeBytesStart(4);
return packet.level == APPLICATION_LEVEL && packet.lastDispatch == ICMPv6_DISPATCH; return ANALYSIS_OK_FINAL;
} }
@Override
public boolean matchPacket(Packet packet) {
return packet.level == APPLICATION_LEVEL && packet.lastDispatch == ICMPv6_DISPATCH;
}
} }

323
tools/cooja/java/org/contikios/cooja/plugins/analyzers/IEEE802154Analyzer.java
View file

@ -7,175 +7,206 @@ import org.contikios.cooja.util.StringUtils;
public class IEEE802154Analyzer extends PacketAnalyzer { public class IEEE802154Analyzer extends PacketAnalyzer {
/* TODO: fix this to be correct */ // Addressing modes
public static final int NO_ADDRESS = 0; public static final int NO_ADDRESS = 0;
public static final int RSV_ADDRESS = 1; public static final int RSV_ADDRESS = 1;
public static final int SHORT_ADDRESS = 2; public static final int SHORT_ADDRESS = 2;
public static final int LONG_ADDRESS = 3; public static final int LONG_ADDRESS = 3;
public static final int BEACONFRAME = 0x00; // Frame types
public static final int DATAFRAME = 0x01; public static final int BEACONFRAME = 0x00;
public static final int ACKFRAME = 0x02; public static final int DATAFRAME = 0x01;
public static final int CMDFRAME = 0x03; public static final int ACKFRAME = 0x02;
public static final int CMDFRAME = 0x03;
// private static final byte[] BROADCAST_ADDR = {(byte)0xff, (byte)0xff}; // private static final byte[] BROADCAST_ADDR = {(byte)0xff, (byte)0xff};
private static final String[] typeS = {"-", "D", "A", "C"};
private static final String[] typeS = {"-", "D", "A"}; private static final String[] typeVerbose = {"BEACON", "DATA", "ACK", "CMD"};
private static final String[] typeVerbose = {"BEACON", "DATA", "ACK"}; private static final String[] addrModeNames = {"None", "Reserved", "Short", "Long"};
private PcapExporter pcapExporter; private PcapExporter pcapExporter;
// private int defaultAddressMode = LONG_ADDRESS; // private int defaultAddressMode = LONG_ADDRESS;
// private byte seqNo = 0; // private byte seqNo = 0;
// private int myPanID = 0xabcd; // private int myPanID = 0xabcd;
public IEEE802154Analyzer(boolean pcap) {
public IEEE802154Analyzer(boolean pcap) { if (pcap) {
if (pcap) try { try {
pcapExporter = new PcapExporter(); pcapExporter = new PcapExporter();
} catch (IOException e) { } catch (IOException e) {
e.printStackTrace(); e.printStackTrace();
} }
} }
}
public void setPcapFile(File pcapFile) { public void setPcapFile(File pcapFile) {
if (pcapExporter != null) { if (pcapExporter != null) {
try { try {
pcapExporter.openPcap(pcapFile); pcapExporter.openPcap(pcapFile);
} catch (IOException e) { } catch (IOException e) {
System.err.println("Could not open pcap file"); System.err.println("Could not open pcap file");
e.printStackTrace(); e.printStackTrace();
} }
}
}
@Override
public boolean matchPacket(Packet packet) {
return packet.level == MAC_LEVEL;
}
/* this protocol always have network level packets as payload */
public int nextLevel(byte[] packet, int level) {
return NETWORK_LEVEL;
}
/* create a 802.15.4 packet of the bytes and "dispatch" to the
* next handler
*/
@Override
public int analyzePacket(Packet packet, StringBuilder brief, StringBuilder verbose) {
if (pcapExporter != null) {
try {
pcapExporter.exportPacketData(packet.getPayload());
} catch (IOException e) {
System.err.println("Could not export PCap data");
e.printStackTrace();
} }
} }
public boolean matchPacket(Packet packet) { int pos = packet.pos;
return packet.level == MAC_LEVEL; // FCF field
int fcfType = packet.data[pos + 0] & 0x07;
boolean fcfSecurity = ((packet.data[pos + 0] >> 3) & 0x01) != 0;
boolean fcfPending = ((packet.data[pos + 0] >> 4) & 0x01) != 0;
boolean fcfAckRequested = ((packet.data[pos + 0] >> 5) & 0x01) != 0;
boolean fcfIntraPAN = ((packet.data[pos + 0] >> 6) & 0x01) != 0;
int fcfDestAddrMode = (packet.data[pos + 1] >> 2) & 0x03;
int fcfFrameVersion = (packet.data[pos + 1] >> 4) & 0x03;
int fcfSrcAddrMode = (packet.data[pos + 1] >> 6) & 0x03;
// Sequence number
int seqNumber = packet.data[pos + 2] & 0xff;
// Addressing Fields
int destPanID = 0;
int srcPanID = 0;
byte[] sourceAddress = null;
byte[] destAddress = null;
pos += 3;
if (fcfDestAddrMode > 0) {
destPanID = (packet.data[pos] & 0xff) + ((packet.data[pos + 1] & 0xff) << 8);
pos += 2;
if (fcfDestAddrMode == SHORT_ADDRESS) {
destAddress = new byte[2];
destAddress[1] = packet.data[pos];
destAddress[0] = packet.data[pos + 1];
pos += 2;
} else if (fcfDestAddrMode == LONG_ADDRESS) {
destAddress = new byte[8];
for (int i = 0; i < 8; i++) {
destAddress[i] = packet.data[pos + 7 - i];
}
pos += 8;
}
} }
/* this protocol always have network level packets as payload */ if (fcfSrcAddrMode > 0) {
public int nextLevel(byte[] packet, int level) { if (fcfIntraPAN) {
return NETWORK_LEVEL; srcPanID = destPanID;
} else {
srcPanID = (packet.data[pos] & 0xff) + ((packet.data[pos + 1] & 0xff) << 8);
pos += 2;
}
if (fcfSrcAddrMode == SHORT_ADDRESS) {
sourceAddress = new byte[2];
sourceAddress[1] = packet.data[pos];
sourceAddress[0] = packet.data[pos + 1];
pos += 2;
} else if (fcfSrcAddrMode == LONG_ADDRESS) {
sourceAddress = new byte[8];
for (int i = 0; i < 8; i++) {
sourceAddress[i] = packet.data[pos + 7 - i];
}
pos += 8;
}
} }
/* create a 802.15.4 packet of the bytes and "dispatch" to the
* next handler
*/
public int analyzePacket(Packet packet, StringBuffer brief, StringBuffer verbose) {
if (pcapExporter != null) {
try {
pcapExporter.exportPacketData(packet.getPayload());
} catch (IOException e) {
System.err.println("Could not export PCap data");
e.printStackTrace();
}
}
int pos = packet.pos;
int type = packet.data[pos + 0] & 7;
// int security = (packet.data[pos + 0] >> 3) & 1;
// int pending = (packet.data[pos + 0] >> 4) & 1;
// int ackRequired = (packet.data[pos + 0] >> 5) & 1;
int panCompression = (packet.data[pos + 0]>> 6) & 1;
int destAddrMode = (packet.data[pos + 1] >> 2) & 3;
// int frameVersion = (packet.data[pos + 1] >> 4) & 3;
int srcAddrMode = (packet.data[pos + 1] >> 6) & 3;
int seqNumber = packet.data[pos + 2] & 0xff;
int destPanID = 0;
int srcPanID = 0;
byte[] sourceAddress = null;
byte[] destAddress = null;
pos += 3;
if (destAddrMode > 0) {
destPanID = (packet.data[pos] & 0xff) + ((packet.data[pos + 1] & 0xff) << 8);
pos += 2;
if (destAddrMode == SHORT_ADDRESS) {
destAddress = new byte[2];
destAddress[1] = packet.data[pos];
destAddress[0] = packet.data[pos + 1];
pos += 2;
} else if (destAddrMode == LONG_ADDRESS) {
destAddress = new byte[8];
for (int i = 0; i < 8; i++) {
destAddress[i] = packet.data[pos + 7 - i];
}
pos += 8;
}
}
if (srcAddrMode > 0) {
if (panCompression == 0){
srcPanID = (packet.data[pos] & 0xff) + ((packet.data[pos + 1] & 0xff) << 8);
pos += 2;
} else {
srcPanID = destPanID;
}
if (srcAddrMode == SHORT_ADDRESS) {
sourceAddress = new byte[2];
sourceAddress[1] = packet.data[pos];
sourceAddress[0] = packet.data[pos + 1];
pos += 2;
} else if (srcAddrMode == LONG_ADDRESS) {
sourceAddress = new byte[8];
for (int i = 0; i < 8; i++) {
sourceAddress[i] = packet.data[pos + 7 - i];
}
pos += 8;
}
}
// int payloadLen = packet.data.length - pos; // int payloadLen = packet.data.length - pos;
brief.append("15.4 ");
brief.append(fcfType < typeS.length ? typeS[fcfType] : "?").append(' ');
brief.append("15.4 "); verbose.append("<html><b>IEEE 802.15.4 ")
brief.append(type < typeS.length ? typeS[type] : "?").append(' '); .append(fcfType < typeVerbose.length ? typeVerbose[fcfType] : "?")
.append("</b> #").append(seqNumber);
verbose.append("<html><b>IEEE 802.15.4 ") if (fcfType != ACKFRAME) {
.append(type < typeVerbose.length ? typeVerbose[type] : "?") printAddress(brief, fcfSrcAddrMode, sourceAddress);
.append(' ').append(seqNumber); brief.append(' ');
if (type != ACKFRAME) { printAddress(brief, fcfDestAddrMode, destAddress);
printAddress(brief, srcAddrMode, sourceAddress);
brief.append(' ');
printAddress(brief, destAddrMode, destAddress);
verbose.append("</b><br>From "); verbose.append("<br>From ");
if (srcPanID != 0) { if (srcPanID != 0) {
verbose.append(StringUtils.toHex((byte)(srcPanID >> 8))) verbose.append("0x")
.append(StringUtils.toHex((byte)(srcPanID & 0xff))) .append(StringUtils.toHex((byte) (srcPanID >> 8)))
.append(StringUtils.toHex((byte) (srcPanID & 0xff)))
.append('/'); .append('/');
} }
printAddress(verbose, srcAddrMode, sourceAddress); printAddress(verbose, fcfSrcAddrMode, sourceAddress);
verbose.append(" to "); verbose.append(" to ");
if (destPanID != 0) { if (destPanID != 0) {
verbose.append(StringUtils.toHex((byte)(destPanID >> 8))) verbose.append("0x")
.append(StringUtils.toHex((byte)(destPanID & 0xff))) .append(StringUtils.toHex((byte) (destPanID >> 8)))
.append(StringUtils.toHex((byte) (destPanID & 0xff)))
.append('/'); .append('/');
} }
printAddress(verbose, destAddrMode, destAddress); printAddress(verbose, fcfDestAddrMode, destAddress);
} else {
/* got ack - no more to do ... */
return ANALYSIS_OK_FINAL;
}
/* update packet */
packet.pos = pos;
packet.level = NETWORK_LEVEL;
/* remove CRC from the packet */
packet.consumeBytesEnd(2);
packet.llsender = sourceAddress;
packet.llreceiver = destAddress;
return ANALYSIS_OK_CONTINUE;
} }
private void printAddress(StringBuffer sb, int type, byte[] addr) { verbose.append("<br/>Sec = ").append(fcfSecurity)
if (type == SHORT_ADDRESS) { .append(", Pend = ").append(fcfPending)
sb.append(StringUtils.toHex(addr)); .append(", ACK = ").append(fcfAckRequested)
} else if (type == LONG_ADDRESS) { .append(", iPAN = ").append(fcfIntraPAN)
sb.append(StringUtils.toHex(addr[0]) + StringUtils.toHex(addr[1]) + ":" + .append(", DestAddr = ").append(addrModeNames[fcfDestAddrMode])
StringUtils.toHex(addr[2]) + StringUtils.toHex(addr[3]) + ":" + .append(", Vers. = ").append(fcfFrameVersion)
StringUtils.toHex(addr[4]) + StringUtils.toHex(addr[5]) + ":" + .append(", SrcAddr = ").append(addrModeNames[fcfSrcAddrMode]);
StringUtils.toHex(addr[6]) + StringUtils.toHex(addr[7]));
} /* update packet */
packet.pos = pos;
/* remove CRC from the packet */
packet.consumeBytesEnd(2);
if (fcfType == ACKFRAME) {
/* got ack - no more to do ... */
return ANALYSIS_OK_FINAL;
} }
packet.level = NETWORK_LEVEL;
packet.llsender = sourceAddress;
packet.llreceiver = destAddress;
return ANALYSIS_OK_CONTINUE;
}
private void printAddress(StringBuilder sb, int type, byte[] addr) {
if (type == SHORT_ADDRESS) {
sb.append("0x").append(StringUtils.toHex(addr));
} else if (type == LONG_ADDRESS) {
sb.append(StringUtils.toHex(addr[0]))
.append(':')
.append(StringUtils.toHex(addr[1]))
.append(':')
.append(StringUtils.toHex(addr[2]))
.append(':')
.append(StringUtils.toHex(addr[3]))
.append(':')
.append(StringUtils.toHex(addr[4]))
.append(':')
.append(StringUtils.toHex(addr[5]))
.append(':')
.append(StringUtils.toHex(addr[6]))
.append(':')
.append(StringUtils.toHex(addr[7]));
}
}
} }

801
tools/cooja/java/org/contikios/cooja/plugins/analyzers/IPHCPacketAnalyzer.java
View file

@ -4,365 +4,426 @@ import org.contikios.cooja.util.StringUtils;
public class IPHCPacketAnalyzer extends PacketAnalyzer { public class IPHCPacketAnalyzer extends PacketAnalyzer {
public final static int SICSLOWPAN_UDP_PORT_MIN = 0xF0B0; public final static int SICSLOWPAN_UDP_4_BIT_PORT_MIN = 0xF0B0;
public final static int SICSLOWPAN_UDP_PORT_MAX = 0xF0BF; /* F0B0 + 15 */ public final static int SICSLOWPAN_UDP_4_BIT_PORT_MAX = 0xF0BF; /* F0B0 + 15 */
public final static int SICSLOWPAN_UDP_8_BIT_PORT_MIN = 0xF000;
public final static int SICSLOWPAN_UDP_8_BIT_PORT_MAX = 0xF0FF; /* F000 + 255 */
public final static int SICSLOWPAN_DISPATCH_IPV6 = 0x41; /* 01000001 = 65 */ public final static int SICSLOWPAN_DISPATCH_IPV6 = 0x41; /* 01000001 = 65 */
public final static int SICSLOWPAN_DISPATCH_HC1 = 0x42; /* 01000010 = 66 */ public final static int SICSLOWPAN_DISPATCH_HC1 = 0x42; /* 01000010 = 66 */
public final static int SICSLOWPAN_DISPATCH_IPHC = 0x60; /* 011xxxxx = ... */ public final static int SICSLOWPAN_DISPATCH_IPHC = 0x60; /* 011xxxxx = ... */
public final static int SICSLOWPAN_DISPATCH_FRAG1 = 0xc0; /* 1100= 0xxx */
public final static int SICSLOWPAN_DISPATCH_FRAGN = 0xe0; /* 1110= 0xxx */
/* public final static int EXT_HDR_HOP_BY_HOP = 0;
* Values of fields within the IPHC encoding first byte public final static int EXT_HDR_ROUTING = 43;
* (C stands for compressed and I for inline) public final static int EXT_HDR_FRAGMENT = 44;
*/
public final static int SICSLOWPAN_IPHC_FL_C = 0x10; /*
public final static int SICSLOWPAN_IPHC_TC_C = 0x08; * Values of fields within the IPHC encoding first byte
public final static int SICSLOWPAN_IPHC_NH_C = 0x04; * (C stands for compressed and I for inline)
public final static int SICSLOWPAN_IPHC_TTL_1 = 0x01; */
public final static int SICSLOWPAN_IPHC_TTL_64 = 0x02; public final static int SICSLOWPAN_IPHC_FL_C = 0x10;
public final static int SICSLOWPAN_IPHC_TTL_255 = 0x03; public final static int SICSLOWPAN_IPHC_TC_C = 0x08;
public final static int SICSLOWPAN_IPHC_TTL_I = 0x00; public final static int SICSLOWPAN_IPHC_NH_C = 0x04;
public final static int SICSLOWPAN_IPHC_TTL_1 = 0x01;
public final static int SICSLOWPAN_IPHC_TTL_64 = 0x02;
public final static int SICSLOWPAN_IPHC_TTL_255 = 0x03;
public final static int SICSLOWPAN_IPHC_TTL_I = 0x00;
/* Values of fields within the IPHC encoding second byte */ /* Values of fields within the IPHC encoding second byte */
public final static int SICSLOWPAN_IPHC_CID = 0x80; public final static int SICSLOWPAN_IPHC_CID = 0x80;
public final static int SICSLOWPAN_IPHC_SAC = 0x40; public final static int SICSLOWPAN_IPHC_SAC = 0x40;
public final static int SICSLOWPAN_IPHC_SAM_00 = 0x00; public final static int SICSLOWPAN_IPHC_SAM_00 = 0x00;
public final static int SICSLOWPAN_IPHC_SAM_01 = 0x10; public final static int SICSLOWPAN_IPHC_SAM_01 = 0x10;
public final static int SICSLOWPAN_IPHC_SAM_10 = 0x20; public final static int SICSLOWPAN_IPHC_SAM_10 = 0x20;
public final static int SICSLOWPAN_IPHC_SAM_11 = 0x30; public final static int SICSLOWPAN_IPHC_SAM_11 = 0x30;
public final static int SICSLOWPAN_IPHC_M = 0x08; public final static int SICSLOWPAN_IPHC_M = 0x08;
public final static int SICSLOWPAN_IPHC_DAC = 0x04; public final static int SICSLOWPAN_IPHC_DAC = 0x04;
public final static int SICSLOWPAN_IPHC_DAM_00 = 0x00; public final static int SICSLOWPAN_IPHC_DAM_00 = 0x00;
public final static int SICSLOWPAN_IPHC_DAM_01 = 0x01; public final static int SICSLOWPAN_IPHC_DAM_01 = 0x01;
public final static int SICSLOWPAN_IPHC_DAM_10 = 0x02; public final static int SICSLOWPAN_IPHC_DAM_10 = 0x02;
public final static int SICSLOWPAN_IPHC_DAM_11 = 0x03; public final static int SICSLOWPAN_IPHC_DAM_11 = 0x03;
private static final int SICSLOWPAN_NDC_UDP_MASK = 0xf8; private static final int SICSLOWPAN_NDC_UDP_MASK = 0xf8;
private static final int SICSLOWPAN_NHC_UDP_ID = 0xf0; private static final int SICSLOWPAN_NHC_UDP_ID = 0xf0;
private static final int SICSLOWPAN_NHC_UDP_C = 0xf3; private static final int SICSLOWPAN_NHC_UDP_00 = 0xf0;
private static final int SICSLOWPAN_NHC_UDP_I = 0xf0; private static final int SICSLOWPAN_NHC_UDP_01 = 0xf1;
private static final int SICSLOWPAN_NHC_UDP_10 = 0xf2;
private static final int SICSLOWPAN_NHC_UDP_11 = 0xf3;
public final static int PROTO_UDP = 17; public final static int PROTO_UDP = 17;
public final static int PROTO_TCP = 6; public final static int PROTO_TCP = 6;
public final static int PROTO_ICMP = 58; public final static int PROTO_ICMP = 58;
public final static byte[] UNSPECIFIED_ADDRESS
= {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
public final static byte[] UNSPECIFIED_ADDRESS = private static byte[][] addrContexts = new byte[][]{
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; {(byte) 0xaa, (byte) 0xaa, 0, 0, 0, 0, 0, 0}
};
private static byte[][] addrContexts = new byte[][] { private static final int IPHC_DISPATCH = 0x60;
{(byte)0xaa, (byte)0xaa, 0, 0, 0, 0, 0, 0}
};
private static final int IPHC_DISPATCH = 0x60; /* packet must be on network level && have a IPHC dispatch */
@Override
public boolean matchPacket(Packet packet) {
return packet.level == NETWORK_LEVEL && (packet.get(0) & 0xe0) == IPHC_DISPATCH;
}
/* packet must be on network level && have a IPHC dispatch */ @Override
public boolean matchPacket(Packet packet) { public int analyzePacket(Packet packet, StringBuilder brief,
return packet.level == NETWORK_LEVEL && (packet.get(0) & 0xe0) == IPHC_DISPATCH; StringBuilder verbose) {
/* if packet has less than 3 bytes it is not interesting ... */
if (packet.size() < 3) return ANALYSIS_FAILED;
int tf = (packet.get(0) >> 3) & 0x03;
boolean nhc = (packet.get(0) & SICSLOWPAN_IPHC_NH_C) > 0;
int hlim = (packet.get(0) & 0x03);
switch (hlim) {
case 0x00:
hlim = 0;
break;
case 0x01:
hlim = 1;
break;
case 0x02:
hlim = 64;
break;
case 0x03:
hlim = 255;
break;
}
int cid = (packet.get(1) >> 7) & 0x01;
int sac = (packet.get(1) >> 6) & 0x01;
int sam = (packet.get(1) >> 4) & 0x03;
boolean m = ((packet.get(1) >> 3) & 0x01) != 0;
int dac = (packet.get(1) >> 2) & 0x01;
int dam = packet.get(1) & 0x03;
int sci = 0;
int dci = 0;
String error = null;
brief.append("IPHC");
/* need to decompress while analyzing - add that later... */
verbose.append("<b>IPHC HC-06</b><br>");
verbose.append("TF = ").append(tf)
.append(", NH = ").append(nhc ? "compressed" : "inline")
.append(", HLIM = ").append(hlim == 0 ? "inline" : hlim)
.append(", CID = ").append(cid)
.append(", SAC = ").append(sac == 1 ? "stateless" : "stateful")
.append(", SAM = ").append(sam)
.append(", MCast = ").append(m)
.append(", DAC = ").append(dac == 1 ? "stateless" : "stateful")
.append(", DAM = ").append(dam);
if (cid == 1) {
verbose.append("<br>Contexts: sci=").append(packet.get(2) >> 4).
append(" dci=").append(packet.get(2) & 0x0f);
sci = packet.get(2) >> 4;
dci = packet.get(2) & 0x0f;
} }
public int analyzePacket(Packet packet, StringBuffer brief, int hc06_ptr = 2 + cid;
StringBuffer verbose) {
/* if packet has less than 3 bytes it is not interesting ... */ int version = 6;
if (packet.size() < 3) return ANALYSIS_FAILED; int trafficClass = 0;
int flowLabel = 0;
int len = 0;
int proto = 0;
int ttl = 0;
byte[] srcAddress = new byte[16];
byte[] destAddress = new byte[16];
int tf = (packet.get(0) >> 3) & 0x03; int srcPort = 0;
boolean nhc = (packet.get(0) & SICSLOWPAN_IPHC_NH_C) > 0; int destPort = 0;
int hlim = (packet.get(0) & 0x03);
int cid = (packet.get(1) >> 7) & 0x01;
int sac = (packet.get(1) >> 6) & 0x01;
int sam = (packet.get(1) >> 4) & 0x03;
int m = (packet.get(1) >> 3) & 0x01;
int dac = (packet.get(1) >> 2) & 0x01;
int dam = packet.get(1) & 0x03;
int sci = 0;
int dci = 0;
String error = null; try {
/* Traffic class and flow label */
brief.append("IPHC"); if ((packet.get(0) & SICSLOWPAN_IPHC_FL_C) == 0) {
/* Flow label are carried inline */
/* need to decompress while analyzing - add that later... */ if ((packet.get(0) & SICSLOWPAN_IPHC_TC_C) == 0) {
/* Traffic class is carried inline */
verbose.append("<b>IPHC HC-06</b><br>"); flowLabel = packet.getInt(hc06_ptr + 1, 3);
verbose.append("tf = " + tf + " nhc = " + nhc + " hlim = " + hlim int tmp = packet.get(hc06_ptr);
+ " cid = " + cid + " sac = " + sac + " sam = " + sam hc06_ptr += 4;
+ " MCast = " + m + " dac = " + dac + " dam = " + dam); /* hc06 format of tc is ECN | DSCP , original is DSCP | ECN */
if (cid == 1) { trafficClass = ((tmp >> 2) & 0x3f) | (tmp << 6) & (0x80 + 0x40);
verbose.append("<br>Contexts: sci=" + (packet.get(2) >> 4) + " dci=" /* ECN rolled down two steps + lowest DSCP bits at top two bits */
+ (packet.get(2) & 0x0f));
sci = packet.get(2) >> 4;
dci = packet.get(2) & 0x0f;
}
int hc06_ptr = 2 + cid;
int version = 6;
int trafficClass = 0;
int flowLabel = 0;
int len = 0;
int proto = 0;
int ttl = 0;
byte[] srcAddress = new byte[16];
byte[] destAddress = new byte[16];
int srcPort = 0;
int destPort = 0;
try {
/* Traffic class and flow label */
if((packet.get(0) & SICSLOWPAN_IPHC_FL_C) == 0) {
/* Flow label are carried inline */
if((packet.get(0) & SICSLOWPAN_IPHC_TC_C) == 0) {
/* Traffic class is carried inline */
flowLabel = packet.getInt(hc06_ptr + 1, 3);
int tmp = packet.get(hc06_ptr);
hc06_ptr += 4;
/* hc06 format of tc is ECN | DSCP , original is DSCP | ECN */
trafficClass = ((tmp >> 2) & 0x3f) | (tmp << 6) & (0x80 + 0x40);
/* ECN rolled down two steps + lowest DSCP bits at top two bits */
} else {
/* highest flow label bits + ECN bits */
int tmp = packet.get(hc06_ptr);
trafficClass = (tmp >> 6) & 0x0f;
flowLabel = packet.getInt(hc06_ptr + 1, 2);
hc06_ptr += 3;
}
} else { } else {
/* Version is always 6! */ /* highest flow label bits + ECN bits */
/* Version and flow label are compressed */ int tmp = packet.get(hc06_ptr);
if((packet.get(0) & SICSLOWPAN_IPHC_TC_C) == 0) { trafficClass = (tmp >> 6) & 0x0f;
/* Traffic class is inline */ flowLabel = packet.getInt(hc06_ptr + 1, 2);
trafficClass =((packet.get(hc06_ptr) >> 6) & 0x03); hc06_ptr += 3;
trafficClass |= (packet.get(hc06_ptr) << 2);
hc06_ptr += 1;
}
} }
} else {
/* Next Header */ /* Version is always 6! */
if((packet.get(0) & SICSLOWPAN_IPHC_NH_C) == 0) { /* Version and flow label are compressed */
/* Next header is carried inline */ if ((packet.get(0) & SICSLOWPAN_IPHC_TC_C) == 0) {
proto = packet.get(hc06_ptr); /* Traffic class is inline */
hc06_ptr += 1; trafficClass = ((packet.get(hc06_ptr) >> 6) & 0x03);
trafficClass |= (packet.get(hc06_ptr) << 2);
hc06_ptr += 1;
} }
}
/* Hop limit */ /* Next Header */
switch(packet.get(0) & 0x03) { if ((packet.get(0) & SICSLOWPAN_IPHC_NH_C) == 0) {
/* Next header is carried inline */
proto = packet.get(hc06_ptr);
hc06_ptr += 1;
}
/* Hop limit */
switch (packet.get(0) & 0x03) {
case SICSLOWPAN_IPHC_TTL_1: case SICSLOWPAN_IPHC_TTL_1:
ttl = 1; ttl = 1;
break; break;
case SICSLOWPAN_IPHC_TTL_64: case SICSLOWPAN_IPHC_TTL_64:
ttl = 2; ttl = 64;
break; break;
case SICSLOWPAN_IPHC_TTL_255: case SICSLOWPAN_IPHC_TTL_255:
ttl = 255; ttl = 255;
break; break;
case SICSLOWPAN_IPHC_TTL_I: case SICSLOWPAN_IPHC_TTL_I:
ttl = packet.get(hc06_ptr); ttl = packet.get(hc06_ptr);
hc06_ptr += 1; hc06_ptr += 1;
break;
}
/* context based compression */
if ((packet.get(1) & SICSLOWPAN_IPHC_SAC) > 0) {
/* Source address */
byte[] context = null;
if ((packet.get(1) & SICSLOWPAN_IPHC_SAM_11) != SICSLOWPAN_IPHC_SAM_00) {
context = addrContexts[sci];
}
switch (packet.get(1) & SICSLOWPAN_IPHC_SAM_11) {
case SICSLOWPAN_IPHC_SAM_00:
/* copy the unspecificed address */
srcAddress = UNSPECIFIED_ADDRESS;
break;
case SICSLOWPAN_IPHC_SAM_01: /* 64 bits */
/* copy prefix from context */
System.arraycopy(context, 0, srcAddress, 0, 8);
/* copy IID from packet */
packet.copy(hc06_ptr, srcAddress, 8, 8);
hc06_ptr += 8;
break;
case SICSLOWPAN_IPHC_SAM_10: /* 16 bits */
/* unicast address */
System.arraycopy(context, 0, srcAddress, 0, 8);
/* copy 6 NULL bytes then 2 last bytes of IID */
packet.copy(hc06_ptr, srcAddress, 14, 2);
hc06_ptr += 2;
break;
case SICSLOWPAN_IPHC_SAM_11: /* 0-bits */
/* copy prefix from context */
System.arraycopy(context, 0, srcAddress, 0, 8);
/* infer IID from L2 address */
System.arraycopy(packet.llsender, 0, srcAddress,
16 - packet.llsender.length, packet.llsender.length);
break; break;
} }
/* end context based compression */
} else {
/* no compression and link local */
switch (packet.get(1) & SICSLOWPAN_IPHC_SAM_11) {
case SICSLOWPAN_IPHC_SAM_00: /* 128 bits */
/* copy whole address from packet */
/* context based compression */ packet.copy(hc06_ptr, srcAddress, 0, 16);
if((packet.get(1) & SICSLOWPAN_IPHC_SAC) > 0) { hc06_ptr += 16;
/* Source address */ break;
byte[] context = null; case SICSLOWPAN_IPHC_SAM_01: /* 64 bits */
if((packet.get(1) & SICSLOWPAN_IPHC_SAM_11) != SICSLOWPAN_IPHC_SAM_00) {
context = addrContexts[sci];
}
switch(packet.get(1) & SICSLOWPAN_IPHC_SAM_11) { srcAddress[0] = (byte) 0xfe;
case SICSLOWPAN_IPHC_SAM_00: srcAddress[1] = (byte) 0x80;
/* copy the unspecificed address */ /* copy IID from packet */
srcAddress = UNSPECIFIED_ADDRESS; packet.copy(hc06_ptr, srcAddress, 8, 8);
break; hc06_ptr += 8;
case SICSLOWPAN_IPHC_SAM_01: /* 64 bits */ break;
/* copy prefix from context */ case SICSLOWPAN_IPHC_SAM_10: /* 16 bits */
System.arraycopy(context, 0, srcAddress, 0, 8);
/* copy IID from packet */ srcAddress[0] = (byte) 0xfe;
packet.copy(hc06_ptr, srcAddress, 8, 8); srcAddress[1] = (byte) 0x80;
hc06_ptr += 8; packet.copy(hc06_ptr, srcAddress, 14, 2);
break; hc06_ptr += 2;
case SICSLOWPAN_IPHC_SAM_10: /* 16 bits */ break;
/* unicast address */ case SICSLOWPAN_IPHC_SAM_11: /* 0 bits */
System.arraycopy(context, 0, srcAddress, 0, 8); /* setup link-local address */
/* copy 6 NULL bytes then 2 last bytes of IID */
packet.copy(hc06_ptr, srcAddress, 14, 2); srcAddress[0] = (byte) 0xfe;
hc06_ptr += 2; srcAddress[1] = (byte) 0x80;
break; /* infer IID from L2 address */
case SICSLOWPAN_IPHC_SAM_11: /* 0-bits */ System.arraycopy(packet.llsender, 0, srcAddress,
/* copy prefix from context */ 16 - packet.llsender.length, packet.llsender.length);
System.arraycopy(context, 0, srcAddress, 0, 8); break;
/* infer IID from L2 address */ }
System.arraycopy(packet.llsender, 0, srcAddress, }
16 - packet.llsender.length, packet.llsender.length);
break; /* Destination address */
}
/* end context based compression */ /* multicast compression */
if ((packet.get(1) & SICSLOWPAN_IPHC_M) != 0) {
/* context based multicast compression */
if ((packet.get(1) & SICSLOWPAN_IPHC_DAC) != 0) {
/* TODO: implement this */
} else { } else {
/* no compression and link local */ /* non-context based multicast compression */
switch(packet.get(1) & SICSLOWPAN_IPHC_SAM_11) { switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) {
case SICSLOWPAN_IPHC_SAM_00: /* 128 bits */ case SICSLOWPAN_IPHC_DAM_00: /* 128 bits */
/* copy whole address from packet */ /* copy whole address from packet */
packet.copy(hc06_ptr, srcAddress, 0, 16);
hc06_ptr += 16; packet.copy(hc06_ptr, destAddress, 0, 16);
break; hc06_ptr += 16;
case SICSLOWPAN_IPHC_SAM_01: /* 64 bits */ break;
srcAddress[0] = (byte) 0xfe; case SICSLOWPAN_IPHC_DAM_01: /* 48 bits FFXX::00XX:XXXX:XXXX */
srcAddress[1] = (byte) 0x80;
/* copy IID from packet */ destAddress[0] = (byte) 0xff;
packet.copy(hc06_ptr, srcAddress, 8, 8); destAddress[1] = packet.get(hc06_ptr);
hc06_ptr += 8; packet.copy(hc06_ptr + 1, destAddress, 11, 5);
break; hc06_ptr += 6;
case SICSLOWPAN_IPHC_SAM_10: /* 16 bits */ break;
srcAddress[0] = (byte) 0xfe; case SICSLOWPAN_IPHC_DAM_10: /* 32 bits FFXX::00XX:XXXX */
srcAddress[1] = (byte) 0x80;
packet.copy(hc06_ptr, srcAddress, 14, 2); destAddress[0] = (byte) 0xff;
hc06_ptr += 2; destAddress[1] = packet.get(hc06_ptr);
break; packet.copy(hc06_ptr + 1, destAddress, 13, 3);
case SICSLOWPAN_IPHC_SAM_11: /* 0 bits */ hc06_ptr += 4;
/* setup link-local address */ break;
srcAddress[0] = (byte) 0xfe; case SICSLOWPAN_IPHC_DAM_11: /* 8 bits FF02::00XX */
srcAddress[1] = (byte) 0x80;
/* infer IID from L2 address */ destAddress[0] = (byte) 0xff;
System.arraycopy(packet.llsender, 0, srcAddress, destAddress[1] = (byte) 0x02;
16 - packet.llsender.length, packet.llsender.length); destAddress[15] = packet.get(hc06_ptr);
break; hc06_ptr++;
} break;
}
} }
} else {
/* no multicast */
/* Context based */
if ((packet.get(1) & SICSLOWPAN_IPHC_DAC) != 0) {
byte[] context = addrContexts[dci];
/* Destination address */ switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) {
case SICSLOWPAN_IPHC_DAM_01: /* 64 bits */
/* multicast compression */ System.arraycopy(context, 0, destAddress, 0, 8);
if((packet.get(1) & SICSLOWPAN_IPHC_M) != 0) { /* copy IID from packet */
/* context based multicast compression */ packet.copy(hc06_ptr, destAddress, 8, 8);
if((packet.get(1) & SICSLOWPAN_IPHC_DAC) != 0) { hc06_ptr += 8;
/* TODO: implement this */ break;
} else { case SICSLOWPAN_IPHC_DAM_10: /* 16 bits */
/* non-context based multicast compression */ /* unicast address */
switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) {
case SICSLOWPAN_IPHC_DAM_00: /* 128 bits */ System.arraycopy(context, 0, destAddress, 0, 8);
/* copy whole address from packet */ /* copy IID from packet */
packet.copy(hc06_ptr, destAddress, 0, 16); packet.copy(hc06_ptr, destAddress, 14, 2);
hc06_ptr += 16; hc06_ptr += 2;
break; break;
case SICSLOWPAN_IPHC_DAM_01: /* 48 bits FFXX::00XX:XXXX:XXXX */ case SICSLOWPAN_IPHC_DAM_11: /* 0 bits */
destAddress[0] = (byte) 0xff; /* unicast address */
destAddress[1] = packet.get(hc06_ptr);
packet.copy(hc06_ptr + 1, destAddress, 11, 5); System.arraycopy(context, 0, destAddress, 0, 8);
hc06_ptr += 6; /* infer IID from L2 address */
break; System.arraycopy(packet.llreceiver, 0, destAddress,
case SICSLOWPAN_IPHC_DAM_10: /* 32 bits FFXX::00XX:XXXX */ 16 - packet.llreceiver.length, packet.llreceiver.length);
destAddress[0] = (byte) 0xff; break;
destAddress[1] = packet.get(hc06_ptr); }
packet.copy(hc06_ptr + 1, destAddress, 13, 3);
hc06_ptr += 4;
break;
case SICSLOWPAN_IPHC_DAM_11: /* 8 bits FF02::00XX */
destAddress[0] = (byte) 0xff;
destAddress[1] = (byte) 0x02;
destAddress[15] = packet.get(hc06_ptr);
hc06_ptr++;
break;
}
}
} else { } else {
/* no multicast */ /* not context based => link local M = 0, DAC = 0 - same as SAC */
/* Context based */ switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) {
if((packet.get(1) & SICSLOWPAN_IPHC_DAC) != 0) { case SICSLOWPAN_IPHC_DAM_00: /* 128 bits */
byte[] context = addrContexts[dci];
switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) { packet.copy(hc06_ptr, destAddress, 0, 16);
case SICSLOWPAN_IPHC_DAM_01: /* 64 bits */ hc06_ptr += 16;
System.arraycopy(context, 0, destAddress, 0, 8); break;
/* copy IID from packet */ case SICSLOWPAN_IPHC_DAM_01: /* 64 bits */
packet.copy(hc06_ptr, destAddress, 8, 8);
hc06_ptr += 8; destAddress[0] = (byte) 0xfe;
break; destAddress[1] = (byte) 0x80;
case SICSLOWPAN_IPHC_DAM_10: /* 16 bits */ packet.copy(hc06_ptr, destAddress, 8, 8);
/* unicast address */ hc06_ptr += 8;
System.arraycopy(context, 0, destAddress, 0, 8); break;
/* copy IID from packet */ case SICSLOWPAN_IPHC_DAM_10: /* 16 bits */
packet.copy(hc06_ptr, destAddress, 14, 2);
hc06_ptr += 2; destAddress[0] = (byte) 0xfe;
break; destAddress[1] = (byte) 0x80;
case SICSLOWPAN_IPHC_DAM_11: /* 0 bits */ packet.copy(hc06_ptr, destAddress, 14, 2);
/* unicast address */ hc06_ptr += 2;
System.arraycopy(context, 0, destAddress, 0, 8); break;
/* infer IID from L2 address */ case SICSLOWPAN_IPHC_DAM_11: /* 0 bits */
System.arraycopy(packet.llreceiver, 0, destAddress,
16 - packet.llreceiver.length, packet.llreceiver.length); destAddress[0] = (byte) 0xfe;
break; destAddress[1] = (byte) 0x80;
} System.arraycopy(packet.llreceiver, 0, destAddress,
} else { 16 - packet.llreceiver.length, packet.llreceiver.length);
/* not context based => link local M = 0, DAC = 0 - same as SAC */ break;
switch (packet.get(1) & SICSLOWPAN_IPHC_DAM_11) { }
case SICSLOWPAN_IPHC_DAM_00: /* 128 bits */
packet.copy(hc06_ptr, destAddress, 0, 16);
hc06_ptr += 16;
break;
case SICSLOWPAN_IPHC_DAM_01: /* 64 bits */
destAddress[0] = (byte) 0xfe;
destAddress[1] = (byte) 0x80;
packet.copy(hc06_ptr, destAddress, 8, 8);
hc06_ptr += 8;
break;
case SICSLOWPAN_IPHC_DAM_10: /* 16 bits */
destAddress[0] = (byte) 0xfe;
destAddress[1] = (byte) 0x80;
packet.copy(hc06_ptr, destAddress, 14, 2);
hc06_ptr += 2;
break;
case SICSLOWPAN_IPHC_DAM_11: /* 0 bits */
destAddress[0] = (byte) 0xfe;
destAddress[1] = (byte) 0x80;
System.arraycopy(packet.llreceiver, 0, destAddress,
16 - packet.llreceiver.length, packet.llreceiver.length);
break;
}
}
} }
}
/* Next header processing - continued */ /* Next header processing - continued */
if(nhc) { if (nhc) {
/* TODO: check if this is correct in hc-06 */ /* TODO: check if this is correct in hc-06 */
/* The next header is compressed, NHC is following */ /* The next header is compressed, NHC is following */
if((packet.get(hc06_ptr) & SICSLOWPAN_NDC_UDP_MASK) == SICSLOWPAN_NHC_UDP_ID) { if ((packet.get(hc06_ptr) & SICSLOWPAN_NDC_UDP_MASK) == SICSLOWPAN_NHC_UDP_ID) {
proto = PROTO_UDP; proto = PROTO_UDP;
switch(packet.get(hc06_ptr)) { switch (packet.get(hc06_ptr) & (byte) SICSLOWPAN_NHC_UDP_11) {
case (byte) SICSLOWPAN_NHC_UDP_C: case (byte) SICSLOWPAN_NHC_UDP_00:
/* 1 byte for NHC, 1 byte for ports, 2 bytes chksum */ /* 1 byte for NHC, 4 byte for ports, 2 bytes chksum */
srcPort = SICSLOWPAN_UDP_PORT_MIN + (packet.get(hc06_ptr + 1) >> 4); srcPort = packet.getInt(hc06_ptr + 1, 2) & 0xFFFF;
destPort = SICSLOWPAN_UDP_PORT_MIN + (packet.get(hc06_ptr + 1) & 0x0F); destPort = packet.getInt(hc06_ptr + 3, 2) & 0xFFFF;
// memcpy(&SICSLOWPAN_UDP_BUF->udpchksum, hc06_ptr + 2, 2); hc06_ptr += 7;
// PRINTF("IPHC: Uncompressed UDP ports (4): %x, %x\n", break;
// SICSLOWPAN_UDP_BUF->srcport, SICSLOWPAN_UDP_BUF->destport); case (byte) SICSLOWPAN_NHC_UDP_01:
hc06_ptr += 4; /* 1 byte for NHC, 3 byte for ports, 2 bytes chksum */
break; srcPort = packet.getInt(hc06_ptr + 1, 2);
case (byte) SICSLOWPAN_NHC_UDP_I: destPort = SICSLOWPAN_UDP_8_BIT_PORT_MIN + (packet.get(hc06_ptr + 3) & 0xFF);
/* 1 byte for NHC, 4 byte for ports, 2 bytes chksum */ hc06_ptr += 6;
srcPort = packet.getInt(hc06_ptr + 1, 2); break;
destPort = packet.getInt(hc06_ptr + 3, 2); case (byte) SICSLOWPAN_NHC_UDP_10:
// memcpy(&SICSLOWPAN_UDP_BUF->udpchksum, hc06_ptr + 5, 2); /* 1 byte for NHC, 3 byte for ports, 2 bytes chksum */
// PRINTF("IPHC: Uncompressed UDP ports (7): %x, %x\n", srcPort = SICSLOWPAN_UDP_8_BIT_PORT_MIN + (packet.get(hc06_ptr + 1) & 0xFF);
// SICSLOWPAN_UDP_BUF->srcport, SICSLOWPAN_UDP_BUF->destport); destPort = packet.getInt(hc06_ptr + 2, 2);
hc06_ptr += 6;
hc06_ptr += 7; break;
break; case (byte) SICSLOWPAN_NHC_UDP_11:
default: /* 1 byte for NHC, 1 byte for ports, 2 bytes chksum */
// PRINTF("sicslowpan uncompress_hdr: error unsupported UDP compression\n"); srcPort = SICSLOWPAN_UDP_4_BIT_PORT_MIN + (packet.get(hc06_ptr + 1) >> 4);
return ANALYSIS_FAILED; destPort = SICSLOWPAN_UDP_4_BIT_PORT_MIN + (packet.get(hc06_ptr + 1) & 0x0F);
} hc06_ptr += 4;
} break;
}
} }
} else {
// Skip extension header
// XXX TODO: Handle others, too?
if (proto == EXT_HDR_HOP_BY_HOP) {
proto = packet.get(hc06_ptr) & 0xFF;
// header length is length specified in field, rounded up to 64 bit
int hdr_len = ((packet.get(hc06_ptr + 1) / 8) + 1) * 8;
hc06_ptr += hdr_len;
// UDP hadling
if (proto == PROTO_UDP) {
srcPort = packet.getInt(hc06_ptr, 2) & 0xFFFF;
destPort = packet.getInt(hc06_ptr + 2, 2) & 0xFFFF;
hc06_ptr += 4;
}
}
}
// /* IP length field. */ // /* IP length field. */
// if(ip_len == 0) { // if(ip_len == 0) {
@ -374,54 +435,74 @@ public class IPHCPacketAnalyzer extends PacketAnalyzer {
// SICSLOWPAN_IP_BUF->len[0] = (ip_len - UIP_IPH_LEN) >> 8; // SICSLOWPAN_IP_BUF->len[0] = (ip_len - UIP_IPH_LEN) >> 8;
// SICSLOWPAN_IP_BUF->len[1] = (ip_len - UIP_IPH_LEN) & 0x00FF; // SICSLOWPAN_IP_BUF->len[1] = (ip_len - UIP_IPH_LEN) & 0x00FF;
// } // }
// /* length field in UDP header */ // /* length field in UDP header */
// if(SICSLOWPAN_IP_BUF->proto == UIP_PROTO_UDP) { // if(SICSLOWPAN_IP_BUF->proto == UIP_PROTO_UDP) {
// memcpy(&SICSLOWPAN_UDP_BUF->udplen, ipBuf + len[0], 2); // memcpy(&SICSLOWPAN_UDP_BUF->udplen, ipBuf + len[0], 2);
// } // }
/*--------------------------------------------- */ /*--------------------------------------------- */
} catch (Exception e) {
// some kind of unexpected error...
error = " error during IPHC parsing: " + e.getMessage();
}
packet.pos += hc06_ptr;
} catch (Exception e) { String protoStr = "" + proto;
// some kind of unexpected error... if (proto == PROTO_ICMP) {
error = " error during IPHC parsing: " + e.getMessage(); protoStr = "ICMPv6";
} } else if (proto == PROTO_UDP) {
packet.pos += hc06_ptr; protoStr = "UDP";
} else if (proto == PROTO_TCP) {
String protoStr = "" + proto; protoStr = "TCP";
if (proto == PROTO_ICMP) { } else {
protoStr = "ICMPv6"; protoStr = String.valueOf(proto);
} else if (proto == PROTO_UDP) protoStr = "UDP";
else if (proto == PROTO_TCP) protoStr = "TCP";
verbose.append("<br><b>IPv6 ").append(protoStr).append("</b> TC = " + trafficClass +
" FL: " + flowLabel + "<br>");
verbose.append("From ");
printAddress(verbose, srcAddress);
verbose.append(" to ");
printAddress(verbose, destAddress);
if (error != null) verbose.append(" " + error);
packet.lastDispatch = (byte) (proto & 0xff);
if (proto == PROTO_UDP || proto == PROTO_ICMP ||
proto == PROTO_TCP) {
packet.level = APPLICATION_LEVEL;
return ANALYSIS_OK_CONTINUE;
} else {
packet.level = NETWORK_LEVEL;
return ANALYSIS_OK_CONTINUE;
}
} }
public static void printAddress(StringBuffer out, byte[] address) { // IPv6 Information
for (int i = 0; i < 16; i+=2) {
out.append(StringUtils.toHex((byte) (address[i] & 0xff)) + brief.append("|IPv6");
StringUtils.toHex((byte) (address[i + 1] & 0xff))); verbose.append("<br/><b>IPv6</b>")
if (i < 14) { .append(" TC = ").append(trafficClass)
out.append(":"); .append(", FL = ").append(flowLabel)
} .append("<br>");
} verbose.append("From ");
printAddress(verbose, srcAddress);
verbose.append(" to ");
printAddress(verbose, destAddress);
if (error != null) {
verbose.append(" ").append(error);
}
// Application Layer Information
if (proto != PROTO_ICMP) {
brief.append('|').append(protoStr);
verbose.append("<br/><b>").append(protoStr).append("</b>");
}
if (proto == PROTO_UDP) {
brief.append(' ').append(srcPort).append(' ').append(destPort);
verbose.append("<br/>Src Port: ").append(srcPort);
verbose.append(", Dst Port: ").append(destPort);
}
packet.lastDispatch = (byte) (proto & 0xff);
if (proto == PROTO_UDP || proto == PROTO_ICMP
|| proto == PROTO_TCP) {
packet.level = APPLICATION_LEVEL;
return ANALYSIS_OK_CONTINUE;
} else {
packet.level = NETWORK_LEVEL;
return ANALYSIS_OK_CONTINUE;
}
}
public static void printAddress(StringBuilder out, byte[] address) {
for (int i = 0; i < 16; i += 2) {
out.append(StringUtils.toHex((byte) (address[i] & 0xff))
+ StringUtils.toHex((byte) (address[i + 1] & 0xff)));
if (i < 14) {
out.append(":");
} }
}
}
} }

125
tools/cooja/java/org/contikios/cooja/plugins/analyzers/IPv6PacketAnalyzer.java
View file

@ -4,78 +4,79 @@ import org.contikios.cooja.util.StringUtils;
public class IPv6PacketAnalyzer extends PacketAnalyzer { public class IPv6PacketAnalyzer extends PacketAnalyzer {
public final static int PROTO_UDP = 17;
public final static int PROTO_TCP = 6;
public final static int PROTO_ICMP = 58;
public final static int PROTO_UDP = 17; public final static byte[] UNSPECIFIED_ADDRESS
public final static int PROTO_TCP = 6; = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
public final static int PROTO_ICMP = 58;
private static final int IPV6_DISPATCH = 0x41;
public final static byte[] UNSPECIFIED_ADDRESS = @Override
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; public boolean matchPacket(Packet packet) {
return packet.level == NETWORK_LEVEL && packet.get(0) == IPV6_DISPATCH;
}
private static final int IPV6_DISPATCH = 0x41; @Override
public int analyzePacket(Packet packet, StringBuilder brief,
StringBuilder verbose) {
public boolean matchPacket(Packet packet) { /* if packet has less than 40 bytes it is not interesting ... */
return packet.level == NETWORK_LEVEL && packet.get(0) == IPV6_DISPATCH; if (packet.size() < 40) return ANALYSIS_FAILED;
brief.append("IPv6");
/* need to decompress while analyzing - add that later... */
verbose.append("<b>IPv6</b><br>");
int pos = 1;
int version = 6;
int trafficClass = 0;
int flowLabel = 0;
int len = packet.getInt(pos + 4, 2);
int proto = packet.getInt(pos + 6, 1);
int ttl = packet.getInt(pos + 7, 1);
byte[] srcAddress = new byte[16];
byte[] destAddress = new byte[16];
packet.copy(pos + 8, srcAddress, 0, 16);
packet.copy(pos + 24, destAddress, 0, 16);
String protoStr = "" + proto;
if (proto == PROTO_ICMP) {
protoStr = "ICMPv6";
} else if (proto == PROTO_UDP) {
protoStr = "UDP";
} else if (proto == PROTO_TCP) {
protoStr = "TCP";
} }
public int analyzePacket(Packet packet, StringBuffer brief, /* consume dispatch + IP header */
StringBuffer verbose) { packet.pos += 41;
/* if packet has less than 40 bytes it is not interesting ... */ verbose.append("<br><b>IPv6 ").append(protoStr)
if (packet.size() < 40) return ANALYSIS_FAILED; .append("</b> TC = ").append(trafficClass)
.append(" FL: ").append(flowLabel).append("<br>");
verbose.append("From ");
printAddress(verbose, srcAddress);
verbose.append(" to ");
printAddress(verbose, destAddress);
packet.lastDispatch = (byte) (proto & 0xff);
packet.level = APPLICATION_LEVEL;
return ANALYSIS_OK_CONTINUE;
}
brief.append("IPv6"); public static void printAddress(StringBuilder out, byte[] address) {
for (int i = 0; i < 16; i += 2) {
/* need to decompress while analyzing - add that later... */ out.append(StringUtils.toHex((byte) (address[i] & 0xff))
+ StringUtils.toHex((byte) (address[i + 1] & 0xff)));
verbose.append("<b>IPv6</b><br>"); if (i < 14) {
out.append(":");
int pos = 1;
int version = 6;
int trafficClass = 0;
int flowLabel = 0;
int len = packet.getInt(pos + 4, 2);
int proto = packet.getInt(pos + 6, 1);
int ttl = packet.getInt(pos + 7, 1);
byte[] srcAddress = new byte[16];
byte[] destAddress = new byte[16];
packet.copy(pos + 8, srcAddress, 0, 16);
packet.copy(pos + 24, destAddress, 0, 16);
String protoStr = "" + proto;
if (proto == PROTO_ICMP) {
protoStr = "ICMPv6";
} else if (proto == PROTO_UDP) protoStr = "UDP";
else if (proto == PROTO_TCP) protoStr = "TCP";
/* consume dispatch + IP header */
packet.pos += 41;
verbose.append("<br><b>IPv6 ").append(protoStr).append("</b> TC = " + trafficClass +
" FL: " + flowLabel + "<br>");
verbose.append("From ");
printAddress(verbose, srcAddress);
verbose.append(" to ");
printAddress(verbose, destAddress);
packet.lastDispatch = (byte) (proto & 0xff);
packet.level = APPLICATION_LEVEL;
return ANALYSIS_OK_CONTINUE;
}
public static void printAddress(StringBuffer out, byte[] address) {
for (int i = 0; i < 16; i+=2) {
out.append(StringUtils.toHex((byte) (address[i] & 0xff)) +
StringUtils.toHex((byte) (address[i + 1] & 0xff)));
if (i < 14) {
out.append(":");
}
}
} }
}
}
} }

130
tools/cooja/java/org/contikios/cooja/plugins/analyzers/PacketAnalyzer.java
View file

@ -2,88 +2,86 @@ package org.contikios.cooja.plugins.analyzers;
public abstract class PacketAnalyzer { public abstract class PacketAnalyzer {
public static final int ANALYSIS_FAILED = -1; public static final int ANALYSIS_FAILED = -1;
public static final int ANALYSIS_OK_CONTINUE = 1; public static final int ANALYSIS_OK_CONTINUE = 1;
public static final int ANALYSIS_OK_FINAL = 2; public static final int ANALYSIS_OK_FINAL = 2;
public static final int RADIO_LEVEL = 0; public static final int RADIO_LEVEL = 0;
public static final int MAC_LEVEL = 1; public static final int MAC_LEVEL = 1;
public static final int NETWORK_LEVEL = 2; public static final int NETWORK_LEVEL = 2;
public static final int APPLICATION_LEVEL = 3; public static final int APPLICATION_LEVEL = 3;
public static class Packet { public static class Packet {
byte[] data;
int pos;
int level;
/* size = length - consumed bytes at tail */
int size;
/* L2 addresseses */ byte[] data;
byte[] llsender; int pos;
byte[] llreceiver; int level;
/* size = length - consumed bytes at tail */
int size;
byte lastDispatch = 0; /* L2 addresseses */
byte[] llsender;
byte[] llreceiver;
public Packet(byte[] data, int level) { byte lastDispatch = 0;
this.level = level;
this.data = data;
this.size = data.length;
}
public Packet(byte[] data, int level) {
this.level = level;
this.data = data;
this.size = data.length;
}
public void consumeBytesStart(int bytes) { public void consumeBytesStart(int bytes) {
pos += bytes; pos += bytes;
} }
public void consumeBytesEnd(int bytes) { public void consumeBytesEnd(int bytes) {
size -= bytes; size -= bytes;
} }
public boolean hasMoreData() {
return size > pos;
}
public boolean hasMoreData() { public int size() {
return size > pos; return size - pos;
} }
public int size() { public byte get(int index) {
return size - pos; if (index >= size) return 0;
} return data[pos + index];
}
public byte get(int index) { public int getInt(int index, int size) {
if (index >= size) return 0; int value = 0;
return data[pos + index]; for (int i = 0; i < size; i++) {
} value = (value << 8) + (get(index + i) & 0xFF);
}
return value;
}
public int getInt(int index, int size) { public byte[] getPayload() {
int value = 0; byte[] pload = new byte[size - pos];
for (int i = 0; i < size; i++) { System.arraycopy(data, pos, pload, 0, pload.length);
value = (value << 8) + get(index + i); return pload;
} }
return value;
}
public void copy(int srcpos, byte[] arr, int pos, int len) {
for (int i = 0; i < len; i++) {
arr[pos + i] = get(srcpos + i);
}
}
public byte[] getPayload() { public byte[] getLLSender() {
byte[] pload = new byte[size - pos]; return llsender;
System.arraycopy(data, pos, pload, 0, pload.length); }
return pload;
}
public void copy(int srcpos, byte[] arr, int pos, int len) { public byte[] getLLReceiver() {
for (int i = 0; i < len; i++) { return llreceiver;
arr[pos + i] = get(srcpos + i); }
} };
}
public byte[] getLLSender() { public abstract boolean matchPacket(Packet packet);
return llsender;
}
public byte[] getLLReceiver() { public abstract int analyzePacket(Packet packet, StringBuilder brief, StringBuilder verbose);
return llreceiver;
}
};
public abstract boolean matchPacket(Packet packet);
public abstract int analyzePacket(Packet packet, StringBuffer brief, StringBuffer verbose);
} }

90
tools/cooja/java/org/contikios/cooja/plugins/analyzers/PcapExporter.java
View file

@ -9,55 +9,55 @@ import java.io.File;
public class PcapExporter { public class PcapExporter {
DataOutputStream out; DataOutputStream out;
public PcapExporter() throws IOException { public PcapExporter() throws IOException {
}
public void openPcap(File pcapFile) throws IOException {
if (out != null) {
closePcap();
} }
if (pcapFile == null) {
public void openPcap(File pcapFile) throws IOException { /* pcap file not specified, use default file name */
if ( out != null ) { pcapFile = new File("radiolog-" + System.currentTimeMillis() + ".pcap");
closePcap();
}
if ( pcapFile == null ) {
/* pcap file not specified, use default file name */
pcapFile = new File("radiolog-" + System.currentTimeMillis() + ".pcap");
}
out = new DataOutputStream(new FileOutputStream(pcapFile));
/* pcap header */
out.writeInt(0xa1b2c3d4);
out.writeShort(0x0002);
out.writeShort(0x0004);
out.writeInt(0);
out.writeInt(0);
out.writeInt(4096);
out.writeInt(195); /* 195 for LINKTYPE_IEEE802_15_4 */
out.flush();
System.out.println("Opened pcap file " + pcapFile);
} }
public void closePcap() throws IOException { out = new DataOutputStream(new FileOutputStream(pcapFile));
out.close(); /* pcap header */
out = null; out.writeInt(0xa1b2c3d4);
out.writeShort(0x0002);
out.writeShort(0x0004);
out.writeInt(0);
out.writeInt(0);
out.writeInt(4096);
out.writeInt(195); /* 195 for LINKTYPE_IEEE802_15_4 */
out.flush();
System.out.println("Opened pcap file " + pcapFile);
}
public void closePcap() throws IOException {
out.close();
out = null;
}
public void exportPacketData(byte[] data) throws IOException {
if (out == null) {
/* pcap file never set, open default */
openPcap(null);
} }
try {
public void exportPacketData(byte[] data) throws IOException { /* pcap packet header */
if (out == null) { out.writeInt((int) (System.currentTimeMillis() / 1000));
/* pcap file never set, open default */ out.writeInt((int) ((System.currentTimeMillis() % 1000) * 1000));
openPcap(null); out.writeInt(data.length);
} out.writeInt(data.length);
try { /* and the data */
/* pcap packet header */ out.write(data);
out.writeInt((int) (System.currentTimeMillis() / 1000)); out.flush();
out.writeInt((int) ((System.currentTimeMillis() % 1000) * 1000)); } catch (Exception e) {
out.writeInt(data.length); e.printStackTrace();
out.writeInt(data.length);
/* and the data */
out.write(data);
out.flush();
} catch (Exception e) {
e.printStackTrace();
}
} }
}
} }