simplified and bugfixed Cooja's IP address interface, added two
variables in uip-ds6.c to allow Cooja to extract addresses from memory
This commit is contained in:
parent
ebd9573574
commit
b9f1b9b205
|
@ -42,6 +42,7 @@
|
||||||
*/
|
*/
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
|
#include <stddef.h>
|
||||||
#include "lib/random.h"
|
#include "lib/random.h"
|
||||||
#include "net/uip-nd6.h"
|
#include "net/uip-nd6.h"
|
||||||
#include "net/uip-ds6.h"
|
#include "net/uip-ds6.h"
|
||||||
|
@ -78,6 +79,10 @@ uip_ds6_defrt_t uip_ds6_defrt_list[UIP_DS6_DEFRT_NB]; /** \brief Def
|
||||||
uip_ds6_prefix_t uip_ds6_prefix_list[UIP_DS6_PREFIX_NB]; /** \brief Prefix list */
|
uip_ds6_prefix_t uip_ds6_prefix_list[UIP_DS6_PREFIX_NB]; /** \brief Prefix list */
|
||||||
uip_ds6_route_t uip_ds6_routing_table[UIP_DS6_ROUTE_NB]; /** \brief Routing table */
|
uip_ds6_route_t uip_ds6_routing_table[UIP_DS6_ROUTE_NB]; /** \brief Routing table */
|
||||||
|
|
||||||
|
/* Used by Cooja to enable extraction of addresses from memory.*/
|
||||||
|
uint8_t uip_ds6_addr_size;
|
||||||
|
uint8_t uip_ds6_netif_addr_list_offset;
|
||||||
|
|
||||||
/** @} */
|
/** @} */
|
||||||
|
|
||||||
/* "full" (as opposed to pointer) ip address used in this file, */
|
/* "full" (as opposed to pointer) ip address used in this file, */
|
||||||
|
@ -106,6 +111,8 @@ uip_ds6_init(void)
|
||||||
memset(uip_ds6_prefix_list, 0, sizeof(uip_ds6_prefix_list));
|
memset(uip_ds6_prefix_list, 0, sizeof(uip_ds6_prefix_list));
|
||||||
memset(&uip_ds6_if, 0, sizeof(uip_ds6_if));
|
memset(&uip_ds6_if, 0, sizeof(uip_ds6_if));
|
||||||
memset(uip_ds6_routing_table, 0, sizeof(uip_ds6_routing_table));
|
memset(uip_ds6_routing_table, 0, sizeof(uip_ds6_routing_table));
|
||||||
|
uip_ds6_addr_size = sizeof(struct uip_ds6_addr);
|
||||||
|
uip_ds6_netif_addr_list_offset = offsetof(struct uip_ds6_netif, addr_list);
|
||||||
|
|
||||||
/* Set interface parameters */
|
/* Set interface parameters */
|
||||||
uip_ds6_if.link_mtu = UIP_LINK_MTU;
|
uip_ds6_if.link_mtu = UIP_LINK_MTU;
|
||||||
|
|
|
@ -25,8 +25,6 @@
|
||||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
||||||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
* SUCH DAMAGE.
|
* SUCH DAMAGE.
|
||||||
*
|
|
||||||
* $Id: IPAddress.java,v 1.11 2010/12/07 10:40:08 fros4943 Exp $
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
package se.sics.cooja.interfaces;
|
package se.sics.cooja.interfaces;
|
||||||
|
@ -41,13 +39,12 @@ import javax.swing.JPanel;
|
||||||
import org.apache.log4j.Logger;
|
import org.apache.log4j.Logger;
|
||||||
import org.jdom.Element;
|
import org.jdom.Element;
|
||||||
|
|
||||||
import se.sics.cooja.AddressMemory;
|
|
||||||
import se.sics.cooja.ClassDescription;
|
import se.sics.cooja.ClassDescription;
|
||||||
import se.sics.cooja.Mote;
|
import se.sics.cooja.Mote;
|
||||||
import se.sics.cooja.MoteInterface;
|
import se.sics.cooja.MoteInterface;
|
||||||
import se.sics.cooja.MoteTimeEvent;
|
import se.sics.cooja.MoteMemory;
|
||||||
import se.sics.cooja.Simulation;
|
import se.sics.cooja.MoteMemory.MemoryEventType;
|
||||||
import se.sics.cooja.TimeEvent;
|
import se.sics.cooja.MoteMemory.MemoryMonitor;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Read-only interface to IPv4 or IPv6 address.
|
* Read-only interface to IPv4 or IPv6 address.
|
||||||
|
@ -57,61 +54,34 @@ import se.sics.cooja.TimeEvent;
|
||||||
@ClassDescription("IP Address")
|
@ClassDescription("IP Address")
|
||||||
public class IPAddress extends MoteInterface {
|
public class IPAddress extends MoteInterface {
|
||||||
private static Logger logger = Logger.getLogger(IPAddress.class);
|
private static Logger logger = Logger.getLogger(IPAddress.class);
|
||||||
private AddressMemory moteMem;
|
private final MoteMemory moteMem;
|
||||||
|
|
||||||
private static final int IPv6_MAX_ADDRESSES = 4;
|
private static final int IPv6_MAX_ADDRESSES = 4;
|
||||||
private int ipv6NetworkInterfaceAddressOffset;
|
private boolean ipv6IsGlobal = false;
|
||||||
private int ipv6AddressStructSize;
|
private int ipv6AddressIndex = -1;
|
||||||
private boolean ipv6IsGlobal = false;
|
|
||||||
private int ipv6AddressIndex = -1;
|
private static final int MONITORED_SIZE = 150;
|
||||||
|
private MemoryMonitor memMonitor;
|
||||||
|
|
||||||
public IPAddress(final Mote mote) {
|
public IPAddress(final Mote mote) {
|
||||||
moteMem = (AddressMemory) mote.getMemory();
|
moteMem = mote.getMemory();
|
||||||
|
|
||||||
/* ipV6: Struct sizes and offsets */
|
memMonitor = new MemoryMonitor() {
|
||||||
int intLength = moteMem.getIntegerLength();
|
public void memoryChanged(MoteMemory memory, MemoryEventType type, int address) {
|
||||||
int longLength = 4;
|
if (type != MemoryEventType.WRITE) {
|
||||||
ipv6NetworkInterfaceAddressOffset /* net/uip-ds6.h:uip_ds6_netif_t */ =
|
|
||||||
4 /* link_mtu */ +
|
|
||||||
align(1, intLength) /* cur_hop_limit */ +
|
|
||||||
4 /* base_reachable_time */ +
|
|
||||||
4 /* reachable_time */ +
|
|
||||||
4 /* retrans_timer */ +
|
|
||||||
align(1, intLength) /* maxdadns */;
|
|
||||||
ipv6AddressStructSize /* net/uip-ds6.h:uip_ds6_addr_t */ =
|
|
||||||
align(1, 2) /* isused */ +
|
|
||||||
16 /* ipaddr, aligned on 16 bits */ +
|
|
||||||
align(3, intLength) /* state + type + isinfinite */ +
|
|
||||||
2*longLength /* vlifetime */ +
|
|
||||||
2*longLength /* dadtimer */ +
|
|
||||||
align(1, intLength) /* dadnscount */;
|
|
||||||
ipv6AddressStructSize = align(ipv6AddressStructSize, intLength);
|
|
||||||
|
|
||||||
/* Detect startup IP (only zeroes) */
|
|
||||||
TimeEvent updateWhenAddressReady = new MoteTimeEvent(mote, 0) {
|
|
||||||
public void execute(long t) {
|
|
||||||
if (!isVersion4() && !isVersion6()) {
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
setChanged();
|
||||||
String ipString = getIPString();
|
notifyObservers();
|
||||||
ipString = ipString.replace(".", "");
|
|
||||||
ipString = ipString.replace(":", "");
|
|
||||||
ipString = ipString.replace("0", "");
|
|
||||||
if (!ipString.isEmpty()) {
|
|
||||||
setChanged();
|
|
||||||
notifyObservers();
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Postpone until IP has been set */
|
|
||||||
mote.getSimulation().scheduleEvent(
|
|
||||||
this,
|
|
||||||
mote.getSimulation().getSimulationTime() + Simulation.MILLISECOND);
|
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
updateWhenAddressReady.execute(0);
|
if (isVersion4()) {
|
||||||
|
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_hostaddr"), 4, memMonitor);
|
||||||
|
} else if (isVersion6()) {
|
||||||
|
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_netif_addr_list_offset"), 1, memMonitor);
|
||||||
|
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_addr_size"), 1, memMonitor);
|
||||||
|
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_if"), MONITORED_SIZE, memMonitor);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -130,80 +100,77 @@ public class IPAddress extends MoteInterface {
|
||||||
ipString += (0xFF & ip[3]);
|
ipString += (0xFF & ip[3]);
|
||||||
return ipString;
|
return ipString;
|
||||||
} else if (isVersion6()) {
|
} else if (isVersion6()) {
|
||||||
String ipString = getUncompressedIPv6Address();
|
String ipString = getUncompressedIPv6Address();
|
||||||
if (ipString != null) {
|
return compressIPv6Address(ipString);
|
||||||
ipString = compressIPv6Address(ipString);
|
|
||||||
}
|
|
||||||
return ipString;
|
|
||||||
}
|
}
|
||||||
return null;
|
return null;
|
||||||
}
|
}
|
||||||
|
|
||||||
public static String compressIPv6Address(String ipString) {
|
public static String compressIPv6Address(String ipString) {
|
||||||
while (ipString.contains(":0000:")) {
|
if (ipString.contains(":0000:0000:0000:0000:")) {
|
||||||
ipString = ipString.replaceAll(":0000:", "::");
|
ipString = ipString.replace(":0000:0000:0000:0000:", "::");
|
||||||
}
|
} else if (ipString.contains(":0000:0000:0000:")) {
|
||||||
while (ipString.contains("0000")) {
|
ipString = ipString.replace(":0000:0000:0000:", "::");
|
||||||
ipString = ipString.replaceAll("0000", "0");
|
} else if (ipString.contains(":0000:0000:")) {
|
||||||
}
|
ipString = ipString.replace(":0000:0000:", "::");
|
||||||
while (ipString.contains(":::")) {
|
} else if (ipString.contains(":0000:")) {
|
||||||
ipString = ipString.replaceAll(":::", "::");
|
ipString = ipString.replace(":0000:", "::");
|
||||||
}
|
}
|
||||||
while (ipString.contains(":0")) {
|
while (ipString.contains(":0")) {
|
||||||
ipString = ipString.replaceAll(":0", ":");
|
ipString = ipString.replaceAll(":0", ":");
|
||||||
}
|
}
|
||||||
if (ipString.endsWith(":")) {
|
|
||||||
ipString = ipString + "0";
|
|
||||||
}
|
|
||||||
return ipString;
|
return ipString;
|
||||||
}
|
}
|
||||||
|
|
||||||
public String getUncompressedIPv6Address() {
|
public String getUncompressedIPv6Address() {
|
||||||
byte[] ip = null;
|
byte[] ip = null;
|
||||||
|
|
||||||
/* TODO No need to copy the entire array! */
|
/* IpV6: Struct sizes and offsets */
|
||||||
byte[] structData = moteMem.getByteArray("uip_ds6_if",
|
int ipv6NetworkInterfaceAddressOffset = moteMem.getByteValueOf("uip_ds6_netif_addr_list_offset");
|
||||||
ipv6NetworkInterfaceAddressOffset+IPv6_MAX_ADDRESSES*ipv6AddressStructSize);
|
int ipv6AddressStructSize = moteMem.getByteValueOf("uip_ds6_addr_size");
|
||||||
|
if (ipv6NetworkInterfaceAddressOffset == 0 || ipv6AddressStructSize == 0) {
|
||||||
|
return "";
|
||||||
|
}
|
||||||
|
|
||||||
ipv6AddressIndex = -1;
|
/* TODO No need to copy the entire array! */
|
||||||
for (int addressIndex=0; addressIndex < IPv6_MAX_ADDRESSES; addressIndex++) {
|
byte[] structData = moteMem.getByteArray("uip_ds6_if",
|
||||||
int offset = ipv6NetworkInterfaceAddressOffset+addressIndex*ipv6AddressStructSize;
|
ipv6NetworkInterfaceAddressOffset+IPv6_MAX_ADDRESSES*ipv6AddressStructSize);
|
||||||
byte isUsed = structData[offset];
|
|
||||||
if (isUsed == 0) {
|
ipv6AddressIndex = -1;
|
||||||
continue;
|
for (int addressIndex=0; addressIndex < IPv6_MAX_ADDRESSES; addressIndex++) {
|
||||||
}
|
int offset = ipv6NetworkInterfaceAddressOffset+addressIndex*ipv6AddressStructSize;
|
||||||
|
byte isUsed = structData[offset];
|
||||||
|
if (isUsed == 0) {
|
||||||
|
continue;
|
||||||
|
}
|
||||||
byte[] addressData = new byte[16];
|
byte[] addressData = new byte[16];
|
||||||
System.arraycopy(
|
System.arraycopy(
|
||||||
structData, offset+2/* ipaddr offset */,
|
structData, offset+2/* ipaddr offset */,
|
||||||
addressData, 0, 16);
|
addressData, 0, 16);
|
||||||
|
|
||||||
if (addressData[0] == (byte)0xFE && addressData[1] == (byte)0x80) {
|
|
||||||
ipv6IsGlobal = false;
|
|
||||||
} else {
|
|
||||||
ipv6IsGlobal = true;
|
|
||||||
}
|
|
||||||
|
|
||||||
ip = addressData;
|
|
||||||
ipv6AddressIndex = addressIndex;
|
|
||||||
if (ipv6IsGlobal) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if (ip == null) {
|
|
||||||
ip = new byte[16];
|
|
||||||
ipv6AddressIndex = -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
String ipString = "";
|
if (addressData[0] == (byte)0xFE && addressData[1] == (byte)0x80) {
|
||||||
int i=0;
|
ipv6IsGlobal = false;
|
||||||
while (i < 14) {
|
} else {
|
||||||
int val = (0xFF&ip[i+1]) + ((0xFF&ip[i])<<8);
|
ipv6IsGlobal = true;
|
||||||
ipString += hex16ToString(val) + ":";
|
}
|
||||||
i+=2;
|
|
||||||
|
ip = addressData;
|
||||||
|
ipv6AddressIndex = addressIndex;
|
||||||
|
if (ipv6IsGlobal) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
int val = (0xFF&ip[15]) + ((0xFF&ip[14])<<8);
|
if (ip == null) {
|
||||||
ipString += hex16ToString(val);
|
ip = new byte[16];
|
||||||
return ipString;
|
ipv6AddressIndex = -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
StringBuilder sb = new StringBuilder();
|
||||||
|
for (int i=0; i < 14; i+=2) {
|
||||||
|
sb.append(String.format("%02x%02x:", 0xFF&ip[i+0], 0xFF&ip[i+1]));
|
||||||
|
}
|
||||||
|
sb.append(String.format("%02x%02x", 0xFF&ip[14], 0xFF&ip[15]));
|
||||||
|
return sb.toString();
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -217,7 +184,23 @@ public class IPAddress extends MoteInterface {
|
||||||
* @return True if mote has an IPv6 address
|
* @return True if mote has an IPv6 address
|
||||||
*/
|
*/
|
||||||
public boolean isVersion6() {
|
public boolean isVersion6() {
|
||||||
return moteMem.variableExists("uip_ds6_if");
|
return
|
||||||
|
moteMem.variableExists("uip_ds6_netif_addr_list_offset") &&
|
||||||
|
moteMem.variableExists("uip_ds6_addr_size") &&
|
||||||
|
moteMem.variableExists("uip_ds6_if");
|
||||||
|
}
|
||||||
|
|
||||||
|
public void removed() {
|
||||||
|
super.removed();
|
||||||
|
if (memMonitor != null) {
|
||||||
|
if (isVersion4()) {
|
||||||
|
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("rimeaddr_node_addr"), 4, memMonitor);
|
||||||
|
} else if (isVersion6()) {
|
||||||
|
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_netif_addr_list_offset"), 1, memMonitor);
|
||||||
|
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_addr_size"), 1, memMonitor);
|
||||||
|
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_if"), MONITORED_SIZE, memMonitor);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
public JPanel getInterfaceVisualizer() {
|
public JPanel getInterfaceVisualizer() {
|
||||||
|
@ -230,8 +213,8 @@ public class IPAddress extends MoteInterface {
|
||||||
if (isVersion4()) {
|
if (isVersion4()) {
|
||||||
ipLabel.setText("IPv4 address: " + getIPString());
|
ipLabel.setText("IPv4 address: " + getIPString());
|
||||||
} else if (isVersion6()) {
|
} else if (isVersion6()) {
|
||||||
ipLabel.setText((ipv6IsGlobal?"Global":"Local") +
|
ipLabel.setText((ipv6IsGlobal?"Global":"Local") +
|
||||||
" IPv6 address(#" + ipv6AddressIndex + "): " + getIPString());
|
" IPv6 address(#" + ipv6AddressIndex + "): " + getIPString());
|
||||||
} else {
|
} else {
|
||||||
ipLabel.setText("Unknown IP");
|
ipLabel.setText("Unknown IP");
|
||||||
}
|
}
|
||||||
|
@ -260,21 +243,4 @@ public class IPAddress extends MoteInterface {
|
||||||
|
|
||||||
public void setConfigXML(Collection<Element> configXML, boolean visAvailable) {
|
public void setConfigXML(Collection<Element> configXML, boolean visAvailable) {
|
||||||
}
|
}
|
||||||
|
|
||||||
private static String hex16ToString(int data) {
|
|
||||||
String s = Integer.toString(data & 0xffff, 16);
|
|
||||||
if (s.length() < 4) {
|
|
||||||
s = "0000".substring(0, 4 - s.length()) + s;
|
|
||||||
}
|
|
||||||
return s;
|
|
||||||
}
|
|
||||||
|
|
||||||
private static int align(int bytes, int alignment) {
|
|
||||||
int size = (bytes/alignment)*alignment;
|
|
||||||
while (size < bytes) {
|
|
||||||
size += alignment;
|
|
||||||
}
|
|
||||||
return size;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue